summaryrefslogtreecommitdiff
path: root/src/target/avr32_regs.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/target/avr32_regs.c')
-rw-r--r--src/target/avr32_regs.c112
1 files changed, 112 insertions, 0 deletions
diff --git a/src/target/avr32_regs.c b/src/target/avr32_regs.c
new file mode 100644
index 00000000..eb283fc3
--- /dev/null
+++ b/src/target/avr32_regs.c
@@ -0,0 +1,112 @@
+/***************************************************************************
+ * Copyright (C) 2010 by Oleksandr Tymoshenko <gonzo@bluezbox.com> *
+ * *
+ * 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. *
+ ***************************************************************************/
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include "target.h"
+#include "jtag/jtag.h"
+#include "avr32_jtag.h"
+#include "avr32_regs.h"
+
+static int avr32_jtag_read_reg(struct avr32_jtag *jtag_info, int reg,
+ uint32_t *val)
+{
+ int retval;
+ uint32_t dcsr;
+
+ retval = avr32_jtag_exec(jtag_info, MTDR(AVR32_OCDREG_DCCPU, reg));
+ if (retval != ERROR_OK)
+ return retval;
+
+ do {
+ retval = avr32_jtag_nexus_read(jtag_info,
+ AVR32_OCDREG_DCSR, &dcsr);
+
+ if (retval != ERROR_OK)
+ return retval;
+ } while (!(dcsr & OCDREG_DCSR_CPUD));
+
+ retval = avr32_jtag_nexus_read(jtag_info,
+ AVR32_OCDREG_DCCPU, val);
+
+ return retval;
+}
+
+static int avr32_jtag_write_reg(struct avr32_jtag *jtag_info, int reg,
+ uint32_t val)
+{
+ int retval;
+ uint32_t dcsr;
+
+ /* Restore Status reg */
+ retval = avr32_jtag_nexus_write(jtag_info,
+ AVR32_OCDREG_DCEMU, val);
+ if (retval != ERROR_OK)
+ return retval;
+
+ retval = avr32_jtag_exec(jtag_info, MFDR(reg, AVR32_OCDREG_DCEMU));
+ if (retval != ERROR_OK)
+ return retval;
+ do {
+ retval = avr32_jtag_nexus_read(jtag_info,
+ AVR32_OCDREG_DCSR, &dcsr);
+ } while (!(dcsr & OCDREG_DCSR_EMUD) && (retval == ERROR_OK));
+
+ return retval;
+}
+
+
+
+int avr32_jtag_read_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
+{
+ int i, retval;
+
+ /* read core registers */
+ for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
+ avr32_jtag_read_reg(jtag_info, i, regs + i);
+
+ /* read status register */
+ retval = avr32_jtag_exec(jtag_info, MFSR(0, 0));
+ if (retval != ERROR_OK)
+ return retval;
+
+ retval = avr32_jtag_read_reg(jtag_info, 0, regs + AVR32_REG_SR);
+
+ return retval;
+}
+
+int avr32_jtag_write_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
+{
+ int i, retval;
+
+ retval = avr32_jtag_write_reg(jtag_info, 0, regs[AVR32_REG_SR]);
+ /* Restore Status reg */
+ retval = avr32_jtag_exec(jtag_info, MTSR(0, 0));
+ if (retval != ERROR_OK)
+ return retval;
+
+ /*
+ * And now the rest of registers
+ */
+ for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
+ avr32_jtag_write_reg(jtag_info, i, regs[i]);
+
+ return ERROR_OK;
+}