head.S
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:28k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /* $Id: head.S,v 1.44 2002/02/05 15:39:57 bjornw Exp $
  2.  * 
  3.  * Head of the kernel - alter with care
  4.  *
  5.  * Copyright (C) 2000, 2001 Axis Communications AB
  6.  *
  7.  * Authors: Bjorn Wesen (bjornw@axis.com)
  8.  * 
  9.  * $Log: head.S,v $
  10.  * Revision 1.44  2002/02/05 15:39:57  bjornw
  11.  * Oops.. non-CRAMFS_MAGIC should jump over the copying, not into it...
  12.  *
  13.  * Revision 1.43  2001/11/08 15:09:43  starvik
  14.  * Only start MII clock if Ethernet is configured
  15.  *
  16.  * Revision 1.42  2001/11/08 14:37:34  starvik
  17.  * Start MII clock early to make sure that it is running at tranceiver reset
  18.  *
  19.  * Revision 1.41  2001/10/29 14:55:58  pkj
  20.  * Corrected pa$r0 to par0.
  21.  *
  22.  * Revision 1.40  2001/10/03 14:59:57  pkj
  23.  * Added support for resetting the Bluetooth hardware.
  24.  *
  25.  * Revision 1.39  2001/10/01 14:45:03  bjornw
  26.  * Removed underscores and added register prefixes
  27.  *
  28.  * Revision 1.38  2001/09/21 07:14:11  jonashg
  29.  * Made root filesystem (cramfs) use mtdblock driver when booting from flash.
  30.  *
  31.  * Revision 1.37  2001/09/11 13:44:29  orjanf
  32.  * Decouple usage of serial ports for debug and kgdb.
  33.  *
  34.  * Revision 1.36  2001/06/29 12:39:31  pkj
  35.  * Added support for mirroring the first flash to just below the
  36.  * second one, to make them look consecutive to cramfs.
  37.  *
  38.  * Revision 1.35  2001/06/25 14:07:00  hp
  39.  *  Fix review comment.
  40.  *  * head.S: Use IO_STATE, IO_FIELD and IO_MASK constructs instead of
  41.  *  magic numbers.  Add comment that -traditional must not be used.
  42.  *  * entry.S (SYMBOL_NAME): Change redefinition to use ## concatenation.
  43.  *  Correct and update comment.
  44.  *  * Makefile (.S.o): Don't use -traditional.  Add comment why the
  45.  *  toplevel rule can't be used (now that there's a reason).
  46.  *
  47.  * Revision 1.34  2001/05/15 07:08:14  hp
  48.  * Tweak "notice" to reflect that both r8 r9 are used
  49.  *
  50.  * Revision 1.33  2001/05/15 06:40:05  hp
  51.  * Put bulk of code in .text.init, data in .data.init
  52.  *
  53.  * Revision 1.32  2001/05/15 06:18:56  hp
  54.  * Execute review comment: s/bcc/bhs/g; s/bcs/blo/g
  55.  *
  56.  * Revision 1.31  2001/05/15 06:08:40  hp
  57.  * Add sentence about autodetecting the bit31-MMU-bug
  58.  *
  59.  * Revision 1.30  2001/05/15 06:00:05  hp
  60.  * Update comment: LOW_MAP is not forced on xsim anymore.
  61.  *
  62.  * Revision 1.29  2001/04/18 12:51:59  orjanf
  63.  * * Reverted review change regarding the use of bcs/bcc.
  64.  * * Removed non-working LED-clearing code.
  65.  *
  66.  * Revision 1.28  2001/04/17 13:58:39  orjanf
  67.  * * Renamed CONFIG_KGDB to CONFIG_ETRAX_KGDB.
  68.  *
  69.  * Revision 1.27  2001/04/17 11:42:35  orjanf
  70.  * Changed according to review:
  71.  * * Added comment explaining memory map bug.
  72.  * * Changed bcs and bcc to blo and bhs, respectively.
  73.  * * Removed mentioning of Stallone and Olga boards.
  74.  *
  75.  * Revision 1.26  2001/04/06 12:31:07  jonashg
  76.  * Check for cramfs in flash before RAM instead of RAM before flash.
  77.  *
  78.  * Revision 1.25  2001/04/04 06:23:53  starvik
  79.  * Initialize DRAM if not already initialized
  80.  *
  81.  * Revision 1.24  2001/04/03 11:12:00  starvik
  82.  * Removed dram init (done by rescue or etrax100boot
  83.  * Corrected include
  84.  *
  85.  * Revision 1.23  2001/04/03 09:53:03  starvik
  86.  * Include hw_settings.S
  87.  *
  88.  * Revision 1.22  2001/03/26 14:23:26  bjornw
  89.  * Namechange of some config options
  90.  *
  91.  * Revision 1.21  2001/03/08 12:14:41  bjornw
  92.  * * Config name for ETRAX IDE was renamed
  93.  * * Removed G27 auto-setting when JULIETTE is chosen (need to make this
  94.  *   a new config option later)
  95.  *
  96.  * Revision 1.20  2001/02/23 12:47:56  bjornw
  97.  * MMU regs during LOW_MAP updated to reflect a newer reality
  98.  *
  99.  * Revision 1.19  2001/02/19 11:12:07  bjornw
  100.  * Changed comment header format
  101.  *
  102.  * Revision 1.18  2001/02/15 07:25:38  starvik
  103.  * Added support for synchronous serial ports
  104.  *
  105.  * Revision 1.17  2001/02/08 15:53:13  starvik
  106.  * Last commit removed some important ifdefs
  107.  *
  108.  * Revision 1.16  2001/02/08 15:20:38  starvik
  109.  * Include dram_init.S as inline
  110.  *
  111.  * Revision 1.15  2001/01/29 18:12:01  bjornw
  112.  * Corrected some comments
  113.  *
  114.  * Revision 1.14  2001/01/29 13:11:29  starvik
  115.  * Include dram_init.S (with DRAM/SDRAM initialization)
  116.  *
  117.  * Revision 1.13  2001/01/23 14:54:57  markusl
  118.  * Updated for USB
  119.  * i.e. added r_gen_config settings
  120.  *
  121.  * Revision 1.12  2001/01/19 16:16:29  perf
  122.  * Added temporary mapping of 0x0c->0x0c to avoid flash loading confusion.
  123.  * Renamed serial options from ETRAX100 to ETRAX.
  124.  *
  125.  * Revision 1.11  2001/01/16 16:31:38  bjornw
  126.  * * Changed name and semantics of running_from_flash to romfs_in_flash,
  127.  *   set by head.S to indicate to setup.c whether there is a cramfs image
  128.  *   after the kernels BSS or not. Should work for all three boot-cases
  129.  *   (DRAM with cramfs in DRAM, DRAM with cramfs in flash (compressed boot),
  130.  *    and flash with cramfs in flash)
  131.  *
  132.  * Revision 1.10  2001/01/16 14:12:21  bjornw
  133.  * * Check for cramfs start passed in r9 from the decompressor, if all other
  134.  *   cramfs options fail (if we boot from DRAM but don't find a cramfs image
  135.  *   after the kernel in DRAM, it is probably still in the flash)
  136.  * * Check magic in cramfs detection when booting from flash directly
  137.  *
  138.  * Revision 1.9  2001/01/15 17:17:02  bjornw
  139.  * * Corrected the code that detects the cramfs lengths
  140.  * * Added a comment saying that the above does not work due to other
  141.  *   reasons..
  142.  *
  143.  * Revision 1.8  2001/01/15 16:27:51  jonashg
  144.  * Made boot after flashing work.
  145.  * * end destination is __vmlinux_end in RAM.
  146.  * * _romfs_start moved because of virtual memory.
  147.  *
  148.  * Revision 1.7  2000/11/21 13:55:29  bjornw
  149.  * Use CONFIG_CRIS_LOW_MAP for the low VM map instead of explicit CPU type
  150.  *
  151.  * Revision 1.6  2000/10/06 12:36:55  bjornw
  152.  * Forgot swapper_pg_dir when changing memory map..
  153.  *
  154.  * Revision 1.5  2000/10/04 16:49:30  bjornw
  155.  * * Fixed memory mapping in LX
  156.  * * Check for cramfs instead of romfs
  157.  *
  158.  */
  159. #include <linux/config.h>
  160. #define ASSEMBLER_MACROS_ONLY
  161. /* The IO_* macros use the ## token concatenation operator, so
  162.    -traditional must not be used when assembling this file.  */
  163. #include <asm/sv_addr_ag.h>
  164. #define CRAMFS_MAGIC 0x28cd3d45
  165. #define RAM_INIT_MAGIC 0x56902387
  166. #define START_ETHERNET_CLOCK IO_STATE(R_NETWORK_GEN_CONFIG, enable, on) |
  167.                              IO_STATE(R_NETWORK_GEN_CONFIG, phy, mii_clk)
  168. ;; exported symbols
  169. .globl etrax_irv
  170. .globl romfs_start
  171. .globl romfs_length
  172. .globl romfs_in_flash
  173. .globl  swapper_pg_dir
  174. .text
  175. ;; This is the entry point of the kernel. We are in supervisor mode.
  176. ;; 0x00000000 if Flash, 0x40004000 if DRAM
  177. ;; since etrax actually starts at address 2 when booting from flash, we
  178. ;; put a nop (2 bytes) here first so we dont accidentally skip the di
  179. ;;
  180. ;; NOTICE! The registers r8 and r9 are used as parameters carrying
  181. ;; information from the decompressor (if the kernel was compressed). 
  182. ;; They should not be used in the code below until read.
  183. nop
  184. di
  185. ;; First setup the kseg_c mapping from where the kernel is linked
  186. ;; to 0x40000000 (where the actual DRAM resides) otherwise
  187. ;; we cannot do very much! See arch/cris/README.mm
  188. ;;
  189. ;; Notice that since we're potentially running at 0x00 or 0x40 right now,
  190. ;; we will get a fault as soon as we enable the MMU if we dont
  191. ;; temporarily map those segments linearily.
  192. ;;
  193. ;; Due to a bug in Etrax-100 LX version 1 we need to map the memory
  194. ;; slightly different.  The bug is that you can't remap bit 31 of
  195. ;; an address.  Though we can check the version register for
  196. ;; whether the bug is present, some constants would then have to
  197. ;; be variables, so we don't.  The drawback is that you can "only" map
  198. ;; 1G per process with CONFIG_CRIS_LOW_MAP.
  199. #ifdef CONFIG_CRIS_LOW_MAP
  200. ; kseg mappings, temporary map of 0xc0->0x40
  201.   move.d   IO_FIELD (R_MMU_KBASE_HI, base_c, 4)
  202. | IO_FIELD (R_MMU_KBASE_HI, base_b, 0xb)
  203. | IO_FIELD (R_MMU_KBASE_HI, base_9, 9)
  204. | IO_FIELD (R_MMU_KBASE_HI, base_8, 8), $r0
  205. move.d $r0, [R_MMU_KBASE_HI]
  206. ; temporary map of 0x40->0x40 and 0x60->0x40 
  207.   move.d   IO_FIELD (R_MMU_KBASE_LO, base_6, 4)
  208. | IO_FIELD (R_MMU_KBASE_LO, base_4, 4), $r0
  209. move.d $r0, [R_MMU_KBASE_LO]
  210. ; mmu enable, segs e,c,b,a,6,5,4,0 segment mapped
  211.   move.d   IO_STATE (R_MMU_CONFIG, mmu_enable, enable)
  212. | IO_STATE (R_MMU_CONFIG, inv_excp, enable)
  213. | IO_STATE (R_MMU_CONFIG, acc_excp, enable)
  214. | IO_STATE (R_MMU_CONFIG, we_excp, enable)
  215. | IO_STATE (R_MMU_CONFIG, seg_f, page)
  216. | IO_STATE (R_MMU_CONFIG, seg_e, seg)
  217. | IO_STATE (R_MMU_CONFIG, seg_d, page)
  218. | IO_STATE (R_MMU_CONFIG, seg_c, seg)
  219. | IO_STATE (R_MMU_CONFIG, seg_b, seg)
  220. | IO_STATE (R_MMU_CONFIG, seg_a, seg)
  221. | IO_STATE (R_MMU_CONFIG, seg_9, page)
  222. | IO_STATE (R_MMU_CONFIG, seg_8, page)
  223. | IO_STATE (R_MMU_CONFIG, seg_7, page)
  224. | IO_STATE (R_MMU_CONFIG, seg_6, seg)
  225. | IO_STATE (R_MMU_CONFIG, seg_5, seg)
  226. | IO_STATE (R_MMU_CONFIG, seg_4, seg)
  227. | IO_STATE (R_MMU_CONFIG, seg_3, page)
  228. | IO_STATE (R_MMU_CONFIG, seg_2, page)
  229. | IO_STATE (R_MMU_CONFIG, seg_1, page)
  230. | IO_STATE (R_MMU_CONFIG, seg_0, seg), $r0
  231. move.d $r0, [R_MMU_CONFIG]
  232. #else
  233. ; kseg mappings
  234.   move.d   IO_FIELD (R_MMU_KBASE_HI, base_e, 8)
  235. | IO_FIELD (R_MMU_KBASE_HI, base_c, 4)
  236. | IO_FIELD (R_MMU_KBASE_HI, base_b, 0xb), $r0
  237. move.d $r0, [R_MMU_KBASE_HI]
  238. ; temporary map of 0x40->0x40 and 0x00->0x00 
  239. move.d   IO_FIELD (R_MMU_KBASE_LO, base_4, 4), $r0
  240. move.d $r0, [R_MMU_KBASE_LO]
  241. ; mmu enable, segs f,e,c,b,4,0 segment mapped
  242.   move.d   IO_STATE (R_MMU_CONFIG, mmu_enable, enable)
  243. | IO_STATE (R_MMU_CONFIG, inv_excp, enable)
  244. | IO_STATE (R_MMU_CONFIG, acc_excp, enable)
  245. | IO_STATE (R_MMU_CONFIG, we_excp, enable)
  246. | IO_STATE (R_MMU_CONFIG, seg_f, seg)
  247. | IO_STATE (R_MMU_CONFIG, seg_e, seg)
  248. | IO_STATE (R_MMU_CONFIG, seg_d, page)
  249. | IO_STATE (R_MMU_CONFIG, seg_c, seg)
  250. | IO_STATE (R_MMU_CONFIG, seg_b, seg)
  251. | IO_STATE (R_MMU_CONFIG, seg_a, page)
  252. | IO_STATE (R_MMU_CONFIG, seg_9, page)
  253. | IO_STATE (R_MMU_CONFIG, seg_8, page)
  254. | IO_STATE (R_MMU_CONFIG, seg_7, page)
  255. | IO_STATE (R_MMU_CONFIG, seg_6, page)
  256. | IO_STATE (R_MMU_CONFIG, seg_5, page)
  257. | IO_STATE (R_MMU_CONFIG, seg_4, seg)
  258. | IO_STATE (R_MMU_CONFIG, seg_3, page)
  259. | IO_STATE (R_MMU_CONFIG, seg_2, page)
  260. | IO_STATE (R_MMU_CONFIG, seg_1, page)
  261. | IO_STATE (R_MMU_CONFIG, seg_0, seg), $r0
  262. move.d $r0, [R_MMU_CONFIG]
  263. #endif
  264. ;; Now we need to sort out the segments and their locations in RAM or
  265. ;; Flash. The image in the Flash (or in DRAM) consists of 3 pieces:
  266. ;; 1) kernel text, 2) kernel data, 3) ROM filesystem image
  267. ;; But the linker has linked the kernel to expect this layout in
  268. ;; DRAM memory:
  269. ;; 1) kernel text, 2) kernel data, 3) kernel BSS
  270. ;; (the location of the ROM filesystem is determined by the krom driver)
  271. ;; If we boot this from Flash, we want to keep the ROM filesystem in
  272. ;; the flash, we want to copy the text and need to copy the data to DRAM.
  273. ;; But if we boot from DRAM, we need to move the ROMFS image
  274. ;; from its position after kernel data, to after kernel BSS, BEFORE the
  275. ;; kernel starts using the BSS area (since its "overlayed" with the ROMFS)
  276. ;;
  277. ;; In both cases, we start in un-cached mode, and need to jump into a
  278. ;; cached PC after we're done fiddling around with the segments.
  279. ;; 
  280. ;; arch/etrax100/etrax100.ld sets some symbols that define the start
  281. ;; and end of each segment.
  282. ;; Check if we start from DRAM or FLASH by testing PC
  283. move.d $pc,$r0
  284. and.d 0x7fffffff,$r0 ; get rid of the non-cache bit
  285. cmp.d 0x10000,$r0 ; arbitrary... just something above this code
  286. blo _inflash0
  287. nop
  288. jump _inram ; enter cached ram
  289. ;; Jumpgate for branches.
  290. _inflash0:
  291. jump _inflash
  292. ;; Put this in a suitable section where we can reclaim storage
  293. ;; after init.
  294. .section ".text.init"
  295. _inflash:
  296. #ifdef CONFIG_ETRAX_ETHERNET
  297. ;; Start MII clock to make sure it is running when tranceiver is reset
  298. move.d START_ETHERNET_CLOCK, $r0
  299. move.d $r0, [R_NETWORK_GEN_CONFIG]
  300. #endif
  301. ;; We need to initialze DRAM registers before we start using the DRAM
  302. cmp.d RAM_INIT_MAGIC, $r8 ; Already initialized?
  303. beq _dram_init_finished
  304. nop
  305. #include "../lib/dram_init.S"
  306. _dram_init_finished:
  307. ;; Copy text+data to DRAM
  308. ;; This is fragile - the calculation of r4 as the image size depends
  309. ;; on that the labels below actually are the first and last positions
  310. ;; in the linker-script.
  311. ;;
  312. ;; Then the locating of the cramfs image depends on the aforementioned
  313. ;; image being located in the flash at 0. This is most often not true,
  314. ;; thus the following does not work (normally there is a rescue-block
  315. ;; between the physical start of the flash and the flash-image start,
  316. ;; and when run with compression, the kernel is actually unpacked to
  317. ;; DRAM and we never get here in the first place :))
  318. moveq 0, $r0 ; source
  319. move.d text_start, $r1 ; destination
  320. move.d __vmlinux_end, $r2 ; end destination
  321. move.d $r2, $r4
  322. sub.d $r1, $r4 ; r4=__vmlinux_end in flash, used below
  323. 1: move.w [$r0+], $r3
  324. move.w $r3, [$r1+]
  325. cmp.d $r2, $r1
  326. blo 1b
  327. nop
  328. ;; We keep the cramfs in the flash.
  329. ;; There might be none, but that does not matter because
  330. ;; we don't do anything than read some bytes here.
  331. moveq 0, $r0
  332. move.d $r0, [romfs_length] ; default if there is no cramfs
  333. move.d  [$r4], $r0 ; cramfs_super.magic
  334. cmp.d CRAMFS_MAGIC, $r0
  335. bne 1f
  336. nop
  337. move.d [$r4 + 4], $r0 ; cramfs_super.size
  338. move.d $r0, [romfs_length]
  339. #ifdef CONFIG_CRIS_LOW_MAP
  340. add.d   0x50000000, $r4 ; add flash start in virtual memory (cached)
  341. #else
  342. add.d   0xf0000000, $r4 ; add flash start in virtual memory (cached)
  343. #endif
  344. move.d $r4, [romfs_start]
  345. 1:
  346. moveq 1, $r0
  347. move.d $r0, [romfs_in_flash]
  348. jump _start_it ; enter code, cached this time
  349. _inram:
  350. ;; Move the ROM fs to after BSS end. This assumes that the cramfs
  351. ;; second longword contains the length of the cramfs
  352. moveq 0, $r0
  353. move.d $r0, [romfs_length] ; default if there is no cramfs
  354. ;; The kernel could have been unpacked to DRAM by the loader, but
  355. ;; the cramfs image could still be in the Flash directly after the
  356. ;; compressed kernel image. The loader passes the address of the
  357. ;; byte succeeding the last compressed byte in the flash in the
  358. ;; register r9 when starting the kernel. Check if r9 points to a
  359. ;; decent cramfs image!
  360. ;; (Notice that if this is not booted from the loader, r9 will be
  361. ;;  garbage but we do sanity checks on it, the chance that it points
  362. ;;  to a cramfs magic is small.. )
  363. cmp.d 0x0ffffff8, $r9
  364. bhs _no_romfs_in_flash ; r9 points outside the flash area
  365. nop
  366. move.d [$r9], $r0 ; cramfs_super.magic
  367. cmp.d CRAMFS_MAGIC, $r0
  368. bne _no_romfs_in_flash
  369. nop
  370. move.d [$r9+4], $r0 ; cramfs_super.length
  371. move.d $r0, [romfs_length]
  372. #ifdef CONFIG_CRIS_LOW_MAP
  373. add.d   0x50000000, $r9 ; add flash start in virtual memory (cached)
  374. #else
  375. add.d   0xf0000000, $r9 ; add flash start in virtual memory (cached)
  376. #endif
  377. move.d $r9, [romfs_start]
  378. moveq 1, $r0
  379. move.d $r0, [romfs_in_flash]
  380. jump _start_it ; enter code, cached this time
  381. _no_romfs_in_flash:
  382. ;; Check if there is a cramfs (magic value).
  383. ;; Notice that we check for cramfs magic value - which is
  384. ;; the "rom fs" we'll possibly use in 2.4 if not JFFS (which does
  385. ;; not need this mechanism anyway)
  386. move.d __vmlinux_end, $r0; the image will be after the vmlinux end address
  387. move.d [$r0], $r1 ; cramfs assumes same endian on host/target
  388. cmp.d CRAMFS_MAGIC, $r1; magic value in cramfs superblock
  389. bne 2f
  390. nop
  391. ;; Ok. What is its size ? 
  392. move.d [$r0 + 4], $r2 ; cramfs_super.size (again, no need to swapwb)
  393. ;; We want to copy it to the end of the BSS
  394. move.d _end, $r1
  395. ;; Remember values so cramfs and setup can find this info
  396. move.d $r1, [romfs_start] ; new romfs location
  397. move.d $r2, [romfs_length]
  398. ;; We need to copy it backwards, since they can be overlapping
  399. add.d $r2, $r0
  400. add.d $r2, $r1
  401. ;; Go ahead. Make my loop.
  402. lsrq 1, $r2 ; size is in bytes, we copy words
  403. 1: move.w [$r0=$r0-2],$r3
  404. move.w $r3,[$r1=$r1-2]
  405. subq 1, $r2
  406. bne 1b
  407. nop
  408. 2:
  409. ;; Dont worry that the BSS is tainted. It will be cleared later.
  410. moveq 0, $r0
  411. move.d $r0, [romfs_in_flash]
  412. jump _start_it ; better skip the additional cramfs check below
  413. _start_it:
  414. ;; the kernel stack is overlayed with the task structure for each
  415. ;; task. thus the initial kernel stack is in the same page as the
  416. ;; init_task (but starts in the top of the page, size 8192)
  417. move.d init_task_union + 8192, $sp
  418. move.d ibr_start,$r0 ; this symbol is set by the linker script 
  419. move $r0,$ibr
  420. move.d $r0,[etrax_irv] ; set the interrupt base register and pointer
  421. ;; Clear BSS region, from _bss_start to _end
  422. move.d __bss_start, $r0
  423. move.d _end, $r1
  424. 1: clear.d [$r0+]
  425. cmp.d $r1, $r0
  426. blo 1b
  427. nop
  428. #ifdef CONFIG_BLK_DEV_ETRAXIDE
  429. ;; disable ATA before enabling it in genconfig below
  430. moveq 0,$r0
  431. move.d $r0,[R_ATA_CTRL_DATA]
  432. move.d $r0,[R_ATA_TRANSFER_CNT]
  433. move.d $r0,[R_ATA_CONFIG]
  434. #if 0
  435. move.d R_PORT_G_DATA, $r1
  436. move.d $r0, [$r1]; assert ATA bus-reset
  437. nop
  438. nop
  439. nop
  440. nop
  441. nop
  442. nop
  443. move.d 0x08000000,$r0
  444. move.d $r0,[$r1]
  445. #endif
  446. #endif
  447. #ifdef CONFIG_JULIETTE
  448. ;; configure external DMA channel 0 before enabling it in genconfig
  449. moveq 0,$r0
  450. move.d $r0,[R_EXT_DMA_0_ADDR]
  451. ; cnt enable, word size, output, stop, size 0
  452. move.d   IO_STATE (R_EXT_DMA_0_CMD, cnt, enable)
  453. | IO_STATE (R_EXT_DMA_0_CMD, rqpol, ahigh)
  454. | IO_STATE (R_EXT_DMA_0_CMD, apol, ahigh)
  455. | IO_STATE (R_EXT_DMA_0_CMD, rq_ack, burst)
  456. | IO_STATE (R_EXT_DMA_0_CMD, wid, word)
  457. | IO_STATE (R_EXT_DMA_0_CMD, dir, output)
  458. | IO_STATE (R_EXT_DMA_0_CMD, run, stop)
  459. | IO_FIELD (R_EXT_DMA_0_CMD, trf_count, 0),$r0
  460. move.d $r0,[R_EXT_DMA_0_CMD]
  461. ;; reset dma4 and wait for completion
  462. moveq IO_STATE (R_DMA_CH4_CMD, cmd, reset),$r0
  463. move.b $r0,[R_DMA_CH4_CMD]
  464. 1: move.b [R_DMA_CH4_CMD],$r0
  465. and.b IO_MASK (R_DMA_CH4_CMD, cmd),$r0
  466. cmp.b IO_STATE (R_DMA_CH4_CMD, cmd, reset),$r0
  467. beq 1b
  468. nop
  469. ;; reset dma5 and wait for completion
  470. moveq IO_STATE (R_DMA_CH5_CMD, cmd, reset),$r0
  471. move.b $r0,[R_DMA_CH5_CMD]
  472. 1: move.b [R_DMA_CH5_CMD],$r0
  473. and.b IO_MASK (R_DMA_CH5_CMD, cmd),$r0
  474. cmp.b IO_STATE (R_DMA_CH5_CMD, cmd, reset),$r0
  475. beq 1b
  476. nop
  477. #endif
  478. ;; Etrax product HW genconfig setup
  479. moveq 0,$r0
  480. #if (!defined(CONFIG_ETRAX_KGDB) || !defined(CONFIG_ETRAX_DEBUG_PORT0)) 
  481. && !defined(CONFIG_DMA_MEMCPY)
  482. ; DMA channels 6 and 7 to ser0, kgdb doesnt want DMA
  483. or.d   IO_STATE (R_GEN_CONFIG, dma7, serial0)
  484. | IO_STATE (R_GEN_CONFIG, dma6, serial0),$r0
  485. #endif
  486. #if !defined(CONFIG_ETRAX_KGDB) || !defined(CONFIG_ETRAX_DEBUG_PORT1)
  487. ; DMA channels 8 and 9 to ser1, kgdb doesnt want DMA
  488. or.d   IO_STATE (R_GEN_CONFIG, dma9, serial1)
  489. | IO_STATE (R_GEN_CONFIG, dma8, serial1),$r0
  490. #endif
  491. #ifdef CONFIG_DMA_MEMCPY
  492. ; 6/7 memory-memory DMA
  493. or.d   IO_STATE (R_GEN_CONFIG, dma7, intdma6)
  494. | IO_STATE (R_GEN_CONFIG, dma6, intdma7),$r0
  495. #endif
  496. #ifdef CONFIG_ETRAX_SERIAL_PORT2
  497. ; Enable serial port 2
  498. or.w IO_STATE (R_GEN_CONFIG, ser2, select),$r0
  499. #if !defined(CONFIG_ETRAX_KGDB) || !defined(CONFIG_ETRAX_DEBUG_PORT2)
  500. ; DMA channels 2 and 3 to ser2, kgdb doesnt want DMA
  501. or.d   IO_STATE (R_GEN_CONFIG, dma3, serial2)
  502. | IO_STATE (R_GEN_CONFIG, dma2, serial2),$r0
  503. #endif
  504. #endif
  505. #if defined(CONFIG_ETRAX_SERIAL_PORT3) || defined(CONFIG_ETRAX_SYNCHRONOUS_SERIAL_PORT1)
  506. ; Enable serial port 3
  507. or.w IO_STATE (R_GEN_CONFIG, ser3, select),$r0
  508. #if !defined(CONFIG_ETRAX_KGDB) || !defined(CONFIG_ETRAX_DEBUG_PORT3)
  509. ; DMA channels 4 and 5 to ser3, kgdb doesnt want DMA
  510. or.d   IO_STATE (R_GEN_CONFIG, dma5, serial3)
  511. | IO_STATE (R_GEN_CONFIG, dma4, serial3),$r0
  512. #endif
  513. #endif
  514. #if defined(CONFIG_ETRAX_PARALLEL_PORT0) || defined(CONFIG_ETRAX_ETHERNET_LPSLAVE)
  515. ; parport 0 enabled using DMA 2/3
  516. or.w IO_STATE (R_GEN_CONFIG, par0, select),$r0
  517. #endif
  518. #if defined(CONFIG_ETRAX_PARALLEL_PORT1) || defined(CONFIG_ETRAX_ETHERNET_LPSLAVE)
  519. ; parport 1 enabled using DMA 4/5
  520. or.w IO_STATE (R_GEN_CONFIG, par1, select),$r0
  521. #endif
  522. #ifdef CONFIG_ETRAX_IDE
  523. ; DMA channels 2 and 3 to ATA, ATA enabled
  524. or.d   IO_STATE (R_GEN_CONFIG, dma3, ata)
  525. | IO_STATE (R_GEN_CONFIG, dma2, ata)
  526. | IO_STATE (R_GEN_CONFIG, ata, select),$r0
  527. #endif
  528. #ifdef CONFIG_ETRAX_USB_HOST_PORT1
  529. ; Set the USB port 1 enable bit
  530. or.d IO_STATE (R_GEN_CONFIG, usb1, select),$r0
  531. #endif
  532. #ifdef CONFIG_ETRAX_USB_HOST_PORT2
  533. ; Set the USB port 2 enable bit
  534. or.d IO_STATE (R_GEN_CONFIG, usb2, select),$r0
  535. #endif
  536. #ifdef CONFIG_ETRAX_USB_HOST
  537. ; Connect DMA channels 8 and 9 to USB
  538. and.d (~(IO_MASK (R_GEN_CONFIG, dma9)
  539.    | IO_MASK (R_GEN_CONFIG, dma8)))
  540. | IO_STATE (R_GEN_CONFIG, dma9, usb)
  541. | IO_STATE (R_GEN_CONFIG, dma8, usb),$r0
  542. #endif
  543. #ifdef CONFIG_JULIETTE
  544. ; DMA channels 4 and 5 to EXTDMA0, for Juliette
  545. or.d   IO_STATE (R_GEN_CONFIG, dma5, extdma0)
  546. | IO_STATE (R_GEN_CONFIG, dma4, extdma0),$r0
  547. #endif
  548. #if defined(CONFIG_BLUETOOTH) && (defined(CONFIG_BLUETOOTH_RESET_G10) || defined(CONFIG_BLUETOOTH_RESET_G11))
  549. or.d   IO_STATE (R_GEN_CONFIG, g8_15dir, out),$r0
  550. #endif
  551. move.d $r0,[genconfig_shadow] ; init a shadow register of R_GEN_CONFIG
  552. #ifndef CONFIG_SVINTO_SIM
  553. move.d $r0,[R_GEN_CONFIG]
  554. #if 0
  555. moveq 4,$r0
  556. move.b $r0,[R_DMA_CH6_CMD] ; reset (ser0 dma out)
  557. move.b $r0,[R_DMA_CH7_CMD] ; reset (ser0 dma in)
  558. 1: move.b [R_DMA_CH6_CMD],$r0 ; wait for reset cycle to finish
  559. and.b 7,$r0
  560. cmp.b 4,$r0
  561. beq 1b
  562. nop
  563. 1: move.b [R_DMA_CH7_CMD],$r0 ; wait for reset cycle to finish
  564. and.b 7,$r0
  565. cmp.b 4,$r0
  566. beq 1b
  567. nop
  568. #endif
  569. moveq IO_STATE (R_DMA_CH8_CMD, cmd, reset),$r0
  570. move.b $r0,[R_DMA_CH8_CMD] ; reset (ser1 dma out)
  571. move.b $r0,[R_DMA_CH9_CMD] ; reset (ser1 dma in)
  572. 1: move.b [R_DMA_CH8_CMD],$r0 ; wait for reset cycle to finish
  573. andq IO_MASK (R_DMA_CH8_CMD, cmd),$r0
  574. cmpq IO_STATE (R_DMA_CH8_CMD, cmd, reset),$r0
  575. beq 1b
  576. nop
  577. 1: move.b [R_DMA_CH9_CMD],$r0 ; wait for reset cycle to finish
  578. andq IO_MASK (R_DMA_CH9_CMD, cmd),$r0
  579. cmpq IO_STATE (R_DMA_CH9_CMD, cmd, reset),$r0
  580. beq 1b
  581. nop
  582. ;; setup port PA and PB default initial directions and data
  583. ;; including their shadow registers
  584. move.b CONFIG_ETRAX_DEF_R_PORT_PA_DIR,$r0
  585. #if defined(CONFIG_BLUETOOTH) && defined(CONFIG_BLUETOOTH_RESET_PA7)
  586. or.b IO_STATE (R_PORT_PA_DIR, dir7, output),$r0
  587. #endif
  588. move.b $r0,[port_pa_dir_shadow]
  589. move.b $r0,[R_PORT_PA_DIR]
  590. move.b CONFIG_ETRAX_DEF_R_PORT_PA_DATA,$r0
  591. #if defined(CONFIG_BLUETOOTH) && defined(CONFIG_BLUETOOTH_RESET_PA7)
  592. #if defined(CONFIG_BLUETOOTH_RESET_ACTIVE_HIGH)
  593. and.b ~(1 << 7),$r0
  594. #else
  595. or.b (1 << 7),$r0
  596. #endif
  597. #endif
  598. move.b $r0,[port_pa_data_shadow]
  599. move.b $r0,[R_PORT_PA_DATA]
  600. move.b CONFIG_ETRAX_DEF_R_PORT_PB_CONFIG,$r0
  601. move.b $r0,[port_pb_config_shadow]
  602. move.b $r0,[R_PORT_PB_CONFIG]
  603. move.b CONFIG_ETRAX_DEF_R_PORT_PB_DIR,$r0
  604. #if defined(CONFIG_BLUETOOTH) && defined(CONFIG_BLUETOOTH_RESET_PB5)
  605. or.b IO_STATE (R_PORT_PB_DIR, dir5, output),$r0
  606. #endif
  607. move.b $r0,[port_pb_dir_shadow]
  608. move.b $r0,[R_PORT_PB_DIR]
  609. move.b CONFIG_ETRAX_DEF_R_PORT_PB_DATA,$r0
  610. #if defined(CONFIG_BLUETOOTH) && defined(CONFIG_BLUETOOTH_RESET_PB5)
  611. #if defined(CONFIG_BLUETOOTH_RESET_ACTIVE_HIGH)
  612. and.b ~(1 << 5),$r0
  613. #else
  614. or.b (1 << 5),$r0
  615. #endif
  616. #endif
  617. move.b $r0,[port_pb_data_shadow]
  618. move.b $r0,[R_PORT_PB_DATA]
  619. moveq   0, $r0
  620. move.d  $r0,[port_pb_i2c_shadow]
  621. move.d  $r0, [R_PORT_PB_I2C]
  622. moveq 0,$r0
  623. #if defined(CONFIG_BLUETOOTH) && defined(CONFIG_BLUETOOTH_RESET_G10)
  624. #if defined(CONFIG_BLUETOOTH_RESET_ACTIVE_HIGH)
  625. and.d ~(1 << 10),$r0
  626. #else
  627. or.d (1 << 10),$r0
  628. #endif
  629. #endif
  630. #if defined(CONFIG_BLUETOOTH) && defined(CONFIG_BLUETOOTH_RESET_G11)
  631. #if defined(CONFIG_BLUETOOTH_RESET_ACTIVE_HIGH)
  632. and.d ~(1 << 11),$r0
  633. #else
  634. or.d (1 << 11),$r0
  635. #endif
  636. #endif
  637. move.d $r0,[port_g_data_shadow]
  638. move.d $r0,[R_PORT_G_DATA]
  639. ;; setup the serial port 0 at 115200 baud for debug purposes
  640. moveq   IO_STATE (R_SERIAL0_XOFF, tx_stop, enable)
  641. | IO_STATE (R_SERIAL0_XOFF, auto_xoff, disable)
  642. | IO_FIELD (R_SERIAL0_XOFF, xoff_char, 0),$r0
  643. move.d $r0,[R_SERIAL0_XOFF] 
  644. ; 115.2kbaud for both transmit and receive
  645. move.b   IO_STATE (R_SERIAL0_BAUD, tr_baud, c115k2Hz)
  646. | IO_STATE (R_SERIAL0_BAUD, rec_baud, c115k2Hz),$r0
  647. move.b $r0,[R_SERIAL0_BAUD]
  648. ; Set up and enable the serial0 receiver.
  649. move.b   IO_STATE (R_SERIAL0_REC_CTRL, dma_err, stop)
  650. | IO_STATE (R_SERIAL0_REC_CTRL, rec_enable, enable)
  651. | IO_STATE (R_SERIAL0_REC_CTRL, rts_, active)
  652. | IO_STATE (R_SERIAL0_REC_CTRL, sampling, middle)
  653. | IO_STATE (R_SERIAL0_REC_CTRL, rec_stick_par, normal)
  654. | IO_STATE (R_SERIAL0_REC_CTRL, rec_par, even)
  655. | IO_STATE (R_SERIAL0_REC_CTRL, rec_par_en, disable)
  656. | IO_STATE (R_SERIAL0_REC_CTRL, rec_bitnr, rec_8bit),$r0
  657. move.b $r0,[R_SERIAL0_REC_CTRL] 
  658. ; Set up and enable the serial0 transmitter.
  659. move.b   IO_FIELD (R_SERIAL0_TR_CTRL, txd, 0)
  660. | IO_STATE (R_SERIAL0_TR_CTRL, tr_enable, enable)
  661. | IO_STATE (R_SERIAL0_TR_CTRL, auto_cts, disabled)
  662. | IO_STATE (R_SERIAL0_TR_CTRL, stop_bits, one_bit)
  663. | IO_STATE (R_SERIAL0_TR_CTRL, tr_stick_par, normal)
  664. | IO_STATE (R_SERIAL0_TR_CTRL, tr_par, even)
  665. | IO_STATE (R_SERIAL0_TR_CTRL, tr_par_en, disable)
  666. | IO_STATE (R_SERIAL0_TR_CTRL, tr_bitnr, tr_8bit),$r0
  667. move.b $r0,[R_SERIAL0_TR_CTRL]
  668. ;; setup the serial port 1 at 115200 baud for debug purposes
  669. moveq   IO_STATE (R_SERIAL1_XOFF, tx_stop, enable)
  670. | IO_STATE (R_SERIAL1_XOFF, auto_xoff, disable)
  671. | IO_FIELD (R_SERIAL1_XOFF, xoff_char, 0),$r0
  672. move.d $r0,[R_SERIAL1_XOFF] 
  673. ; 115.2kbaud for both transmit and receive
  674. move.b   IO_STATE (R_SERIAL1_BAUD, tr_baud, c115k2Hz)
  675. | IO_STATE (R_SERIAL1_BAUD, rec_baud, c115k2Hz),$r0
  676. move.b $r0,[R_SERIAL1_BAUD]
  677. ; Set up and enable the serial1 receiver.
  678. move.b   IO_STATE (R_SERIAL1_REC_CTRL, dma_err, stop)
  679. | IO_STATE (R_SERIAL1_REC_CTRL, rec_enable, enable)
  680. | IO_STATE (R_SERIAL1_REC_CTRL, rts_, active)
  681. | IO_STATE (R_SERIAL1_REC_CTRL, sampling, middle)
  682. | IO_STATE (R_SERIAL1_REC_CTRL, rec_stick_par, normal)
  683. | IO_STATE (R_SERIAL1_REC_CTRL, rec_par, even)
  684. | IO_STATE (R_SERIAL1_REC_CTRL, rec_par_en, disable)
  685. | IO_STATE (R_SERIAL1_REC_CTRL, rec_bitnr, rec_8bit),$r0
  686. move.b $r0,[R_SERIAL1_REC_CTRL] 
  687. ; Set up and enable the serial1 transmitter.
  688. move.b   IO_FIELD (R_SERIAL1_TR_CTRL, txd, 0)
  689. | IO_STATE (R_SERIAL1_TR_CTRL, tr_enable, enable)
  690. | IO_STATE (R_SERIAL1_TR_CTRL, auto_cts, disabled)
  691. | IO_STATE (R_SERIAL1_TR_CTRL, stop_bits, one_bit)
  692. | IO_STATE (R_SERIAL1_TR_CTRL, tr_stick_par, normal)
  693. | IO_STATE (R_SERIAL1_TR_CTRL, tr_par, even)
  694. | IO_STATE (R_SERIAL1_TR_CTRL, tr_par_en, disable)
  695. | IO_STATE (R_SERIAL1_TR_CTRL, tr_bitnr, tr_8bit),$r0
  696. move.b $r0,[R_SERIAL1_TR_CTRL]
  697. #ifdef CONFIG_ETRAX_SERIAL_PORT3
  698. ;; setup the serial port 3 at 115200 baud for debug purposes
  699. moveq   IO_STATE (R_SERIAL3_XOFF, tx_stop, enable)
  700. | IO_STATE (R_SERIAL3_XOFF, auto_xoff, disable)
  701. | IO_FIELD (R_SERIAL3_XOFF, xoff_char, 0),$r0
  702. move.d $r0,[R_SERIAL3_XOFF] 
  703. ; 115.2kbaud for both transmit and receive
  704. move.b   IO_STATE (R_SERIAL3_BAUD, tr_baud, c115k2Hz)
  705. | IO_STATE (R_SERIAL3_BAUD, rec_baud, c115k2Hz),$r0
  706. move.b $r0,[R_SERIAL3_BAUD]
  707. ; Set up and enable the serial3 receiver.
  708. move.b   IO_STATE (R_SERIAL3_REC_CTRL, dma_err, stop)
  709. | IO_STATE (R_SERIAL3_REC_CTRL, rec_enable, enable)
  710. | IO_STATE (R_SERIAL3_REC_CTRL, rts_, active)
  711. | IO_STATE (R_SERIAL3_REC_CTRL, sampling, middle)
  712. | IO_STATE (R_SERIAL3_REC_CTRL, rec_stick_par, normal)
  713. | IO_STATE (R_SERIAL3_REC_CTRL, rec_par, even)
  714. | IO_STATE (R_SERIAL3_REC_CTRL, rec_par_en, disable)
  715. | IO_STATE (R_SERIAL3_REC_CTRL, rec_bitnr, rec_8bit),$r0
  716. move.b $r0,[R_SERIAL3_REC_CTRL] 
  717. ; Set up and enable the serial3 transmitter.
  718. move.b   IO_FIELD (R_SERIAL3_TR_CTRL, txd, 0)
  719. | IO_STATE (R_SERIAL3_TR_CTRL, tr_enable, enable)
  720. | IO_STATE (R_SERIAL3_TR_CTRL, auto_cts, disabled)
  721. | IO_STATE (R_SERIAL3_TR_CTRL, stop_bits, one_bit)
  722. | IO_STATE (R_SERIAL3_TR_CTRL, tr_stick_par, normal)
  723. | IO_STATE (R_SERIAL3_TR_CTRL, tr_par, even)
  724. | IO_STATE (R_SERIAL3_TR_CTRL, tr_par_en, disable)
  725. | IO_STATE (R_SERIAL3_TR_CTRL, tr_bitnr, tr_8bit),$r0
  726. move.b $r0,[R_SERIAL3_TR_CTRL]
  727. #endif
  728. #endif /* CONFIG_SVINTO_SIM */
  729. jump start_kernel ; jump into the C-function start_kernel in init/main.c
  730. .data
  731. etrax_irv:
  732. .dword 0
  733. romfs_start:
  734. .dword 0
  735. romfs_length:
  736. .dword 0
  737. romfs_in_flash:
  738. .dword 0
  739. ;; put some special pages at the beginning of the kernel aligned
  740. ;; to page boundaries - the kernel cannot start until after this
  741. #ifdef CONFIG_CRIS_LOW_MAP
  742. swapper_pg_dir = 0x60002000
  743. #else
  744. swapper_pg_dir = 0xc0002000
  745. #endif
  746. .section ".data.init"
  747. #include "../lib/hw_settings.S"