bootInit.c
上传用户:dqzhongke1
上传日期:2022-06-26
资源大小:667k
文件大小:21k
源码类别:

VxWorks

开发平台:

C/C++

  1. /* bootInit.c - ROM initialization module */
  2. /*
  3.  * Copyright (c) 1989-2005 Wind River Systems, Inc.
  4.  *
  5.  * The right to copy, distribute, modify or otherwise make use
  6.  * of this software may be licensed only pursuant to the terms
  7.  * of an applicable Wind River license agreement.
  8.  */
  9. /*
  10. modification history
  11. --------------------
  12. 04u,10apr07,rlg  defect 92458 - problems with the bootline and vxMulti -
  13.                  resolution make sure BOOT_LINE_ADRS is cleared for all arches.
  14. 04t,26jul05,rec  coldfire support
  15. 04s,06sep05,h_k  replaced compressedEntry with sysInit and usrEntry in a
  16.                  comment. (SPR #111954)
  17. 04r,19apr05,h_k  force to call fillLongs() resides in ROM for compressed
  18.                  image. (SPR #108169)
  19. 04q,24feb05,rec  ARM fillLongs should not be volatile - SPR 106411
  20. 04p,04oct04,mdo  Documentation fixes for apigen
  21. 04o,16sep04,j_b  correct RAM clearing (SPR 99727)
  22. 04n,18aug04,j_b  PM_RESERVED_MEM is dependent on INCLUDE_EDR_PM
  23. 04m,11may04,j_b  add support for PM_RESERVED_MEM
  24. 04l,26mar02,sbs  correcting data section relocation for ROM compressed images
  25.                  (SPR 73785)
  26. 04k,19mar02,dat  Removing previous fix for MIPS, no longer needed (72825)
  27. 04j,18jan02,dat  Don't use loop unrolling for MIPS
  28. 04i,22jan02,scm  Xscale specific validation added to update cache (to match
  29.                  updates...)
  30. 04h,19dec01,aeg  prevented pc-relative addressing on MC680X0.
  31. 04g,10dec01,sbs  Corrected conditions around call to copyLongs for ROM
  32.                  resident images.
  33. 04f,27nov01,sbs  Added new labels, wrs_kernel_data_start and wrs_kernel_data_end
  34.                  for sdata and edata respectively. Added second copy for data
  35.                  section of compressed ROM images. Corrected definition for
  36.                  binArrayEnd. Corrected definition for RESIDENT_DATA.
  37. 04e,27nov01,tpw  Manually unroll copyLongs and fillLongs.
  38. 04d,25oct01,pad  Removed definitions of _binArrayStart and _binArrayEnd, now
  39.                  unnecessary.
  40. 04c,03oct01,dee  Merge from ColdFire T2.1.0 release
  41. 04b,11jan01,scm  Xscale specific validation added to update cache, can not assume uncached area....
  42. 04a,10jun99,jpd  fix error when BOOTCODE_IN_RAM defined (SPR #27775).
  43. 03z,13nov98,cdp  make Thumb support for ARM CPUs dependent on ARM_THUMB.
  44. 03y,10feb99,db   Fix to ensure that default bootline gets copied for
  45.                  standalone and rom-resident images(SPR #21763).
  46. 03x,05oct98,jmp  doc: cleanup.
  47. 03w,17apr98,cdp  backed out 04t and made absEntry volatile for ARM.
  48. 03v,16apr98,cdp  for ARM, make UNCOMPRESS entry point in RAM.
  49. 03u,20mar98,cdp  make ROM_COPY_SIZE subject to #ifndef.
  50. 03t,11nov97,cdp  ARM7TDMI_T: force romStart to call entry point in Thumb state.
  51.                  (SPR# 9716)
  52. 03s,14jul97,tam  changed remaining references to bfillLong to fillLong.
  53. 03r,12feb97,dat  Added USER_RESERVED_MEM, SYS_MEM_TOP, SYS_MEM_BOTTOM, SPR 8030
  54. 03q,04feb97,ms   fixed compiler warning about protoype for bcopyLongs.
  55. 03p,28nov96,cdp  added ARM support.
  56. 03o,03sep96,hdn  added the compression support for pc[34]86 BSP.
  57. 03n,19aug96,ms   added UNCMP_RTN macro to use inflate instead of uncompress
  58. 03m,21jun96,jmb  long modhist -- deleted entries prior to 1994.  SPR #6528
  59. 03l,10jun96,tam  added rom resident support for PPC architecture.
  60. 03k,14may96,dat  fixed compiler warnings for copyLongs, fillLongs. SPR #6536
  61. 03j,06mar96,tpr  changed absEntry to be volatile for PowerPC.
  62. 03i,22aug95,hdn  added support for I80X86.
  63. 03h,14mar95,caf  restored mips resident rom support (SPR #3856).
  64. 03g,16feb95,jdi  doc format change.
  65. 03f,23may95,yao  define binArrayStart and binArrayEnd for PowerPC
  66.                  because tools don't prepend "_".
  67. 03e,09dec94,caf  undid mod 03a, use sdata for resident roms (SPR #3856).
  68. 03d,22jun94,caf  undid 16-byte alignment portion of mod 03c, below.
  69. 03c,14jun94,cd   corrected definitions of etext, edata and end.
  70.            +caf  for R4000 resident ROMs: data starts on 16-byte boundary.
  71.                  for R4000 uncompressed ROMs: added volatile to absEntry type.
  72. */
  73. /*
  74. DESCRIPTION
  75. This module provides a generic boot ROM facility.  The target-specific
  76. romInit.s module performs the minimal preliminary board initialization and
  77. then jumps to the C routine romStart().  This routine, still executing out
  78. of ROM, copies the first stage of the startup code to a RAM address and
  79. jumps to it.  The next stage clears memory and then uncompresses the
  80. remainder of ROM into the final VxWorks ROM image in RAM.
  81. A modified version of the Public Domain f3zlibfP library is used to
  82. uncompress the VxWorks boot ROM executable linked with it.  Compressing
  83. object code typically achieves over 55% compression, permitting much
  84. larger systems to be burned into ROM.  The only expense is the added few
  85. seconds delay while the first two stages complete.
  86. ROM AND RAM MEMORY LAYOUT
  87. Example memory layout for a 1-megabyte board:
  88. cs
  89.     --------------  0x00100000 = LOCAL_MEM_SIZE = sysMemTop()
  90.     |            |
  91.     |    RAM     |
  92.     |  0 filled  |
  93.     |            |
  94.     |------------| = (romInit+ROM_COPY_SIZE) or binArrayStart
  95.     | ROM image  |
  96.     |----------- |  0x00090000  = RAM_HIGH_ADRS
  97.     | STACK_SAVE |
  98.     |------------|
  99.     |            |  0x00080000  = 0.5 Megabytes
  100.     |            |
  101.     |            |
  102.     | 0 filled   |
  103.     |            |
  104.     |            |  0x00001000  = RAM_ADRS & RAM_LOW_ADRS
  105.     |            |
  106.     |            |  exc vectors, bp anchor, exc msg, bootline
  107.     |            |
  108.     |            |
  109.     --------------  0x00000000  = LOCAL_MEM_LOCAL_ADRS
  110. ce
  111. cs
  112.     --------------
  113.     |    ROM     |
  114.     |            |  0xff8xxxxx  = binArrayStart
  115.     |            |
  116.     |            |  0xff800008  = ROM_TEXT_ADRS
  117.     --------------  0xff800000  = ROM_BASE_ADRS
  118. ce
  119. SEE ALSO:
  120. inflate(), romInit(), and deflate
  121. AUTHOR
  122. The original compression software for zlib was written by Jean-loup Gailly
  123. and Mark Adler. See the manual pages of inflate and deflate for
  124. more information on their freely available compression software.
  125. */
  126. #include "vxWorks.h"
  127. #include "sysLib.h"
  128. #include "config.h"
  129. #include "errno.h"
  130. #include "sioLib.h"
  131. #define UNCMP_RTN   inflate
  132. #ifndef USER_RESERVED_MEM
  133. #   define USER_RESERVED_MEM 0
  134. #endif
  135. /*
  136.  * If memory is to be cleared, it will be cleared from SYS_MEM_BOTTOM
  137.  * up to (but not including) SYS_MEM_TOP, except for text and data segments.
  138.  * The user reserved area is not cleared.
  139.  */
  140. #ifdef  INCLUDE_EDR_PM
  141. #    define SYS_MEM_TOP 
  142.         (LOCAL_MEM_LOCAL_ADRS + LOCAL_MEM_SIZE - USER_RESERVED_MEM 
  143.          - PM_RESERVED_MEM)
  144. #else
  145. #    define SYS_MEM_TOP 
  146.         (LOCAL_MEM_LOCAL_ADRS + LOCAL_MEM_SIZE - USER_RESERVED_MEM)
  147. #endif
  148. #define SYS_MEM_BOTTOM 
  149.     (LOCAL_MEM_LOCAL_ADRS + RESERVED)
  150. #define BINARRAYEND_ROUNDOFF    (ROUND_DOWN(binArrayEnd, sizeof(long)))
  151. IMPORT void romInit ();
  152. IMPORT STATUS   UNCMP_RTN ();
  153. IMPORT void usrInit ();
  154. IMPORT void sysInitAlt ();
  155. IMPORT void start ();
  156. IMPORT UCHAR    binArrayStart [];   /* compressed binary image */
  157. IMPORT UCHAR    binArrayEnd [];     /* end of compressed binary image */
  158. IMPORT char etext [];       /* defined by the loader */
  159. IMPORT char end [];         /* defined by the loader */
  160. IMPORT UCHAR    wrs_kernel_data_start [];  /* defined by the loader */
  161. IMPORT UCHAR    wrs_kernel_data_end [];    /* defined by the loader */
  162. #if ((CPU_FAMILY == MIPS) || (CPU_FAMILY==PPC) || 
  163.      (CPU_FAMILY==COLDFIRE))
  164. #  define RESIDENT_DATA   RAM_DST_ADRS
  165. #else
  166. #  define RESIDENT_DATA   wrs_kernel_data_start
  167. #endif
  168. #ifndef RAM_DST_ADRS                    /* default uncompress dest. */
  169. #  define RAM_DST_ADRS        RAM_HIGH_ADRS
  170. #endif
  171. /* If the boot code is in RAM and the RAM is already initialized,
  172.  * clearing the RAM is not necessary.  Macro BOOTCODE_IN_RAM is
  173.  * used not to clear the RAM.
  174.  */
  175. #ifdef  BOOTCODE_IN_RAM         /* not to clear RAM */
  176. #  undef  ROM_TEXT_ADRS
  177. #  undef  ROM_BASE_ADRS
  178. #  define ROM_TEXT_ADRS   ((UINT)romInit)
  179. #  define ROM_BASE_ADRS   ((UINT)romInit)
  180. #endif  /* BOOTCODE_IN_RAM */
  181. /* #if  defined (UNCOMPRESS) */
  182. #ifndef ROM_COPY_SIZE
  183. #  define ROM_COPY_SIZE   ((UINT)end - (UINT)romInit)
  184. #endif
  185. /* #endif*/ /* UNCOMPRESS */
  186. #define ROM_OFFSET(adr) (((UINT)adr - (UINT)romInit) + ROM_TEXT_ADRS)
  187. #if !defined (UNCOMPRESS) && !defined (ROM_RESIDENT)
  188. # define LD_IMAGE_END  ((UINT)RAM_DST_ADRS + 
  189.                (UINT)(ROUND_UP(binArrayEnd - binArrayStart, sizeof(long))))
  190. #endif /* !defined (UNCOMPRESS) && !defined (ROM_RESIDENT) */
  191. /* forward declarations */
  192. LOCAL void copyLongs (FAST UINT *source, FAST UINT *destination, UINT nlongs);
  193. #ifndef BOOTCODE_IN_RAM
  194. LOCAL void fillLongs (FAST UINT *buf, UINT nlongs, FAST UINT val);
  195. #endif  /* BOOTCODE_IN_RAM */
  196. #if (CPU==XSCALE)
  197. int checkLongs (FAST UINT *source, FAST UINT *destination, UINT nlongs);
  198. #endif
  199. /*******************************************************************************
  200. *
  201. * romStart - generic ROM initialization
  202. *
  203. * This is the first C code executed after reset.
  204. *
  205. * This routine is called by the assembly start-up code in romInit().
  206. * It clears memory, copies ROM to RAM, and possibly invokes the uncompressor.
  207. * It then jumps to the entry point of the uncompressed object code.
  208. *
  209. * RETURNS: N/A
  210. *
  211. * ERRNO
  212. */
  213. void romStart
  214.     (
  215.     FAST int startType      /* start type */
  216.     )
  217.     {
  218. #if ((CPU_FAMILY==SPARC) || (CPU_FAMILY==MIPS) || (CPU_FAMILY==I80X86) || 
  219.      (CPU_FAMILY==PPC) || (CPU_FAMILY==ARM) || (CPU_FAMILY==COLDFIRE))
  220.     volatile            /* to force absolute addressing */
  221. #endif /* (CPU_FAMILY==SPARC) */
  222.     FUNCPTR absEntry;       /* to avoid PC Relative Jump Subroutine */
  223. #if (CPU_FAMILY==MC680X0) && !defined(ROM_RESIDENT) && !defined(BOOTCODE_IN_RAM)
  224.     volatile VOIDFUNCPTR romcopyLongs = &copyLongs;  /* force call to ROM */
  225. # define copyLongs romcopyLongs
  226. #endif /* (CPU_FAMILY==MC680X0) */
  227.     /*
  228.      * Copy from ROM to RAM, minus the compressed image
  229.      * if compressed boot ROM which relies on binArray
  230.      * appearing last in DATA segment.
  231.      */
  232. #ifdef ROM_RESIDENT
  233.     /* If ROM resident code, then copy only data segment
  234.      * from ROM to RAM, initialize memory and jump
  235.      * to usrInit.
  236.      */
  237. # if  (CPU_FAMILY == SPARC)
  238.     copyLongs ((UINT *)(etext + 8), (UINT *) RESIDENT_DATA,
  239. # else
  240.     copyLongs ((UINT *)etext, (UINT *) RESIDENT_DATA,
  241. # endif
  242.         ((UINT) wrs_kernel_data_end - (UINT) RESIDENT_DATA) / sizeof (long));
  243. #else   /* ROM_RESIDENT */
  244. # ifdef UNCOMPRESS
  245. #  if (CPU_FAMILY == MIPS)
  246.     /*
  247.      * copy text to uncached locations to avoid problems with
  248.      * copy back caches
  249.      */
  250.     ((FUNCPTR)ROM_OFFSET(copyLongs)) (ROM_TEXT_ADRS, (UINT)K0_TO_K1(romInit),
  251.         ROM_COPY_SIZE / sizeof (long));
  252. #  else   /* CPU_FAMILY == MIPS */
  253.     ((FUNCPTR)ROM_OFFSET(copyLongs)) (ROM_TEXT_ADRS, (UINT)romInit,
  254.         ROM_COPY_SIZE / sizeof (long));
  255. #  endif  /* CPU_FAMILY == MIPS */
  256. # else   /* UNCOMPRESS */
  257. #  if (CPU_FAMILY == MIPS)
  258.     /*
  259.      * copy text to uncached locations to avoid problems with
  260.      * copy back caches
  261.      * copy the entire data segment because there is no way to ensure that
  262.      * binArray is the last thing in the data segment because of GP relative
  263.      * addressing
  264.      */
  265.     ((FUNCPTR)ROM_OFFSET(copyLongs)) (ROM_TEXT_ADRS, (UINT)K0_TO_K1(romInit),
  266.         ((UINT)wrs_kernel_data_end - (UINT)romInit) / sizeof (long));
  267. #  else   /* CPU_FAMILY == MIPS */
  268.     ((FUNCPTR)ROM_OFFSET(copyLongs)) (ROM_TEXT_ADRS, (UINT)romInit,
  269.         ((UINT)binArrayStart - (UINT)romInit)/ sizeof (long));
  270.     ((FUNCPTR)ROM_OFFSET(copyLongs))
  271.            ((UINT *)((UINT)ROM_TEXT_ADRS + ((UINT)BINARRAYEND_ROUNDOFF -
  272.            (UINT)romInit)), (UINT *)BINARRAYEND_ROUNDOFF,
  273.            ((UINT)wrs_kernel_data_end - (UINT)binArrayEnd) / sizeof (long));
  274. #   if (CPU==XSCALE)
  275.     /* validate coherence, can not assume uncached area... */
  276.     ((FUNCPTR)ROM_OFFSET(checkLongs))
  277.                  (ROM_TEXT_ADRS, (UINT)romInit,
  278.                  ((UINT)binArrayStart - (UINT)romInit) / sizeof (long));
  279.     ((FUNCPTR)ROM_OFFSET(checkLongs))
  280.            ((UINT *)((UINT)ROM_TEXT_ADRS + ((UINT)BINARRAYEND_ROUNDOFF -
  281.             (UINT)romInit)), (UINT *)BINARRAYEND_ROUNDOFF,
  282.             ((UINT)wrs_kernel_data_end - (UINT)binArrayEnd) / sizeof (long));
  283. #   endif /* CPU==XSCALE */
  284. #  endif  /* CPU_FAMILY == MIPS */
  285. # endif  /* UNCOMPRESS */
  286. #endif  /* ROM_RESIDENT */
  287. #if (CPU_FAMILY != MIPS) && (!defined (BOOTCODE_IN_RAM))
  288.     /* clear all memory if cold booting */
  289.     if (startType & BOOT_CLEAR)
  290.     {
  291. # ifdef ROM_RESIDENT
  292.     /* Clear memory not loaded with text & data.
  293.      *
  294.      * We are careful about initializing all memory (except
  295.      * STACK_SAVE bytes) due to parity error generation (on
  296.      * some hardware) at a later stage.  This is usually
  297.      * caused by read accesses without initialization.
  298.      */
  299.     /* clear from the bottom of memory to the stack */
  300.     fillLongs ((UINT *)SYS_MEM_BOTTOM,
  301.         ((UINT) RESIDENT_DATA - STACK_SAVE - (UINT)SYS_MEM_BOTTOM) /
  302.         sizeof(long), 0);
  303.     /* fill from the load image to the top of memory */
  304.     fillLongs ((UINT *)end, ((UINT)SYS_MEM_TOP - (UINT)end) / sizeof (long), 0);
  305. # else   /* ROM_RESIDENT */
  306. #  if defined (UNCOMPRESS)
  307.     /* clear from the bottom of memory to the stack */
  308.     fillLongs ((UINT *)(SYS_MEM_BOTTOM),
  309.         ((UINT)romInit - STACK_SAVE - (UINT)SYS_MEM_BOTTOM) /
  310.         sizeof(long), 0);
  311.     /* fill from the load image to the top of memory */
  312.     fillLongs ((UINT *)end, ((UINT)SYS_MEM_TOP - (UINT)end) / sizeof (long), 0);
  313. #  else  /* UNCOMPRESS */
  314. #   if (RAM_DST_ADRS == RAM_HIGH_ADRS)
  315.         /* clear from the bottom of memory to the stack */
  316.         fillLongs ((UINT *)(SYS_MEM_BOTTOM),
  317.             ((UINT)romInit - STACK_SAVE - (UINT)SYS_MEM_BOTTOM) /
  318.             sizeof(long), 0);
  319.         /*
  320.         * fill from the end of the load image to the top of memory
  321.         * (end of decompressed image isn't known, so the end of the
  322.         *  compressed image is used -- should still be more efficient than
  323.         *  clearing from RAM_DST_ADRS all the way to the top of memory)
  324.         */
  325.         fillLongs ((UINT *)LD_IMAGE_END,
  326.             ((UINT)SYS_MEM_TOP - LD_IMAGE_END) / sizeof (long), 0);
  327. #   else  /* RAM_DST_ADRS == RAM_HIGH_ADRS */
  328.         /* fill from the bottom of memory to the load image */
  329.         fillLongs ((UINT *)(SYS_MEM_BOTTOM),
  330.         ((UINT)RAM_DST_ADRS - (UINT)SYS_MEM_BOTTOM) / sizeof (long), 0);
  331.         /*
  332.         * fill from the end of the load image to the stack
  333.         * (end of decompressed image isn't known, so the end of the
  334.         *  compressed image is used -- should still be more efficient than
  335.         *  clearing from bottom of memory all the way to the stack)
  336.         */
  337.         fillLongs ((UINT *)LD_IMAGE_END,
  338.             ((UINT)romInit - STACK_SAVE - LD_IMAGE_END) /
  339.             sizeof (long), 0);
  340. #   endif  /* RAM_DST_ADRS == RAM_HIGH_ADRS */
  341. #  endif  /* UNCOMPRESS */
  342. # endif  /* ROM_RESIDENT */
  343.     }
  344. #endif  /* (CPU_FAMILY != MIPS) && (!defined (BOOTCODE_IN_RAM)) */
  345.     if (startType & BOOT_CLEAR)
  346.     {
  347.     /*
  348.      * Ensure the boot line is null. This is necessary for those
  349.      * targets whose boot line is excluded from cleaning.
  350.      */
  351.         *(BOOT_LINE_ADRS) = EOS;
  352.     }
  353.     /* jump to VxWorks entry point (after uncompressing) */
  354. #if defined (UNCOMPRESS) || defined (ROM_RESIDENT)
  355. # if (CPU_FAMILY == I960)
  356.     absEntry = (FUNCPTR)sysInitAlt;         /* reinit proc tbl */
  357. # else
  358.     absEntry = (FUNCPTR)usrInit;            /* on to bootConfig */
  359. # endif  /* CPU_FAMILY == I960 */
  360. #else   /* defined UNCOMPRESS || defined ROM_RESIDENT */
  361.     {
  362. # if (CPU_FAMILY == MIPS)
  363.     volatile FUNCPTR absUncompress = (FUNCPTR) UNCMP_RTN;
  364.     if ((absUncompress) ((UCHAR *)ROM_OFFSET(binArrayStart),
  365.              (UCHAR *)K0_TO_K1(RAM_DST_ADRS),
  366.              (int)((UINT)binArrayEnd - (UINT)binArrayStart)) != OK)
  367. # elif   (CPU_FAMILY == I80X86) || (CPU_FAMILY == ARM) || (CPU_FAMILY == COLDFIRE)
  368.     volatile FUNCPTR absUncompress = (FUNCPTR) UNCMP_RTN;
  369.     if ((absUncompress) ((UCHAR *)ROM_OFFSET(binArrayStart),
  370.                 (UCHAR *)RAM_DST_ADRS, binArrayEnd - binArrayStart) != OK)
  371. # else
  372.     if (UNCMP_RTN ((UCHAR *)ROM_OFFSET(binArrayStart),
  373.                 (UCHAR *)RAM_DST_ADRS, binArrayEnd - binArrayStart) != OK)
  374. # endif  /* (CPU_FAMILY == MIPS) */
  375.     return;     /* if we return then ROM's will halt */
  376.     absEntry = (FUNCPTR)RAM_DST_ADRS;           /* sysInit() or usrEntry() */
  377. # if (CPU_FAMILY != MIPS) && (!defined (BOOTCODE_IN_RAM))
  378.     /* if cold booting, finish clearing memory */
  379.     if (startType & BOOT_CLEAR)
  380.         {
  381. #  if (RAM_DST_ADRS == RAM_HIGH_ADRS)
  382.         /* clear past the stack to the decompressed image */
  383.         ((FUNCPTR)ROM_OFFSET(fillLongs)) ((UINT *)romInit,
  384.             ((UINT)RAM_DST_ADRS - (UINT)romInit) / sizeof(long), 0);
  385. #  else
  386.         /* clear past the stack to the top of memory */
  387.         ((FUNCPTR)ROM_OFFSET(fillLongs)) ((UINT *)romInit,
  388.             ((UINT)SYS_MEM_TOP - (UINT)romInit) / sizeof(long), 0);
  389. #  endif /* RAM_DST_ADRS == RAM_HIGH_ADRS */
  390.         }
  391. # endif  /* (CPU_FAMILY != MIPS) && (!defined (BOOTCODE_IN_RAM)) */
  392.     }
  393. #endif  /* defined UNCOMPRESS || defined ROM_RESIDENT */
  394. #if ((CPU_FAMILY == ARM) && ARM_THUMB)
  395.     absEntry = (FUNCPTR)((UINT32)absEntry | 1);     /* force Thumb state */
  396. #endif  /* CPU_FAMILY == ARM */
  397.     (absEntry) (startType);
  398.     }
  399. #if     (CPU_FAMILY==ARM) && (!defined(ROM_RESIDENT))
  400. # undef fillLongs
  401. #endif  /* (CPU_FAMILY==ARM) */
  402. #if (CPU_FAMILY==MC680X0) && !defined(ROM_RESIDENT) && !defined(BOOTCODE_IN_RAM)
  403. # undef copyLongs    /* undo effects from above define */
  404. #endif /* CPU_FAMILY==MC680X0 */
  405. /*******************************************************************************
  406. *
  407. * copyLongs - copy one buffer to another a long at a time
  408. *
  409. * This routine copies the first <nlongs> longs from <source> to <destination>.
  410. *
  411. * RETURNS:
  412. *
  413. * ERRNO
  414. */
  415. LOCAL void copyLongs 
  416.     (
  417.     source,
  418.     destination,
  419.     nlongs
  420.     )
  421.     FAST UINT *source;      /* pointer to source buffer      */
  422.     FAST UINT *destination; /* pointer to destination buffer */
  423.     UINT nlongs;        /* number of longs to copy       */
  424.     {
  425.     FAST UINT *dstend = destination + nlongs;
  426.     FAST UINT nchunks;
  427.     /* Hop by chunks of longs, for speed. */
  428.     for (nchunks = nlongs / 8; nchunks; --nchunks)
  429.         {
  430. #if (CPU_FAMILY == MC680X0)
  431.         *destination++ = *source++; /* 0 */
  432.         *destination++ = *source++; /* 1 */
  433.         *destination++ = *source++; /* 2 */
  434.         *destination++ = *source++; /* 3 */
  435.         *destination++ = *source++; /* 4 */
  436.         *destination++ = *source++; /* 5 */
  437.         *destination++ = *source++; /* 6 */
  438.         *destination++ = *source++; /* 7 */
  439. #else
  440.         destination[0] = source[0];
  441.         destination[1] = source[1];
  442.         destination[2] = source[2];
  443.         destination[3] = source[3];
  444.         destination[4] = source[4];
  445.         destination[5] = source[5];
  446.         destination[6] = source[6];
  447.         destination[7] = source[7];
  448.         destination += 8, source += 8;
  449. #endif /* CPU_FAMILY == MC680X0 */
  450.         }
  451.     /* Do the remainder one long at a time. */
  452.     while (destination < dstend)
  453.         *destination++ = *source++;
  454.     }
  455. #ifndef BOOTCODE_IN_RAM
  456. /*******************************************************************************
  457. *
  458. * fillLongs - fill a buffer with a value a long at a time
  459. *
  460. * This routine fills the first <nlongs> longs of the buffer with <val>.
  461. *
  462. * RETURNS:
  463. *
  464. * ERRNO
  465. */
  466. LOCAL void fillLongs 
  467.     (
  468.     buf,
  469.     nlongs,
  470.     val
  471.     )
  472.     FAST UINT *buf; /* pointer to buffer              */
  473.     UINT nlongs;    /* number of longs to fill        */
  474.     FAST UINT val;  /* char with which to fill buffer */
  475.     {
  476.     FAST UINT *bufend = buf + nlongs;
  477.     FAST UINT nchunks;
  478.     /* Hop by chunks of longs, for speed. */
  479.     for (nchunks = nlongs / 8; nchunks; --nchunks)
  480.         {
  481. #if (CPU_FAMILY == MC680X0)
  482.         *buf++ = val;   /* 0 */
  483.         *buf++ = val;   /* 1 */
  484.         *buf++ = val;   /* 2 */
  485.         *buf++ = val;   /* 3 */
  486.         *buf++ = val;   /* 4 */
  487.         *buf++ = val;   /* 5 */
  488.         *buf++ = val;   /* 6 */
  489.         *buf++ = val;   /* 7 */
  490. #else
  491.         buf[0] = val;
  492.         buf[1] = val;
  493.         buf[2] = val;
  494.         buf[3] = val;
  495.         buf[4] = val;
  496.         buf[5] = val;
  497.         buf[6] = val;
  498.         buf[7] = val;
  499.         buf += 8;
  500. #endif /* CPU_FAMILY == MC680X0 */
  501.         }
  502.     /* Do the remainder one long at a time. */
  503.     while (buf < bufend)
  504.         *buf++ = val;
  505.     }
  506. #endif  /* BOOTCODE_IN_RAM */
  507. #if (CPU==XSCALE)
  508. int checkLongs (source, destination, nlongs)
  509. FAST UINT *source;          /* pointer to source buffer      */
  510. FAST UINT *destination;     /* pointer to destination buffer */
  511. UINT nlongs;                /* number of longs to copy       */
  512.     {
  513.     int fine = 1;
  514.     FAST UINT *dstend = destination + nlongs;
  515.     while (destination < dstend)
  516.         {
  517.         if (*destination++ != *source++)
  518.             {
  519.             fine = 0;
  520.             break;
  521.             }
  522.         }
  523.     return fine;
  524.     }
  525. #endif