1 /* SPDX-License-Identifier: GPL-2.0-or-later */
3 /***************************************************************************
4 * Copyright (C) 2010 by Oleksandr Tymoshenko <gonzo@bluezbox.com> *
5 ***************************************************************************/
12 #include "jtag/jtag.h"
13 #include "avr32_jtag.h"
14 #include "avr32_regs.h"
16 static int avr32_jtag_read_reg(struct avr32_jtag *jtag_info, int reg,
22 retval = avr32_jtag_exec(jtag_info, MTDR(AVR32_OCDREG_DCCPU, reg));
23 if (retval != ERROR_OK)
27 retval = avr32_jtag_nexus_read(jtag_info,
28 AVR32_OCDREG_DCSR, &dcsr);
30 if (retval != ERROR_OK)
32 } while (!(dcsr & OCDREG_DCSR_CPUD));
34 retval = avr32_jtag_nexus_read(jtag_info,
35 AVR32_OCDREG_DCCPU, val);
40 static int avr32_jtag_write_reg(struct avr32_jtag *jtag_info, int reg,
46 /* Restore Status reg */
47 retval = avr32_jtag_nexus_write(jtag_info,
48 AVR32_OCDREG_DCEMU, val);
49 if (retval != ERROR_OK)
52 retval = avr32_jtag_exec(jtag_info, MFDR(reg, AVR32_OCDREG_DCEMU));
53 if (retval != ERROR_OK)
56 retval = avr32_jtag_nexus_read(jtag_info,
57 AVR32_OCDREG_DCSR, &dcsr);
58 } while (!(dcsr & OCDREG_DCSR_EMUD) && (retval == ERROR_OK));
65 int avr32_jtag_read_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
69 /* read core registers */
70 for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
71 avr32_jtag_read_reg(jtag_info, i, regs + i);
73 /* read status register */
74 retval = avr32_jtag_exec(jtag_info, MFSR(0, 0));
75 if (retval != ERROR_OK)
78 retval = avr32_jtag_read_reg(jtag_info, 0, regs + AVR32_REG_SR);
83 int avr32_jtag_write_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
87 retval = avr32_jtag_write_reg(jtag_info, 0, regs[AVR32_REG_SR]);
88 if (retval != ERROR_OK)
91 /* Restore Status reg */
92 retval = avr32_jtag_exec(jtag_info, MTSR(0, 0));
93 if (retval != ERROR_OK)
97 * And now the rest of registers
99 for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
100 avr32_jtag_write_reg(jtag_info, i, regs[i]);