Add ability to read/write arbitrary memory. Write LED blinker program.
[fw/altos] / ccdbg.c
diff --git a/ccdbg.c b/ccdbg.c
index 64cb768f4447f1fbb2e798005739489de590b565..a35481438bc4db6b8897d95429a219df4d87679e 100644 (file)
--- a/ccdbg.c
+++ b/ccdbg.c
 
 #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;
-
-       cccp_write(dbg, CC_DATA|CC_CLOCK|CC_RESET_N, set);
-       get = cccp_read_all(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;
-}
+#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_debug_mode(struct ccdbg *dbg)
-{
-       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);
-}
+#if 0
+static uint8_t instructions[] = {
+       3, MOV_direct_data, 0xfe, 0x02,
+       3, MOV_direct_data, 0x90, 0xff,
+       0
+};
+#endif
 
-static void
-ccdbg_manual(struct ccdbg *dbg, FILE *input)
-{
-       char    line[80];
-       uint8_t 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
+};
 
-       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 jump_mem[] = {
+       3, LJMP, 0xf0, 0x00,
+       0
+};
 
 int
 main (int argc, char **argv)
@@ -101,19 +61,37 @@ main (int argc, char **argv)
        struct ccdbg    *dbg;
        uint8_t         status;
        uint16_t        chip_id;
+       uint16_t        pc;
+       uint8_t         memory[0x10];
+       int             i;
 
        dbg = ccdbg_open("/dev/ttyUSB0");
        if (!dbg)
                exit (1);
+#if 0
        ccdbg_manual(dbg, stdin);
-#if 0  
+#endif
+#if 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);
+       status = ccdbg_halt(dbg);
+       printf ("halt status: 0x%02x\n", status);
+/*     ccdbg_execute(dbg, instructions); */
+       ccdbg_write_memory(dbg, 0xf000, mem_instr, sizeof (mem_instr));
+       ccdbg_read_memory(dbg, 0xf000, memory, sizeof (memory));
+       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);
 #endif
-       _ccdbg_reset(dbg);
        ccdbg_close(dbg);
        exit (0);
 }