misc.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:6k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * misc.c
  3.  * 
  4.  * This is a collection of several routines from gzip-1.0.3 
  5.  * adapted for Linux.
  6.  *
  7.  * malloc by Hannu Savolainen 1993 and Matthias Urlichs 1994
  8.  *
  9.  * Modified for ARM Linux by Russell King
  10.  *
  11.  * Nicolas Pitre <nico@visuaide.com>  1999/04/14 :
  12.  *  For this code to run directly from Flash, all constant variables must
  13.  *  be marked with 'const' and all other variables initialized at run-time 
  14.  *  only.  This way all non constant variables will end up in the bss segment,
  15.  *  which should point to addresses in RAM and cleared to 0 on start.
  16.  *  This allows for a much quicker boot time.
  17.  */
  18. unsigned int __machine_arch_type;
  19. #include <linux/kernel.h>
  20. #include <asm/uaccess.h>
  21. #include <asm/arch/uncompress.h>
  22. #include <asm/proc/uncompress.h>
  23. #ifdef STANDALONE_DEBUG
  24. #define puts printf
  25. #endif
  26. #define __ptr_t void *
  27. /*
  28.  * Optimised C version of memzero for the ARM.
  29.  */
  30. void __memzero (__ptr_t s, size_t n)
  31. {
  32. union { void *vp; unsigned long *ulp; unsigned char *ucp; } u;
  33. int i;
  34. u.vp = s;
  35. for (i = n >> 5; i > 0; i--) {
  36. *u.ulp++ = 0;
  37. *u.ulp++ = 0;
  38. *u.ulp++ = 0;
  39. *u.ulp++ = 0;
  40. *u.ulp++ = 0;
  41. *u.ulp++ = 0;
  42. *u.ulp++ = 0;
  43. *u.ulp++ = 0;
  44. }
  45. if (n & 1 << 4) {
  46. *u.ulp++ = 0;
  47. *u.ulp++ = 0;
  48. *u.ulp++ = 0;
  49. *u.ulp++ = 0;
  50. }
  51. if (n & 1 << 3) {
  52. *u.ulp++ = 0;
  53. *u.ulp++ = 0;
  54. }
  55. if (n & 1 << 2)
  56. *u.ulp++ = 0;
  57. if (n & 1 << 1) {
  58. *u.ucp++ = 0;
  59. *u.ucp++ = 0;
  60. }
  61. if (n & 1)
  62. *u.ucp++ = 0;
  63. }
  64. static inline __ptr_t memcpy(__ptr_t __dest, __const __ptr_t __src,
  65.     size_t __n)
  66. {
  67. int i = 0;
  68. unsigned char *d = (unsigned char *)__dest, *s = (unsigned char *)__src;
  69. for (i = __n >> 3; i > 0; i--) {
  70. *d++ = *s++;
  71. *d++ = *s++;
  72. *d++ = *s++;
  73. *d++ = *s++;
  74. *d++ = *s++;
  75. *d++ = *s++;
  76. *d++ = *s++;
  77. *d++ = *s++;
  78. }
  79. if (__n & 1 << 2) {
  80. *d++ = *s++;
  81. *d++ = *s++;
  82. *d++ = *s++;
  83. *d++ = *s++;
  84. }
  85. if (__n & 1 << 1) {
  86. *d++ = *s++;
  87. *d++ = *s++;
  88. }
  89. if (__n & 1)
  90. *d++ = *s++;
  91. return __dest;
  92. }
  93. /*
  94.  * gzip delarations
  95.  */
  96. #define OF(args)  args
  97. #define STATIC static
  98. typedef unsigned char  uch;
  99. typedef unsigned short ush;
  100. typedef unsigned long  ulg;
  101. #define WSIZE 0x8000 /* Window size must be at least 32k, */
  102. /* and a power of two */
  103. static uch *inbuf; /* input buffer */
  104. static uch window[WSIZE]; /* Sliding window buffer */
  105. static unsigned insize; /* valid bytes in inbuf */
  106. static unsigned inptr; /* index of next byte to be processed in inbuf */
  107. static unsigned outcnt; /* bytes in output buffer */
  108. /* gzip flag byte */
  109. #define ASCII_FLAG   0x01 /* bit 0 set: file probably ascii text */
  110. #define CONTINUATION 0x02 /* bit 1 set: continuation of multi-part gzip file */
  111. #define EXTRA_FIELD  0x04 /* bit 2 set: extra field present */
  112. #define ORIG_NAME    0x08 /* bit 3 set: original file name present */
  113. #define COMMENT      0x10 /* bit 4 set: file comment present */
  114. #define ENCRYPTED    0x20 /* bit 5 set: file is encrypted */
  115. #define RESERVED     0xC0 /* bit 6,7:   reserved */
  116. #define get_byte()  (inptr < insize ? inbuf[inptr++] : fill_inbuf())
  117. /* Diagnostic functions */
  118. #ifdef DEBUG
  119. #  define Assert(cond,msg) {if(!(cond)) error(msg);}
  120. #  define Trace(x) fprintf x
  121. #  define Tracev(x) {if (verbose) fprintf x ;}
  122. #  define Tracevv(x) {if (verbose>1) fprintf x ;}
  123. #  define Tracec(c,x) {if (verbose && (c)) fprintf x ;}
  124. #  define Tracecv(c,x) {if (verbose>1 && (c)) fprintf x ;}
  125. #else
  126. #  define Assert(cond,msg)
  127. #  define Trace(x)
  128. #  define Tracev(x)
  129. #  define Tracevv(x)
  130. #  define Tracec(c,x)
  131. #  define Tracecv(c,x)
  132. #endif
  133. static int  fill_inbuf(void);
  134. static void flush_window(void);
  135. static void error(char *m);
  136. static void gzip_mark(void **);
  137. static void gzip_release(void **);
  138. extern char input_data[];
  139. extern char input_data_end[];
  140. static uch *output_data;
  141. static ulg output_ptr;
  142. static ulg bytes_out;
  143. static void *malloc(int size);
  144. static void free(void *where);
  145. static void error(char *m);
  146. static void gzip_mark(void **);
  147. static void gzip_release(void **);
  148. static void puts(const char *);
  149. extern int end;
  150. static ulg free_mem_ptr;
  151. static ulg free_mem_ptr_end;
  152. #define HEAP_SIZE 0x2000
  153. #include "../../../../lib/inflate.c"
  154. #ifndef STANDALONE_DEBUG
  155. static void *malloc(int size)
  156. {
  157. void *p;
  158. if (size <0) error("Malloc errorn");
  159. if (free_mem_ptr <= 0) error("Memory errorn");
  160. free_mem_ptr = (free_mem_ptr + 3) & ~3; /* Align */
  161. p = (void *)free_mem_ptr;
  162. free_mem_ptr += size;
  163. if (free_mem_ptr >= free_mem_ptr_end)
  164. error("Out of memory");
  165. return p;
  166. }
  167. static void free(void *where)
  168. { /* gzip_mark & gzip_release do the free */
  169. }
  170. static void gzip_mark(void **ptr)
  171. {
  172. arch_decomp_wdog();
  173. *ptr = (void *) free_mem_ptr;
  174. }
  175. static void gzip_release(void **ptr)
  176. {
  177. arch_decomp_wdog();
  178. free_mem_ptr = (long) *ptr;
  179. }
  180. #else
  181. static void gzip_mark(void **ptr)
  182. {
  183. }
  184. static void gzip_release(void **ptr)
  185. {
  186. }
  187. #endif
  188. /* ===========================================================================
  189.  * Fill the input buffer. This is called only when the buffer is empty
  190.  * and at least one byte is really needed.
  191.  */
  192. int fill_inbuf(void)
  193. {
  194. if (insize != 0)
  195. error("ran out of input datan");
  196. inbuf = input_data;
  197. insize = &input_data_end[0] - &input_data[0];
  198. inptr = 1;
  199. return inbuf[0];
  200. }
  201. /* ===========================================================================
  202.  * Write the output window window[0..outcnt-1] and update crc and bytes_out.
  203.  * (Used for the decompressed data only.)
  204.  */
  205. void flush_window(void)
  206. {
  207. ulg c = crc;
  208. unsigned n;
  209. uch *in, *out, ch;
  210. in = window;
  211. out = &output_data[output_ptr];
  212. for (n = 0; n < outcnt; n++) {
  213. ch = *out++ = *in++;
  214. c = crc_32_tab[((int)c ^ ch) & 0xff] ^ (c >> 8);
  215. }
  216. crc = c;
  217. bytes_out += (ulg)outcnt;
  218. output_ptr += (ulg)outcnt;
  219. outcnt = 0;
  220. puts(".");
  221. }
  222. static void error(char *x)
  223. {
  224. int ptr;
  225. puts("nn");
  226. puts(x);
  227. puts("nn -- System halted");
  228. while(1); /* Halt */
  229. }
  230. #ifndef STANDALONE_DEBUG
  231. ulg
  232. decompress_kernel(ulg output_start, ulg free_mem_ptr_p, ulg free_mem_ptr_end_p,
  233.   int arch_id)
  234. {
  235. output_data = (uch *)output_start; /* Points to kernel start */
  236. free_mem_ptr = free_mem_ptr_p;
  237. free_mem_ptr_end = free_mem_ptr_end_p;
  238. __machine_arch_type = arch_id;
  239. proc_decomp_setup();
  240. arch_decomp_setup();
  241. makecrc();
  242. puts("Uncompressing Linux...");
  243. gunzip();
  244. puts(" done, booting the kernel.n");
  245. return output_ptr;
  246. }
  247. #else
  248. char output_buffer[1500*1024];
  249. int main()
  250. {
  251. output_data = output_buffer;
  252. makecrc();
  253. puts("Uncompressing Linux...");
  254. gunzip();
  255. puts("done.n");
  256. return 0;
  257. }
  258. #endif