stm32: determine all cpu types and use common examine
[openocd/jflash.git] / src / target / avr32_regs.c
blobc9581d7db2e55baafb6df8474186e8fbf459d213
1 /***************************************************************************
2 * Copyright (C) 2010 by Oleksandr Tymoshenko <gonzo@bluezbox.com> *
3 * *
4 * This program is free software; you can redistribute it and/or modify *
5 * it under the terms of the GNU General Public License as published by *
6 * the Free Software Foundation; either version 2 of the License, or *
7 * (at your option) any later version. *
8 * *
9 * This program is distributed in the hope that it will be useful, *
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
12 * GNU General Public License for more details. *
13 * *
14 * You should have received a copy of the GNU General Public License *
15 * along with this program; if not, write to the *
16 * Free Software Foundation, Inc., *
17 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
18 ***************************************************************************/
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
24 #include "target.h"
25 #include "jtag/jtag.h"
26 #include "avr32_jtag.h"
27 #include "avr32_regs.h"
29 static int avr32_jtag_read_reg(struct avr32_jtag *jtag_info, int reg,
30 uint32_t *val)
32 int retval;
33 uint32_t dcsr;
35 retval = avr32_jtag_exec(jtag_info, MTDR(AVR32_OCDREG_DCCPU, reg));
36 if (retval != ERROR_OK)
37 return retval;
39 do {
40 retval = avr32_jtag_nexus_read(jtag_info,
41 AVR32_OCDREG_DCSR, &dcsr);
43 if (retval != ERROR_OK)
44 return retval;
45 } while (!(dcsr & OCDREG_DCSR_CPUD));
47 retval = avr32_jtag_nexus_read(jtag_info,
48 AVR32_OCDREG_DCCPU, val);
50 return retval;
53 static int avr32_jtag_write_reg(struct avr32_jtag *jtag_info, int reg,
54 uint32_t val)
56 int retval;
57 uint32_t dcsr;
59 /* Restore Status reg */
60 retval = avr32_jtag_nexus_write(jtag_info,
61 AVR32_OCDREG_DCEMU, val);
62 if (retval != ERROR_OK)
63 return retval;
65 retval = avr32_jtag_exec(jtag_info, MFDR(reg, AVR32_OCDREG_DCEMU));
66 if (retval != ERROR_OK)
67 return retval;
68 do {
69 retval = avr32_jtag_nexus_read(jtag_info,
70 AVR32_OCDREG_DCSR, &dcsr);
71 } while (!(dcsr & OCDREG_DCSR_EMUD) && (retval == ERROR_OK));
73 return retval;
78 int avr32_jtag_read_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
80 int i, retval;
82 /* read core registers */
83 for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
84 avr32_jtag_read_reg(jtag_info, i, regs + i);
86 /* read status register */
87 retval = avr32_jtag_exec(jtag_info, MFSR(0, 0));
88 if (retval != ERROR_OK)
89 return retval;
91 retval = avr32_jtag_read_reg(jtag_info, 0, regs + AVR32_REG_SR);
93 return retval;
96 int avr32_jtag_write_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
98 int i, retval;
100 retval = avr32_jtag_write_reg(jtag_info, 0, regs[AVR32_REG_SR]);
101 if (retval != ERROR_OK)
102 return retval;
104 /* Restore Status reg */
105 retval = avr32_jtag_exec(jtag_info, MTSR(0, 0));
106 if (retval != ERROR_OK)
107 return retval;
110 * And now the rest of registers
112 for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
113 avr32_jtag_write_reg(jtag_info, i, regs[i]);
115 return ERROR_OK;