1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
/*
* Copyright © 2008 Keith Packard <keithp@keithp.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.
*/
#include "ccdbg.h"
static uint8_t save_acc[] = {
1, NOP,
0
};
static uint8_t save_sfr[] = {
2, MOV_A_direct, 0,
#define SAVE_SFR_ADDR 2
0,
};
struct sfr_state {
uint8_t address;
uint16_t mask;
char *name;
};
static struct sfr_state sfrs[CC_STATE_NSFR] = {
{ SFR_DPL0, CC_STATE_DP, "dpl0" },
{ SFR_DPH0, CC_STATE_DP, "dph0" },
{ SFR_DPL1, CC_STATE_DP, "dpl1" },
{ SFR_DPH1, CC_STATE_DP, "dph1" },
{ PSW(0), CC_STATE_PSW, "psw" },
};
uint8_t
ccdbg_state_save(struct ccdbg *dbg, struct ccstate *state, unsigned int mask)
{
int i;
mask |= CC_STATE_ACC;
if (mask & CC_STATE_ACC)
state->acc = ccdbg_execute(dbg, save_acc);
for (i = 0; i < CC_STATE_NSFR; i++) {
if (sfrs[i].mask & mask) {
save_sfr[SAVE_SFR_ADDR] = sfrs[i].address;
state->sfr[i] = ccdbg_execute(dbg, save_sfr);
}
}
state->mask = mask;
return 0;
}
static uint8_t restore_sfr[] = {
3, MOV_direct_data, 0, 0,
#define RESTORE_SFR_ADDR 2
#define RESTORE_SFR_DATA 3
0
};
static uint8_t restore_acc[] = {
2, MOV_A_data, 0,
#define RESTORE_ACC_DATA 2
0
};
uint8_t
ccdbg_state_restore(struct ccdbg *dbg, struct ccstate *state)
{
int i;
for (i = CC_STATE_NSFR - 1; i >= 0; i--) {
if (sfrs[i].mask & state->mask) {
restore_sfr[RESTORE_SFR_ADDR] = sfrs[i].address;
restore_sfr[RESTORE_SFR_DATA] = state->sfr[i];
ccdbg_execute(dbg, restore_sfr);
}
}
if (state->mask & CC_STATE_ACC) {
restore_acc[RESTORE_ACC_DATA] = state->acc;
ccdbg_execute(dbg, restore_acc);
}
state->mask = 0;
return 0;
}
static void
ccdbg_state_replace(uint16_t sfr_addr, uint8_t sfr, char *name,
uint16_t addr, uint8_t *bytes, int nbytes)
{
sfr_addr += 0xdf00;
if (addr <= sfr_addr && sfr_addr < addr + nbytes) {
fprintf(stderr, "replacing %s at 0x%04x - read 0x%02x saved 0x%02x\n",
name, sfr_addr, bytes[sfr_addr - addr], sfr);
bytes[sfr_addr - addr] = sfr;
}
}
void
ccdbg_state_replace_xmem(struct ccdbg *dbg, struct ccstate *state,
uint16_t addr, uint8_t *bytes, int nbytes)
{
int i;
if (state->mask & CC_STATE_ACC)
ccdbg_state_replace(ACC(0), state->acc, "acc",
addr, bytes, nbytes);
for (i = 0; i < CC_STATE_NSFR; i++)
if (state->mask & sfrs[i].mask)
ccdbg_state_replace(sfrs[i].address, state->sfr[i],
sfrs[i].name, addr, bytes, nbytes);
}
void
ccdbg_state_replace_sfr(struct ccdbg *dbg, struct ccstate *state,
uint8_t addr, uint8_t *bytes, int nbytes)
{
ccdbg_state_replace_xmem(dbg, state, (uint16_t) addr + 0xdf00, bytes, nbytes);
}
|
