packages/redboot/v2_0/src/mcopy.c

   1 //==========================================================================
   2 //
   3 //      mcopy.c
   4 //
   5 //      RedBoot memory copy (mcopy) routine
   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, 2003 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):    msalter
  44 // Contributors: msalter
  45 // Date:         2003-07-01
  46 // Purpose:
  47 // Description:
  48 //
  49 // This code is part of RedBoot (tm).
  50 //
  51 //####DESCRIPTIONEND####
  52 //
  53 //==========================================================================
  54
  55 #include <redboot.h>
  56
  57 static void
  58 do_mcopy(int argc, char *argv[])
  59 {
  60     struct option_info opts[6];
  61     unsigned long src, dst, len, end;
  62     bool src_set, dst_set, len_set;
  63     bool sz32, sz16, sz8;
  64     int incr = 1;
  65
  66     init_opts(&opts[0], 's', true, OPTION_ARG_TYPE_NUM,
  67               (void *)&src, (bool *)&src_set, "base address");
  68     init_opts(&opts[1], 'l', true, OPTION_ARG_TYPE_NUM,
  69               (void *)&len, (bool *)&len_set, "length");
  70     init_opts(&opts[2], 'd', true, OPTION_ARG_TYPE_NUM,
  71               (void *)&dst, (bool *)&dst_set, "base address");
  72     init_opts(&opts[3], '4', false, OPTION_ARG_TYPE_FLG,
  73               (void *)&sz32, (bool *)0, "copy 32 bit data");
  74     init_opts(&opts[4], '2', false, OPTION_ARG_TYPE_FLG,
  75               (void *)&sz16, (bool *)0, "copy 16 bit data");
  76     init_opts(&opts[5], '1', false, OPTION_ARG_TYPE_FLG,
  77               (void *)&sz8, (bool *)0, "copy 8 bit data");
  78     if (!scan_opts(argc, argv, 1, opts, 6, 0, 0, "")) {
  79         return;
  80     }
  81
  82     // Must have src, dst, len. No more than one size specifier.
  83     if (!src_set || !dst_set || !len_set || (sz32 + sz16 + sz8) > 1) {
  84         diag_printf("usage: mcopy -s <addr> -d <addr> -l <length> [-1|-2|-4]\n");
  85         return;
  86     }
  87
  88     // adjust incr and len for data size
  89     if (sz16) {
  90         len = (len + 1) & ~1;
  91         incr = 2;
  92     } else if (sz32 || !sz8) {
  93         len = (len + 3) & ~3;
  94         incr = 4;
  95     }
  96
  97     end = src + len;
  98
  99     // If overlapping areas, must copy backwards.
 100     if (dst > src && dst < (src + len)) {
 101         end = src - incr;
 102         src += (len - incr);
 103         dst += (len - incr);
 104         incr = -incr;
 105     }
 106
 107     if (sz8) {
 108         while (src != end) {
 109             *(cyg_uint8 *)dst = *(cyg_uint8 *)src;
 110             src += incr;
 111             dst += incr;
 112         }
 113     } else if (sz16) {
 114         while (src != end) {
 115             *(cyg_uint16 *)dst = *(cyg_uint16 *)src;
 116             src += incr;
 117             dst += incr;
 118         }
 119     } else {
 120         // Default - 32 bits
 121         while (src != end) {
 122             *(cyg_uint32 *)dst = *(cyg_uint32 *)src;
 123             src += incr;
 124             dst += incr;
 125         }
 126     }
 127 }
 128
 129
 130 RedBoot_cmd("mcopy",
 131             "Copy memory from one address to another",
 132             "-s <location> -d <location> -l <length> [-1|-2|-4]",
 133             do_mcopy
 134     );