Trim down peak calculation a bit.
[kugel-rb.git] / firmware / rolo.c
blob69166785ad13aa046f4beeafb4f9d8d3ae6fd3dd
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
10 * Copyright (C) 2002 Randy D. Wood
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version 2
15 * of the License, or (at your option) any later version.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
22 #include "config.h"
23 #include "lcd.h"
24 #include "lcd-remote.h"
25 #include "thread.h"
26 #include "kernel.h"
27 #include "button.h"
28 #include "file.h"
29 #include "audio.h"
30 #include "system.h"
31 #include "i2c.h"
32 #include "adc.h"
33 #include "string.h"
34 #include "buffer.h"
35 #include "storage.h"
36 #include "rolo.h"
38 #ifdef MI4_FORMAT
39 #include "crc32-mi4.h"
40 #undef FIRMWARE_OFFSET_FILE_CRC
41 #undef FIRMWARE_OFFSET_FILE_DATA
42 #define FIRMWARE_OFFSET_FILE_CRC 0xC
43 #define FIRMWARE_OFFSET_FILE_DATA 0x200
44 #endif
46 #if !defined(IRIVER_IFP7XX_SERIES)
47 /* FIX: this doesn't work on iFP */
49 #define IRQ0_EDGE_TRIGGER 0x80
51 #ifdef CPU_PP
52 /* Handle the COP properly - it needs to jump to a function outside SDRAM while
53 * the new firmware is being loaded, and then jump to the start of SDRAM
54 * TODO: Use the mailboxes built into the PP processor for this
57 #if NUM_CORES > 1
58 volatile unsigned char IDATA_ATTR cpu_message = 0;
59 volatile unsigned char IDATA_ATTR cpu_reply = 0;
60 extern int cop_idlestackbegin[];
62 void rolo_restart_cop(void) ICODE_ATTR;
63 void rolo_restart_cop(void)
65 if (CURRENT_CORE == CPU)
67 /* There should be free thread slots aplenty */
68 create_thread(rolo_restart_cop, cop_idlestackbegin, IDLE_STACK_SIZE,
69 0, "rolo COP" IF_PRIO(, PRIORITY_REALTIME)
70 IF_COP(, COP));
71 return;
74 COP_INT_DIS = -1;
76 /* Invalidate cache */
77 cpucache_invalidate();
79 /* Disable cache */
80 CACHE_CTL = CACHE_CTL_DISABLE;
82 /* Tell the main core that we're ready to reload */
83 cpu_reply = 1;
85 /* Wait while RoLo loads the image into SDRAM */
86 /* TODO: Accept checksum failure gracefully */
87 while(cpu_message != 1);
89 /* Acknowledge the CPU and then reload */
90 cpu_reply = 2;
92 asm volatile(
93 "mov r0, %0 \n"
94 "mov pc, r0 \n"
95 : : "I"(DRAM_START)
98 #endif /* NUM_CORES > 1 */
99 #endif /* CPU_PP */
101 static void rolo_error(const char *text)
103 lcd_clear_display();
104 lcd_puts(0, 0, "ROLO error:");
105 lcd_puts_scroll(0, 1, text);
106 lcd_update();
107 button_get(true);
108 button_get(true);
109 button_get(true);
110 lcd_stop_scroll();
113 #if CONFIG_CPU == SH7034 || CONFIG_CPU == IMX31L
114 /* these are in assembler file "descramble.S" for SH7034 */
115 extern unsigned short descramble(const unsigned char* source,
116 unsigned char* dest, int length);
117 /* this is in firmware/target/arm/imx31/rolo_restart.c for IMX31 */
118 extern void rolo_restart(const unsigned char* source, unsigned char* dest,
119 int length);
120 #else
122 /* explicitly put this code in iram, ICODE_ATTR is defined to be null for some
123 targets that are low on iram, like the gigabeat F/X */
124 void rolo_restart(const unsigned char* source, unsigned char* dest,
125 long length) __attribute__ ((section(".icode")));
126 void rolo_restart(const unsigned char* source, unsigned char* dest,
127 long length)
129 long i;
130 unsigned char* localdest = dest;
132 /* This is the equivalent of a call to memcpy() but this must be done from
133 iram to avoid overwriting itself and we don't want to depend on memcpy()
134 always being in iram */
135 for(i = 0;i < length;i++)
136 *localdest++ = *source++;
138 #if defined(CPU_COLDFIRE)
139 asm (
140 "movec.l %0,%%vbr \n"
141 "move.l (%0)+,%%sp \n"
142 "move.l (%0),%0 \n"
143 "jmp (%0) \n"
144 : : "a"(dest)
146 #elif defined(CPU_PP)
147 CPU_INT_DIS = -1;
149 /* Flush cache */
150 cpucache_flush();
152 /* Disable cache */
153 CACHE_CTL = CACHE_CTL_DISABLE;
155 /* Reset the memory mapping registers to zero */
157 volatile unsigned long *mmap_reg;
158 for (mmap_reg = &MMAP_FIRST; mmap_reg <= &MMAP_LAST; mmap_reg++)
159 *mmap_reg = 0;
162 #if NUM_CORES > 1
163 /* Tell the COP it's safe to continue rebooting */
164 cpu_message = 1;
166 /* Wait for the COP to tell us it is rebooting */
167 while(cpu_reply != 2);
168 #endif
170 asm volatile(
171 "mov pc, %0 \n"
172 : : "r"(DRAM_START)
175 #elif defined(CPU_ARM)
176 #ifdef HAVE_CPUCACHE_INVALIDATE
177 /* Flush and invalidate caches */
178 cpucache_invalidate();
179 #endif
180 asm volatile(
181 "mov pc, %0 \n"
182 : : "r"(dest)
184 #elif defined(CPU_MIPS)
185 __dcache_writeback_all();
186 asm volatile(
187 "jr %0 \n"
188 : : "r"(dest)
190 #endif
192 #endif
194 /* This is assigned in the linker control file */
195 extern unsigned long loadaddress;
197 /***************************************************************************
199 * Name: rolo_load_app(char *filename,int scrambled)
200 * Filename must be a fully defined filename including the path and extension
202 ***************************************************************************/
203 int rolo_load(const char* filename)
205 int fd;
206 long length;
207 #if defined(CPU_COLDFIRE) || defined(CPU_ARM) || defined(CPU_MIPS)
208 #if !defined(MI4_FORMAT)
209 int i;
210 #endif
211 unsigned long checksum,file_checksum;
212 #else
213 long file_length;
214 unsigned short checksum,file_checksum;
215 #endif
216 unsigned char* ramstart = (void*)&loadaddress;
218 lcd_clear_display();
219 lcd_puts(0, 0, "ROLO...");
220 lcd_puts(0, 1, "Loading");
221 lcd_update();
222 #ifdef HAVE_REMOTE_LCD
223 lcd_remote_clear_display();
224 lcd_remote_puts(0, 0, "ROLO...");
225 lcd_remote_puts(0, 1, "Loading");
226 lcd_remote_update();
227 #endif
229 audio_stop();
231 fd = open(filename, O_RDONLY);
232 if(-1 == fd) {
233 rolo_error("File not found");
234 return -1;
237 length = filesize(fd) - FIRMWARE_OFFSET_FILE_DATA;
239 #if CONFIG_CPU != SH7034
240 /* Read and save checksum */
241 lseek(fd, FIRMWARE_OFFSET_FILE_CRC, SEEK_SET);
242 if (read(fd, &file_checksum, 4) != 4) {
243 rolo_error("Error Reading checksum");
244 return -1;
247 #if !defined(MI4_FORMAT)
248 /* Rockbox checksums are big-endian */
249 file_checksum = betoh32(file_checksum);
250 #endif
252 #if defined(CPU_PP) && NUM_CORES > 1
253 lcd_puts(0, 2, "Waiting for coprocessor...");
254 lcd_update();
255 rolo_restart_cop();
256 /* Wait for COP to be in safe code */
257 while(cpu_reply != 1);
258 lcd_puts(0, 2, " ");
259 lcd_update();
260 #endif
262 lseek(fd, FIRMWARE_OFFSET_FILE_DATA, SEEK_SET);
264 if (read(fd, audiobuf, length) != length) {
265 rolo_error("Error Reading File");
266 return -1;
269 #ifdef MI4_FORMAT
270 /* Check CRC32 to see if we have a valid file */
271 chksum_crc32gentab();
272 checksum = chksum_crc32 (audiobuf, length);
273 #else
274 checksum = MODEL_NUMBER;
276 for(i = 0;i < length;i++) {
277 checksum += audiobuf[i];
279 #endif
281 /* Verify checksum against file header */
282 if (checksum != file_checksum) {
283 rolo_error("Checksum Error");
284 return -1;
287 #ifdef HAVE_STORAGE_FLUSH
288 lcd_puts(0, 1, "Flushing storage buffers");
289 lcd_update();
290 storage_flush();
291 #endif
293 lcd_puts(0, 1, "Executing");
294 lcd_update();
295 #ifdef HAVE_REMOTE_LCD
296 lcd_remote_puts(0, 1, "Executing");
297 lcd_remote_update();
298 #endif
299 adc_close();
301 #if CONFIG_CPU != IMX31L /* We're not finished yet */
302 #ifdef CPU_ARM
303 /* Should do these together since some ARM version should never have
304 * FIQ disabled and not IRQ (imx31 errata). */
305 disable_interrupt(IRQ_FIQ_STATUS);
306 #else
307 /* Some targets have a higher disable level than HIGEST_IRQ_LEVEL */
308 set_irq_level(DISABLE_INTERRUPTS);
309 #endif
310 #endif /* CONFIG_CPU == IMX31L */
312 #else /* CONFIG_CPU == SH7034 */
313 /* Read file length from header and compare to real file length */
314 lseek(fd, FIRMWARE_OFFSET_FILE_LENGTH, SEEK_SET);
315 if(read(fd, &file_length, 4) != 4) {
316 rolo_error("Error Reading File Length");
317 return -1;
319 if (length != file_length) {
320 rolo_error("File length mismatch");
321 return -1;
324 /* Read and save checksum */
325 lseek(fd, FIRMWARE_OFFSET_FILE_CRC, SEEK_SET);
326 if (read(fd, &file_checksum, 2) != 2) {
327 rolo_error("Error Reading checksum");
328 return -1;
330 lseek(fd, FIRMWARE_OFFSET_FILE_DATA, SEEK_SET);
332 /* verify that file can be read and descrambled */
333 if ((audiobuf + (2*length)+4) >= audiobufend) {
334 rolo_error("Not enough room to load file");
335 return -1;
338 if (read(fd, &audiobuf[length], length) != (int)length) {
339 rolo_error("Error Reading File");
340 return -1;
343 lcd_puts(0, 1, "Descramble");
344 lcd_update();
346 checksum = descramble(audiobuf + length, audiobuf, length);
348 /* Verify checksum against file header */
349 if (checksum != file_checksum) {
350 rolo_error("Checksum Error");
351 return -1;
354 #ifdef HAVE_STORAGE_FLUSH
355 lcd_puts(0, 1, "Flushing ");
356 lcd_update();
357 storage_flush();
358 #endif
360 lcd_puts(0, 1, "Executing ");
361 lcd_update();
363 set_irq_level(HIGHEST_IRQ_LEVEL);
365 /* Calling these 2 initialization routines was necessary to get the
366 the origional Archos version of the firmware to load and execute. */
367 system_init(); /* Initialize system for restart */
368 i2c_init(); /* Init i2c bus - it seems like a good idea */
369 ICR = IRQ0_EDGE_TRIGGER; /* Make IRQ0 edge triggered */
370 TSTR = 0xE0; /* disable all timers */
371 /* model-specific de-init, needed when flashed */
372 /* Especially the Archos software is picky about this */
373 #if defined(ARCHOS_RECORDER) || defined(ARCHOS_RECORDERV2) || \
374 defined(ARCHOS_FMRECORDER)
375 PAIOR = 0x0FA0;
376 #endif
377 #endif
378 rolo_restart(audiobuf, ramstart, length);
380 return 0; /* this is never reached */
381 (void)checksum; (void)file_checksum;
383 #else /* !defined(IRIVER_IFP7XX_SERIES) */
384 int rolo_load(const char* filename)
386 /* dummy */
387 (void)filename;
388 return 0;
391 #endif /* !defined(IRIVER_IFP7XX_SERIES) */