X-Git-Url: https://review.openocd.org/gitweb?p=openocd.git;a=blobdiff_plain;f=src%2Fflash%2Focl%2Fat91sam7x%2Fdcc.c;fp=src%2Fflash%2Focl%2Fat91sam7x%2Fdcc.c;h=3507bbe5eaaa6e8dfed8807a981f1ae25a8c4ff0;hp=2c35236961b3ff7e219e1f1b9277507ff6cb2612;hb=040e25424314b49e35eb158eb88e287c76e50596;hpb=6ef27f4534b7a8926866b1156b6a309fc7c3d300;ds=sidebyside diff --git a/src/flash/ocl/at91sam7x/dcc.c b/src/flash/ocl/at91sam7x/dcc.c index 2c35236961..3507bbe5ea 100644 --- a/src/flash/ocl/at91sam7x/dcc.c +++ b/src/flash/ocl/at91sam7x/dcc.c @@ -1,51 +1,51 @@ -/*************************************************************************** - * Copyright (C) 2007 by Pavel Chromy * - * chromy@asix.cz * - * * - * This program is free software; you can redistribute it and/or modify * - * it under the terms of the GNU General Public License as published by * - * the Free Software Foundation; either version 2 of the License, or * - * (at your option) any later version. * - * * - * This program is distributed in the hope that it will be useful, * - * but WITHOUT ANY WARRANTY; without even the implied warranty of * - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * - * GNU General Public License for more details. * - * * - * You should have received a copy of the GNU General Public License * - * along with this program; if not, write to the * - * Free Software Foundation, Inc., * - * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * - ***************************************************************************/ -#include "dcc.h" - - -/* debug channel read (debugger->MCU) */ -uint32 dcc_rd(void) -{ - volatile uint32 dcc_reg; - - do { - asm volatile ("mrc p14, 0, %0, C0, C0" : "=r" (dcc_reg) : ); - } while ((dcc_reg&1)==0); - - asm volatile ("mrc p14, 0, %0, C1, C0" : "=r" (dcc_reg) : ); - return dcc_reg; -} - - -/* debug channel write (MCU->debugger) */ -int dcc_wr(uint32 data) -{ - volatile uint32 dcc_reg; - - do { - asm volatile ("mrc p14, 0, %0, C0, C0" : "=r" (dcc_reg) : ); - /* operation controled by master, cancel operation - upon reception of data for immediate response */ - if (dcc_reg&1) return -1; - } while (dcc_reg&2); - - asm volatile ("mcr p14, 0, %0, C1, C0" : : "r" (data)); - return 0; -} +/*************************************************************************** + * Copyright (C) 2007 by Pavel Chromy * + * chromy@asix.cz * + * * + * This program is free software; you can redistribute it and/or modify * + * it under the terms of the GNU General Public License as published by * + * the Free Software Foundation; either version 2 of the License, or * + * (at your option) any later version. * + * * + * This program is distributed in the hope that it will be useful, * + * but WITHOUT ANY WARRANTY; without even the implied warranty of * + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * + * GNU General Public License for more details. * + * * + * You should have received a copy of the GNU General Public License * + * along with this program; if not, write to the * + * Free Software Foundation, Inc., * + * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * + ***************************************************************************/ +#include "dcc.h" + + +/* debug channel read (debugger->MCU) */ +uint32 dcc_rd(void) +{ + volatile uint32 dcc_reg; + + do { + asm volatile ("mrc p14, 0, %0, C0, C0" : "=r" (dcc_reg) : ); + } while ((dcc_reg&1)==0); + + asm volatile ("mrc p14, 0, %0, C1, C0" : "=r" (dcc_reg) : ); + return dcc_reg; +} + + +/* debug channel write (MCU->debugger) */ +int dcc_wr(uint32 data) +{ + volatile uint32 dcc_reg; + + do { + asm volatile ("mrc p14, 0, %0, C0, C0" : "=r" (dcc_reg) : ); + /* operation controled by master, cancel operation + upon reception of data for immediate response */ + if (dcc_reg&1) return -1; + } while (dcc_reg&2); + + asm volatile ("mcr p14, 0, %0, C1, C0" : : "r" (data)); + return 0; +}