#include "ccdbg.h"
-static uint8_t
-get_bit(char *line, int i, char on, uint8_t bit)
-{
- if (line[i] == on)
- return bit;
- if (line[i] == '.')
- return 0;
- fprintf(stderr, "bad line %s\n", line);
- exit (1);
-}
-
-static char
-is_bit(uint8_t get, char on, uint8_t bit)
-{
- if (get&bit)
- return on;
- else
- return '.';
-}
-
-static uint8_t
-ccdbg_write_read(struct ccdbg *dbg, uint8_t set)
-{
- uint8_t get;
-
- ccdbg_write(dbg, CC_DATA|CC_CLOCK|CC_RESET_N, set);
- get = ccdbg_read(dbg);
- printf("%c %c %c -> %c %c %c\n",
- is_bit(set, 'C', CC_CLOCK),
- is_bit(set, 'D', CC_DATA),
- is_bit(set, 'R', CC_RESET_N),
- is_bit(get, 'C', CC_CLOCK),
- is_bit(get, 'D', CC_DATA),
- is_bit(get, 'R', CC_RESET_N));
- ccdbg_half_clock(dbg);
- return get;
-}
-
-static void
-_ccdbg_debug_mode(struct ccdbg *dbg)
-{
- printf ("#\n");
- printf ("# Debug mode\n");
- printf ("#\n");
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
- ccdbg_write_read(dbg, CC_DATA );
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA );
- ccdbg_write_read(dbg, CC_DATA );
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA );
- ccdbg_write_read(dbg, CC_DATA|CC_RESET_N);
-}
-
-static void
-_ccdbg_reset(struct ccdbg *dbg)
-{
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA );
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA );
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
-}
+#define MOV_direct_data 0x75
+#define LJMP 0x02
+#define MOV_Rn_data(n) (0x78 | (n))
+#define DJNZ_Rn_rel(n) (0xd8 | (n))
-static void
-_ccdbg_send_bit(struct ccdbg *dbg, uint8_t bit)
-{
- if (bit) bit = CC_DATA;
- ccdbg_write_read(dbg, CC_CLOCK|bit|CC_RESET_N);
- ccdbg_write_read(dbg, bit|CC_RESET_N);
-}
-
-static void
-_ccdbg_send_byte(struct ccdbg *dbg, uint8_t byte)
-{
- int bit;
- printf ("#\n");
- printf ("# Send Byte 0x%02x\n", byte);
- printf ("#\n");
- for (bit = 7; bit >= 0; bit--) {
- _ccdbg_send_bit(dbg, (byte >> bit) & 1);
- if (bit == 3)
- printf ("\n");
- }
-}
-
-static void
-_ccdbg_send_bits(struct ccdbg *dbg, int n, uint32_t bits)
-{
- int bit;
- printf ("#\n");
- printf ("# Send %d bits 0x%08x\n", n, bits);
- printf ("#\n");
- for (bit = n - 1; bit >= 0; bit--) {
- _ccdbg_send_bit(dbg, (bits >> bit) & 1);
- if ((bit & 3) == 3)
- printf ("\n");
- }
-}
-
-static void
-_ccdbg_print_bits(int n, uint32_t bits)
-{
- int bit;
-
- for (bit = n - 1; bit >= 0; bit--)
- printf ("%d", (bits >> bit) & 1);
-}
-
-static uint32_t
-_ccdbg_read_bits(struct ccdbg *dbg, int bits)
-{
- int bit;
- uint32_t val = 0;
- uint8_t get;
-
- printf ("#\n");
- printf ("# Read %d bits\n", bits);
- printf ("#\n");
- for (bit = 0; bit < bits; bit++) {
- ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
- get = ccdbg_write_read(dbg, CC_DATA|CC_RESET_N);
- val <<= 1;
- if (get & CC_DATA)
- val |= 1;
- if ((bit & 3) == 3)
- printf ("\n");
- }
- printf ("#\n");
- printf ("# Read "); _ccdbg_print_bits(bits, val); printf ("\n");
- printf ("#\n");
- return val;
-}
-
-static int
-_ccdbg_check_bits(uint32_t bits, uint8_t match)
-{
- int bit;
-
- for (bit = 0; bit < 24; bit++)
- if (((bits >> bit) & 0xff) == match)
- return 1;
- return 0;
-}
-
-static uint32_t
-_ccdbg_play(struct ccdbg *dbg, int num_sync, uint32_t sync)
-{
- uint32_t bits;
- _ccdbg_debug_mode(dbg);
- _ccdbg_send_bits(dbg, num_sync, sync);
- _ccdbg_send_byte(dbg, CC_GET_CHIP_ID);
- bits = _ccdbg_read_bits(dbg, 16);
- _ccdbg_send_byte(dbg, CC_GET_CHIP_ID);
- bits = _ccdbg_read_bits(dbg, 16);
-// _ccdbg_send_byte(dbg, CC_READ_STATUS);
- _ccdbg_reset(dbg);
- if (_ccdbg_check_bits(bits, 0x11)) {
- printf("#\n#match with %d bits 0x%08x\n#\n", num_sync, sync);
- return 1;
- }
- return 0;
-}
-
-static int
-_ccdbg_play_num(struct ccdbg *dbg, int num)
-{
- uint32_t sync;
- uint32_t max;
-
- printf ("#\n#play %d\n#\n", num);
- max = (1 << num);
- for (sync = 0; sync < max; sync++)
- if (_ccdbg_play(dbg, num, sync))
- return 1;
- return 0;
-}
-
-static int
-_ccdbg_play_many(struct ccdbg *dbg, int max)
-{
- int num;
-
- for (num = 0; num < max; num++)
- if (_ccdbg_play_num(dbg, num))
- return 1;
- return 0;
-}
-
-static void
-ccdbg_manual(struct ccdbg *dbg, FILE *input)
-{
- char line[80];
- uint8_t set;
+#if 0
+static uint8_t instructions[] = {
+ 3, MOV_direct_data, 0xfe, 0x02,
+ 3, MOV_direct_data, 0x90, 0xff,
+ 0
+};
+#endif
- while (fgets(line, sizeof line, input)) {
- if (line[0] == '#' || line[0] == '\n') {
- printf ("%s", line);
- continue;
- }
- set = 0;
- set |= get_bit(line, 0, 'C', CC_CLOCK);
- set |= get_bit(line, 2, 'D', CC_DATA);
- set |= get_bit(line, 4, 'R', CC_RESET_N);
- ccdbg_write_read(dbg, set);
- }
-}
+static uint8_t mem_instr[] = {
+ MOV_direct_data, 0xfe, 0x02,
+ MOV_direct_data, 0x90, 0xff,
+ MOV_Rn_data(2), 0x10,
+ MOV_Rn_data(0), 0xff,
+ MOV_Rn_data(1), 0xff,
+ DJNZ_Rn_rel(1), 0xfe,
+ DJNZ_Rn_rel(0), 0xfa,
+ DJNZ_Rn_rel(2), 0xf6,
+ MOV_direct_data, 0x90, 0xfd,
+ MOV_Rn_data(2), 0x10,
+ MOV_Rn_data(0), 0xff,
+ MOV_Rn_data(1), 0xff,
+ DJNZ_Rn_rel(1), 0xfe,
+ DJNZ_Rn_rel(0), 0xfa,
+ DJNZ_Rn_rel(2), 0xf6,
+ LJMP, 0xf0, 0x03
+};
+
+static uint8_t jump_mem[] = {
+ 3, LJMP, 0xf0, 0x00,
+ 0
+};
int
main (int argc, char **argv)
struct ccdbg *dbg;
uint8_t status;
uint16_t chip_id;
+ uint16_t pc;
+ uint8_t memory[0x10];
+ int i;
+ struct hex_file *hex;
dbg = ccdbg_open("/dev/ttyUSB0");
if (!dbg)
exit (1);
-#if 0
- _ccdbg_play(dbg, 0, 0);
- _ccdbg_play_many(dbg, 8);
-#endif
- ccdbg_manual(dbg, stdin);
#if 0
+ ccdbg_manual(dbg, stdin);
+#endif
+ hex = ccdbg_hex_file_read(stdin, "<stdin>");
+ if (!hex)
+ exit (1);
+ ccdbg_reset(dbg);
ccdbg_debug_mode(dbg);
status = ccdbg_read_status(dbg);
printf("Status: 0x%02x\n", status);
chip_id = ccdbg_get_chip_id(dbg);
printf("Chip id: 0x%04x\n", chip_id);
- _ccdbg_reset(dbg);
+ status = ccdbg_halt(dbg);
+ printf ("halt status: 0x%02x\n", status);
+
+ ccdbg_write_hex(dbg, hex);
+ ccdbg_hex_file_free(hex);
+ for (i = 0; i < sizeof (memory); i++)
+ printf (" %02x", memory[i]);
+ printf ("\n");
+ ccdbg_execute(dbg, jump_mem);
+ pc = ccdbg_get_pc(dbg);
+ printf ("pc starts at 0x%04x\n", pc);
+ status = ccdbg_resume(dbg);
+ printf ("resume status: 0x%02x\n", status);
+#if 0
+/* ccdbg_execute(dbg, instructions); */
+ ccdbg_write_memory(dbg, 0xf000, mem_instr, sizeof (mem_instr));
+ ccdbg_read_memory(dbg, 0xf000, memory, sizeof (memory));
#endif
ccdbg_close(dbg);
exit (0);
projects / fw / altos / blobdiff