git.gag.com Git - fw/openocd/blob - src/target/register.c

   1 /***************************************************************************
   2  *   Copyright (C) 2005 by Dominic Rath                                    *
   3  *   Dominic.Rath@gmx.de                                                   *
   4  *                                                                         *
   5  *   Copyright (C) 2007,2008 Øyvind Harboe                                 *
   6  *   oyvind.harboe@zylin.com                                               *
   7  *                                                                         *
   8  *   This program is free software; you can redistribute it and/or modify  *
   9  *   it under the terms of the GNU General Public License as published by  *
  10  *   the Free Software Foundation; either version 2 of the License, or     *
  11  *   (at your option) any later version.                                   *
  12  *                                                                         *
  13  *   This program is distributed in the hope that it will be useful,       *
  14  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
  15  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
  16  *   GNU General Public License for more details.                          *
  17  *                                                                         *
  18  *   You should have received a copy of the GNU General Public License     *
  19  *   along with this program; if not, write to the                         *
  20  *   Free Software Foundation, Inc.,                                       *
  21  *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
  22  ***************************************************************************/
  23 #ifdef HAVE_CONFIG_H
  24 #include "config.h"
  25 #endif
  26
  27 #include "types.h"
  28 #include "register.h"
  29 #include "log.h"
  30
  31
  32 struct reg_arch_type *reg_arch_types = NULL;
  33
  34 struct reg* register_get_by_name(struct reg_cache *first,
  35                 const char *name, bool search_all)
  36 {
  37         int i;
  38         struct reg_cache *cache = first;
  39
  40         while (cache)
  41         {
  42                 for (i = 0; i < cache->num_regs; i++)
  43                 {
  44                         if (strcmp(cache->reg_list[i].name, name) == 0)
  45                                 return &(cache->reg_list[i]);
  46                 }
  47
  48                 if (search_all)
  49                         cache = cache->next;
  50                 else
  51                         break;
  52         }
  53
  54         return NULL;
  55 }
  56
  57 struct reg_cache** register_get_last_cache_p(struct reg_cache **first)
  58 {
  59         struct reg_cache **cache_p = first;
  60
  61         if (*cache_p)
  62                 while (*cache_p)
  63                         cache_p = &((*cache_p)->next);
  64         else
  65                 return first;
  66
  67         return cache_p;
  68 }
  69
  70 int register_reg_arch_type(int (*get)(struct reg *reg), int (*set)(struct reg *reg, uint8_t *buf))
  71 {
  72         struct reg_arch_type** arch_type_p = &reg_arch_types;
  73         int id = 0;
  74
  75         if (*arch_type_p)
  76         {
  77                 while (*arch_type_p)
  78                 {
  79                         id = (*arch_type_p)->id;
  80                         arch_type_p = &((*arch_type_p)->next);
  81                 }
  82         }
  83
  84         (*arch_type_p) = malloc(sizeof(struct reg_arch_type));
  85         (*arch_type_p)->id = id + 1;
  86         (*arch_type_p)->set = set;
  87         (*arch_type_p)->get = get;
  88         (*arch_type_p)->next = NULL;
  89
  90         return id + 1;
  91 }
  92
  93 struct reg_arch_type* register_get_arch_type(int id)
  94 {
  95         struct reg_arch_type *arch_type = reg_arch_types;
  96
  97         while (arch_type)
  98         {
  99                 if (arch_type->id == id)
 100                         return arch_type;
 101                 arch_type = arch_type->next;
 102         }
 103         LOG_ERROR("BUG: encountered unregistered arch type 0x%08x", id);
 104         exit(-1);
 105         return NULL;
 106 }
 107
 108 static int register_get_dummy_core_reg(struct reg *reg)
 109 {
 110         return ERROR_OK;
 111 }
 112
 113 static int register_set_dummy_core_reg(struct reg *reg, uint8_t *buf)
 114 {
 115         reg->dirty = 1;
 116         reg->valid = 1;
 117
 118         return ERROR_OK;
 119 }
 120
 121 void register_init_dummy(struct reg *reg)
 122 {
 123         static int dummy_arch_type = -1;
 124         if (dummy_arch_type == -1)
 125                 dummy_arch_type = register_reg_arch_type(register_get_dummy_core_reg, register_set_dummy_core_reg);
 126
 127         reg->arch_type = dummy_arch_type;
 128 }