packages/cygmon/v2_0/misc/bsp/common/generic-mem.c

   1 //==========================================================================
   2 //
   3 //      generic-mem.c
   4 //
   5 //      Generic support for safe memory read/write.
   6 //
   7 //==========================================================================
   8 //####ECOSGPLCOPYRIGHTBEGIN####
   9 // -------------------------------------------
  10 // This file is part of eCos, the Embedded Configurable Operating System.
  11 // Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
  12 //
  13 // eCos is free software; you can redistribute it and/or modify it under
  14 // the terms of the GNU General Public License as published by the Free
  15 // Software Foundation; either version 2 or (at your option) any later version.
  16 //
  17 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY
  18 // WARRANTY; without even the implied warranty of MERCHANTABILITY or
  19 // FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  20 // for more details.
  21 //
  22 // You should have received a copy of the GNU General Public License along
  23 // with eCos; if not, write to the Free Software Foundation, Inc.,
  24 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  25 //
  26 // As a special exception, if other files instantiate templates or use macros
  27 // or inline functions from this file, or you compile this file and link it
  28 // with other works to produce a work based on this file, this file does not
  29 // by itself cause the resulting work to be covered by the GNU General Public
  30 // License. However the source code for this file must still be made available
  31 // in accordance with section (3) of the GNU General Public License.
  32 //
  33 // This exception does not invalidate any other reasons why a work based on
  34 // this file might be covered by the GNU General Public License.
  35 //
  36 // Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
  37 // at http://sources.redhat.com/ecos/ecos-license/
  38 // -------------------------------------------
  39 //####ECOSGPLCOPYRIGHTEND####
  40 //==========================================================================
  41 //#####DESCRIPTIONBEGIN####
  42 //
  43 // Author(s):
  44 // Contributors: gthomas
  45 // Date:         1999-10-20
  46 // Purpose:      Generic support for safe memory read/write.
  47 // Description:  Some targets may need to provide their own version.
  48 //
  49 //
  50 //####DESCRIPTIONEND####
  51 //
  52 //=========================================================================
  53
  54 #include <stdlib.h>
  55 #include <setjmp.h>
  56 #include <bsp/bsp.h>
  57
  58 typedef void (*moveproc_t)(void *s, void *d);
  59
  60 static jmp_buf __errjmp;
  61
  62 /*
  63  * These are globals because we want them preserved
  64  * across function calls.
  65  */
  66 static bsp_handler_t __oldtrap;
  67 static int __done;
  68
  69
  70 static void
  71 move_8(void *src, void *dest)
  72 {
  73     *(char *)dest = *(char *)src;
  74 }
  75
  76
  77 static void
  78 move_16(void *src, void *dest)
  79 {
  80     *(short *)dest = *(short *)src;
  81 }
  82
  83
  84 static void
  85 move_32(void *src, void *dest)
  86 {
  87     *(int *)dest = *(int *)src;
  88 }
  89
  90
  91 static int
  92 err_trap(int exc_nr, void *regs)
  93 {
  94     longjmp(__errjmp, 1);
  95 }
  96
  97
  98 int
  99 bsp_memory_read(void *addr,    /* start addr of memory to read */
 100                 int  asid,     /* address space id */
 101                 int  rsize,    /* size of individual read operation */
 102                 int  nreads,   /* number of read operations */
 103                 void *buf)     /* result buffer */
 104 {
 105     if (nreads <= 0)
 106         return 0;
 107
 108     __oldtrap = bsp_install_dbg_handler(err_trap);
 109
 110     if (setjmp(__errjmp) == 0) {
 111         moveproc_t move_mem;
 112         int        incr;
 113         char       *src, *dest;
 114
 115         switch (rsize) {
 116           case 8:
 117             move_mem = move_8;
 118             incr = 1;
 119             break;
 120           case 16:
 121             move_mem = move_16;
 122             incr = 2;
 123             break;
 124           case 32:
 125             move_mem = move_32;
 126             incr = 4;
 127             break;
 128           default:
 129             (void)bsp_install_dbg_handler(__oldtrap);
 130             return 0;
 131         }
 132
 133         src = addr;
 134         dest = buf;
 135
 136         for (__done = 0; __done < nreads; __done++) {
 137             move_mem(src, dest);
 138             src  += incr;
 139             dest += incr;
 140         }
 141     }
 142
 143     (void)bsp_install_dbg_handler(__oldtrap);
 144     return __done;
 145 }
 146
 147
 148 int bsp_memory_write(void *addr,   /* start addr of memory to write */
 149                      int  asid,    /* address space id */
 150                      int  wsize,   /* size of individual write operation */
 151                      int  nwrites, /* number of write operations */
 152                      void *buf)    /* source buffer for write data */
 153 {
 154     if (nwrites <= 0)
 155         return 0;
 156
 157     __oldtrap = bsp_install_dbg_handler(err_trap);
 158
 159     if (setjmp(__errjmp) == 0) {
 160         moveproc_t move_mem;
 161         int        incr;
 162         char       *src, *dest;
 163
 164         switch (wsize) {
 165           case 8:
 166             move_mem = move_8;
 167             incr = 1;
 168             break;
 169           case 16:
 170             move_mem = move_16;
 171             incr = 2;
 172             break;
 173           case 32:
 174             move_mem = move_32;
 175             incr = 4;
 176             break;
 177           default:
 178             (void)bsp_install_dbg_handler(__oldtrap);
 179             return 0;
 180         }
 181
 182         src = buf;
 183         dest = addr;
 184
 185         for (__done = 0; __done < nwrites; __done++) {
 186             move_mem(src, dest);
 187             src  += incr;
 188             dest += incr;
 189         }
 190     }
 191
 192     (void)bsp_install_dbg_handler(__oldtrap);
 193     return __done;
 194 }