git.gag.com Git - fw/altos/blob - lib/ccdbg-memory.c

   1 /*
   2  * Copyright © 2008 Keith Packard <keithp@keithp.com>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along
  15  * with this program; if not, write to the Free Software Foundation, Inc.,
  16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  17  */
  18
  19 #include "ccdbg.h"
  20
  21 /*
  22  * Read and write arbitrary memory through the debug port
  23  */
  24
  25 static uint8_t  memory_init[] = {
  26         3,      MOV_DPTR_data16,        0,      0,
  27 #define HIGH_START      2
  28 #define LOW_START       3
  29         0,
  30 };
  31
  32
  33 static uint8_t write8[] = {
  34         2,      MOV_A_data,     0,
  35 #define DATA_BYTE       2
  36         1,      MOVX_atDPTR_A,
  37         1,      INC_DPTR,
  38         0
  39 };
  40
  41 static uint8_t read8[] = {
  42         1,      MOVX_A_atDPTR,
  43         1,      INC_DPTR,
  44         0,
  45 };
  46
  47 uint8_t
  48 ccdbg_write_memory(struct ccdbg *dbg, uint16_t addr, uint8_t *bytes, int nbytes)
  49 {
  50         int i, nl = 0;
  51         memory_init[HIGH_START] = addr >> 8;
  52         memory_init[LOW_START] = addr;
  53         (void) ccdbg_execute(dbg, memory_init);
  54         for (i = 0; i < nbytes; i++) {
  55                 write8[DATA_BYTE] = *bytes++;
  56                 ccdbg_execute(dbg, write8);
  57                 if ((i & 0xf) == 0xf) {
  58                         ccdbg_debug(CC_DEBUG_MEMORY, ".");
  59                         ccdbg_flush();
  60                         nl = 1;
  61                 }
  62                 if ((i & 0xff) == 0xff) {
  63                         ccdbg_debug(CC_DEBUG_MEMORY, "\n");
  64                         nl = 0;
  65                 }
  66         }
  67         if (nl)
  68                 ccdbg_debug(CC_DEBUG_MEMORY, "\n");
  69         return 0;
  70 }
  71
  72 uint8_t
  73 ccdbg_read_memory(struct ccdbg *dbg, uint16_t addr, uint8_t *bytes, int nbytes)
  74 {
  75         int i, nl = 0;
  76         memory_init[HIGH_START] = addr >> 8;
  77         memory_init[LOW_START] = addr;
  78         (void) ccdbg_execute(dbg, memory_init);
  79         for (i = 0; i < nbytes; i++) {
  80                 *bytes++ = ccdbg_execute(dbg, read8);
  81                 if ((i & 0xf) == 0xf) {
  82                         ccdbg_debug(CC_DEBUG_MEMORY, ".");
  83                         ccdbg_flush();
  84                         nl = 1;
  85                 }
  86                 if ((i & 0xff) == 0xff) {
  87                         ccdbg_debug(CC_DEBUG_MEMORY, "\n");
  88                         nl = 0;
  89                 }
  90         }
  91         if (nl)
  92                 ccdbg_debug(CC_DEBUG_MEMORY, "\n");
  93         return 0;
  94 }
  95
  96 uint8_t
  97 ccdbg_write_uint8(struct ccdbg *dbg, uint16_t addr, uint8_t byte)
  98 {
  99         return ccdbg_write_memory(dbg, addr, &byte, 1);
 100 }
 101
 102 uint8_t
 103 ccdbg_write_hex_image(struct ccdbg *dbg, struct hex_image *image, uint16_t offset)
 104 {
 105         ccdbg_write_memory(dbg, image->address + offset, image->data, image->length);
 106         return 0;
 107 }
 108
 109 struct hex_image *
 110 ccdbg_read_hex_image(struct ccdbg *dbg, uint16_t address, uint16_t length)
 111 {
 112         struct hex_image *image;
 113
 114         image = calloc(sizeof(struct hex_image) + length, 1);
 115         image->address = address;
 116         image->length = length;
 117         memset(image->data, 0xff, length);
 118         ccdbg_read_memory(dbg, address, image->data, length);
 119         return image;
 120 }