Fixes SEGFAULT when setting registers from GDB.
[fw/openocd] / 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 "register.h"
28
29 #include "log.h"
30 #include "command.h"
31
32 #include <string.h>
33 #include <stdlib.h>
34
35 reg_arch_type_t *reg_arch_types = NULL;
36
37 reg_t* register_get_by_name(reg_cache_t *first, char *name, int search_all)
38 {
39         int i;
40         reg_cache_t *cache = first;
41
42         while (cache)
43         {
44                 for (i = 0; i < cache->num_regs; i++)
45                 {
46                         if (strcmp(cache->reg_list[i].name, name) == 0)
47                                 return &(cache->reg_list[i]);
48                 }
49
50                 if (search_all)
51                         cache = cache->next;
52                 else
53                         break;
54         }
55
56         return NULL;
57 }
58
59 reg_cache_t** register_get_last_cache_p(reg_cache_t **first)
60 {
61         reg_cache_t **cache_p = first;
62
63         if (*cache_p)
64                 while (*cache_p)
65                         cache_p = &((*cache_p)->next);
66         else
67                 return first;
68
69         return cache_p;
70 }
71
72 int register_reg_arch_type(int (*get)(reg_t *reg), int (*set)(reg_t *reg, u8 *buf))
73 {
74         reg_arch_type_t** arch_type_p = &reg_arch_types;
75         int id = 0;
76
77         if (*arch_type_p)
78         {
79                 while (*arch_type_p)
80                 {
81                         id = (*arch_type_p)->id;
82                         arch_type_p = &((*arch_type_p)->next);
83                 }
84         }
85
86         (*arch_type_p) = malloc(sizeof(reg_arch_type_t));
87         (*arch_type_p)->id = id + 1;
88         (*arch_type_p)->set = set;
89         (*arch_type_p)->get = get;
90         (*arch_type_p)->next = NULL;
91
92         return id + 1;
93 }
94
95 reg_arch_type_t* register_get_arch_type(int id)
96 {
97         reg_arch_type_t *arch_type = reg_arch_types;
98
99         while (arch_type)
100         {
101                 if (arch_type->id == id)
102                         return arch_type;
103                 arch_type = arch_type->next;
104         }
105         LOG_ERROR("BUG: encountered unregistered arch type 0x%08x", id);
106         exit(-1);
107         return NULL;
108 }
109
110
111
112 static int register_get_dummy_core_reg(reg_t *reg)
113 {
114         return ERROR_OK;
115 }
116
117 static int register_set_dummy_core_reg(reg_t *reg, u8 *buf)
118 {
119         reg->dirty = 1;
120         reg->valid = 1;
121
122         return ERROR_OK;
123 }
124
125 void register_init_dummy(reg_t *reg)
126 {
127         static int dummy_arch_type = -1;
128         if (dummy_arch_type == -1 )
129                 register_reg_arch_type(register_get_dummy_core_reg, register_set_dummy_core_reg);
130         
131         reg->arch_type = dummy_arch_type;
132 }