src/target/avr32_regs.c

   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  *   51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.           *
  18  ***************************************************************************/
  19
  20 #ifdef HAVE_CONFIG_H
  21 #include "config.h"
  22 #endif
  23
  24 #include "target.h"
  25 #include "jtag/jtag.h"
  26 #include "avr32_jtag.h"
  27 #include "avr32_regs.h"
  28
  29 static int avr32_jtag_read_reg(struct avr32_jtag *jtag_info, int reg,
  30                 uint32_t *val)
  31 {
  32         int retval;
  33         uint32_t dcsr;
  34
  35         retval = avr32_jtag_exec(jtag_info, MTDR(AVR32_OCDREG_DCCPU, reg));
  36         if (retval != ERROR_OK)
  37                 return retval;
  38
  39         do {
  40                 retval = avr32_jtag_nexus_read(jtag_info,
  41                         AVR32_OCDREG_DCSR, &dcsr);
  42
  43                 if (retval != ERROR_OK)
  44                         return retval;
  45         } while (!(dcsr & OCDREG_DCSR_CPUD));
  46
  47         retval = avr32_jtag_nexus_read(jtag_info,
  48                         AVR32_OCDREG_DCCPU, val);
  49
  50         return retval;
  51 }
  52
  53 static int avr32_jtag_write_reg(struct avr32_jtag *jtag_info, int reg,
  54                 uint32_t val)
  55 {
  56         int retval;
  57         uint32_t dcsr;
  58
  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;
  64
  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));
  72
  73         return retval;
  74 }
  75
  76
  77
  78 int avr32_jtag_read_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
  79 {
  80         int i, retval;
  81
  82         /* read core registers */
  83         for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
  84                 avr32_jtag_read_reg(jtag_info, i, regs + i);
  85
  86         /* read status register */
  87         retval = avr32_jtag_exec(jtag_info, MFSR(0, 0));
  88         if (retval != ERROR_OK)
  89                 return retval;
  90
  91         retval = avr32_jtag_read_reg(jtag_info, 0, regs + AVR32_REG_SR);
  92
  93         return retval;
  94 }
  95
  96 int avr32_jtag_write_regs(struct avr32_jtag *jtag_info, uint32_t *regs)
  97 {
  98         int i, retval;
  99
 100         retval = avr32_jtag_write_reg(jtag_info, 0, regs[AVR32_REG_SR]);
 101         if (retval != ERROR_OK)
 102                 return retval;
 103
 104         /* Restore Status reg */
 105         retval = avr32_jtag_exec(jtag_info, MTSR(0, 0));
 106         if (retval != ERROR_OK)
 107                 return retval;
 108
 109         /*
 110          * And now the rest of registers
 111          */
 112         for (i = 0; i < AVR32NUMCOREREGS - 1; i++)
 113                 avr32_jtag_write_reg(jtag_info, i, regs[i]);
 114
 115         return ERROR_OK;
 116 }