开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > VxWorks > 查看源码
sysALib.s
资源名称：bcm4702.rar　[点击查看]
上传用户：yuanda199
上传日期：2022-06-26
资源大小：412k
文件大小：16k
源码类别：

VxWorks

开发平台：

C/C++

sysALib.s：源码内容
  1. /*
  2.     Copyright 2001, Broadcom Corporation
  3.     All Rights Reserved.
  4.     
  5.     This is UNPUBLISHED PROPRIETARY SOURCE CODE of Broadcom Corporation;
  6.     the contents of this file may not be disclosed to third parties, copied or
  7.     duplicated in any form, in whole or in part, without the prior written
  8.     permission of Broadcom Corporation.
  9. */
  10. /* $Id: sysALib.s,v 1.1 Broadcom SDK $ */
  12. /* sysALib.s - IDT S134 system-dependent assembly routines */
  14. /* Copyright 1984-1996 Wind River Systems, Inc. */
  15.         .data
  16.         .globl  copyright_wind_river
  18. /*
  19. modification history
  20. --------------------
  21. 01b,12nov99,hsm    cleaned
  22. 01a,17june99,hsm   created.
  23. */
  25. /*
  26. DESCRIPTION
  27. This module contains system-dependent routines written in assembly
  28. language.
  30. This module must be the first specified in the f3ldf1 command used to
  31. build the system.  The sysInit() routine is the system start-up code.
  32. */ 
  33. #define _ASMLANGUAGE
  34. #include "vxWorks.h"
  35. #include "arch/mips/ivMips.h"
  36. #include "arch/mips/asmMips.h"
  37. #include "arch/mips/esfMips.h"
  38. #include "arch/mips/archMips.h"
  39. #include "sysLib.h"
  40. #include "config.h"
  41. #include "cacheLib.h"             /* where CACHE_DISABLED, etc are defined; very
  42.                                    * important for #if expression evaluation!
  43.                                    */
  44. /* internals */
  46. .globl sysInit /* start of system code */
  47. .globl sysGpInit /* initialize global pointer */
  48. .globl sysClearTlbEntry /* clear entry in tlb */
  49. .globl sysWbFlush /* flush write buffers */
  50. .globl  sysSetCompare
  51. .globl  sysGetCompare
  52. .globl  sysSetCount
  53. .globl  sysGetCount
  54. .globl sysGetPrid
  55.         .globl  sysGetConfig
  56. /*        .globl  setTlbEntry */
  57.         .globl  setPageSize
  58.         .globl  sysinbyte
  59.         .globl  sysinword
  60.         .globl  sysinlong
  61.         .globl  sysoutbyte
  62.         .globl  sysoutword
  63.         .globl  sysoutlong
  64.         .globl EnableCache
  65. .globl DisableCache
  66.    /*     .globl _writeasm */
  67.         .globl ReadCP0_16
  68.         .globl ReadCP0_22
  69.         .globl ReadSR
  70.         .globl SetSR
  71.         .globl  vxSpGet
  72.         .globl  vxPcGet
  75. /* externals */
  77. .globl usrInit /* system initialization routine */
  79. .text
  81. /*******************************************************************************
  82. *
  83. * sysInit - start after boot
  84. *
  85. * This routine is the system start-up entry point for VxWorks in RAM, the
  86. * first code executed after booting.  It disables interrupts, sets up the
  87. * stack, and jumps to the C routine usrInit() in usrConfig.c.
  88. *
  89. * The initial stack is set to grow down from the address of sysInit().  This
  90. * stack is used only by usrInit() and is never used again.  Memory for the
  91. * stack must be accounted for when determining the system load address.
  92. *
  93. * NOTE: This routine should not be called by the user.
  94. *
  95. * RETURNS: N/A
  97. * sysInit (void) /@ THIS IS NOT A CALLABLE ROUTINE @/
  99. */
  101. .ent sysInit
  102. sysInit:
  103.                 
  104. la gp,_gp /* set global ptr from cmplr */
  106. /* disable all interrupts */
  107. li t0, SR_CU0              /* |SR_IE */
  108.         li      t1, ~SR_IE
  109.         and     t0, t1       
  110. or t0, SR_DE /* disable cache errors on R4200 rev1.1 */
  111. mtc0 t0, C0_SR /* put on processor */
  112. la sp, sysInit-32 /* set stack to grow down from code,
  113.    leave room for four parameters */
  115.               
  116. /* give us as long as possible before a clock interrupt */
  117. li v0,1
  118. mtc0 v0,C0_COUNT
  119. mtc0 zero,C0_COMPARE
  121. li a0, BOOT_WARM_AUTOBOOT  /* push start type arg = WARM_BOOT */
  122. jal usrInit /* never returns - starts up kernel */
  123. li ra, R_VEC /* load prom reset address */
  124. j ra /* just in case */
  125. .end sysInit
  127. /*******************************************************************************
  128. *
  129. * sysGpInit - initialize the MIPS global pointer
  130. *
  131. * The purpose of this routine is to initialize the global pointer (gp).
  132. * It is required in order support compressed ROMs.
  133. *
  134. * RETURNS: N/A
  135. *
  136. * NOMANUAL
  137. */
  139. .ent sysGpInit
  140. sysGpInit:
  141. la gp, _gp /* set global pointer from compiler */
  142. j ra
  143. .end sysGpInit
  145. /*******************************************************************************
  146. *
  147. * sysWbFlush - flush the write buffer
  148. *
  149. * This routine flushes the write buffers, making certain all subsequent
  150. * memory writes have occurred.  It is used during critical periods only, e.g.,
  151. * after memory-mapped I/O register access.
  152. *
  153. * RETURNS: N/A
  155. * sysWbFlush (void)
  157. */
  158. .ent sysWbFlush
  159. sysWbFlush:
  160. .set noreorder
  161. nop
  162.         la      v0,sysWbFlush
  163.         or      v0,K1BASE
  164.         sw      zero,0(v0)
  165.         lw      v0,0(v0)
  166.         j       ra
  167. nop
  168. .set reorder
  169. .end sysWbFlush
  171. /*******************************************************************************
  172. *
  173. * sysSetCompare - set the RC32364 timer compare register
  174. *
  175. * RETURNS: N/A
  177. * int sysSetCompare (void)
  179. */
  181. .ent sysSetCompare
  182. sysSetCompare:
  183. mtc0 a0,C0_COMPARE
  184. j ra
  185. .end sysSetCompare
  187. /*******************************************************************************
  188. *
  189. * sysGetCompare - get the RC32364 timer compare register
  190. *
  191. * RETURNS: N/A
  193. * int sysGetCompare (void)
  195. */
  197. .ent sysGetCompare
  198. sysGetCompare:
  199. mfc0 v0,C0_COMPARE
  200. j ra
  201. .end sysGetCompare
  203. /*******************************************************************************
  204. *
  205. * sysSetCount - set the RC32364 timer count register
  206. *
  207. * RETURNS: N/A
  209. * int sysSetCount (void)
  211. */
  213. .ent sysSetCount
  214. sysSetCount:
  215. mtc0 a0,C0_COUNT
  216. j ra
  217. .end sysSetCount
  219. /*******************************************************************************
  220. *
  221. * sysGetCount - get the RC32364 timer count register
  222. *
  223. * RETURNS: N/A
  225. * int sysGetCount (void)
  227. */
  229. .ent sysGetCount
  230. sysGetCount:
  231. mfc0 v0,C0_COUNT
  232. j ra
  233. .end sysGetCount
  235. /*******************************************************************************
  236. *
  237. * sysGetPrid - get the RC32364 processor ID register
  238. *
  239. * RETURNS: N/A
  241. * int sysGetPrid (void)
  243. */
  244. .ent sysGetPrid
  245. sysGetPrid:
  246. mfc0 v0,C0_PRID
  247. j ra
  248. .end sysGetPrid
  251. #define DELAY1 300000
  252. #define DELAY2 600000
  255. /* Tlb Related functions */
  256. /*****************************************************
  257. * setPageSize      - Sets the MMU page size
  258. *
  259. * Input parameters -
  260. *               a0 - PageSize
  261. */
  263.         .ent setPageSize
  264. setPageSize:
  265.         .set noreorder
  266.          nop
  267.          nop
  268.          mtc0  a0,C0_PAGEMASK
  269.          nop
  270.          nop
  271.         .set reorder
  272.          j    ra
  273.          nop
  274.         .end setPageSize
  276.          
  277. /***************************************************
  278. * setTlbEntry      - sets one MMU entry
  279. *
  280. * Input parameters -
  281. *                a0- Tlb_Inx
  282. *                a1- Tlb_Hi
  283. *                a2- Tlb_Lo0
  284. *                a3- Tlb_Lo1
  285. */
  287.          .ent setTlbEntry
  288. setTlbEntry:
  289.          .set noreorder
  290.           nop
  291.           nop
  292.           mtc0 a0,C0_INX
  293.           nop
  294.           nop
  295.           mtc0 a1,C0_TLBHI
  296.           nop
  297.           nop
  298.           mtc0 a2,C0_TLBLO0
  299.           nop
  300.           nop
  301.           mtc0 a3,C0_TLBLO1
  302.           nop
  303.           nop
  304.           nop
  305.           nop
  306.           nop
  307.           nop
  308.           tlbwi
  309.           nop
  310.           nop
  311.           nop
  312.           .set reorder
  313.  
  314.          j      ra
  315.          nop
  316.          .end setTlbEntry
  319. /*******************************************************************************
  320. *
  321. * sysInByte - input one byte from I/O space
  322. *
  323. * RETURNS: Byte data from the I/O port.
  324.  
  325. * UCHAR sysInByte (address)
  326. *     int address;      /@ I/O port address @/
  327.  
  328. */
  330.           .ent sysinbyte
  331. sysinbyte:
  332.           .set noreorder
  333.            lb   v0, 0x0(a0)
  334.            nop
  335.            j    ra
  336.            nop
  337.           .set reorder
  338.           .end sysinbyte
  340. /*******************************************************************************
  341. *
  342. * sysInWord - input one word from I/O space
  343. *
  344. * RETURNS: Word data from the I/O port.
  345.  
  346. * USHORT sysInWord (address)
  347. *     int address;      /@ I/O port address @/
  348.  
  349. */
  350.            .ent  sysinword
  351. sysinword:
  352.           .set noreorder
  353.            lh   v0,0x0(a0)
  354.            j    ra
  355.            nop
  356.           .set reorder
  357.           .end sysinword
  358. /*******************************************************************************
  359. *
  360. * sysInLong - input one long-word from I/O space
  361. *
  362. * RETURNS: Long-Word data from the I/O port.
  363.  
  364. * USHORT sysInLong (address)
  365. *     int address;      /@ I/O port address @/
  366.  
  367. */
  368.            .ent sysinlong
  369. sysinlong:
  370.            .set noreorder
  371.             lw  v0 ,0(a0)
  372.             nop
  373.             j   ra
  374.             nop
  375.            .set reorder
  376.            .end sysinlong
  377. /*******************************************************************************
  378. *
  379. * sysoutByte - output one byte to I/O space
  380. *
  381. * RETURNS: N/A
  382.  
  383. * void sysOutByte (address, data)
  384. *     int address;      /@ I/O port address @/
  385. *     char data;        /@ data written to the port @/
  386.  
  387. */
  388.             .ent sysoutbyte
  389. sysoutbyte: 
  390.              .set noreorder
  391.              li   t0, 0x3
  392.              xor  a0, t0
  393.              sb   a1,0(a0)
  394.              nop
  395.              j    ra
  396.              nop
  397.             .set reorder
  398.             .end sysoutbyte
  400. /*******************************************************************************
  401. *
  402. * sysoutWord - output one word to I/O space
  403. *
  404. * RETURNS: N/A
  405.  
  406. * void sysOutWord (address, data)
  407. *     int address;      /@ I/O port address @/
  408. *     short data;       /@ data written to the port @/
  409.  
  410. */
  411.              .ent sysoutword
  412. sysoutword:
  413.              .set noreorder
  414.               sh  a1,0(a0)
  415.               nop
  416.               j   ra
  417.               nop
  418.              .set reorder
  419.              .end sysoutword
  420. /*******************************************************************************
  421. *
  422. * sysOutLong - output one long-word to I/O space
  423. *
  424. * RETURNS: N/A
  425.  
  426. * void sysOutLong (address, data)
  427. *     int address;      /@ I/O port address @/
  428. *     long data;        /@ data written to the port @/
  429.  
  430. */
  431.              .ent sysoutlong
  432. sysoutlong:
  433.              .set noreorder
  434.               sw  a1,0(a0)
  435.               nop
  436.               j   ra
  437.               nop
  438.              .set reorder
  439.              .end sysoutlong
  441. /*****************************************************************************
  442. *
  443. * sysgetConfig - Returns the Config register contents
  444. *
  445. *
  446. */
  447.              .ent sysGetConfig
  448. sysGetConfig:
  449.              .set noreorder
  450.               mfc0 v0,C0_CONFIG
  451.               nop
  452.               nop
  453.               j   ra
  454.               nop
  455.              .set reorder
  456.              .end sysGetConfig
  457.              
  459. /************************************************************************/
  460. /*     ReadCP0_16 :                                                     */
  461. /*                                                                      */
  462. /*      SYNTAX: unsigned long ReadCP0_16(void);                         */
  463. /*     RETURNS: CP0 value                                               */
  464. /*                                                                      */
  465. /************************************************************************/
  466. .ent ReadCP0_16
  467. ReadCP0_16:
  468. .set noreorder
  469. mfc0 v0, $16
  470. nop
  471. j ra
  472. nop
  473. .set reorder
  474. .end ReadCP0_16
  477. /************************************************************************
  478. */
  479. /*     ReadCP0_22 :
  480. /*                                                                      *
  481. */
  482. /*      SYNTAX: unsigned long ReadCP0_22(void);                         *
  483. */
  484. /*     RETURNS: CP0 value                                               *
  485. */
  486. /*                                                                      *
  487. */
  488. /************************************************************************
  489. */
  490. .ent ReadCP0_22
  491. ReadCP0_22:
  492. .set noreorder
  493. mfc0 v0, $22
  494. nop
  495. j ra
  496. nop
  497. .set reorder
  498. .end ReadCP0_22
  499.         
  500. /************************************************************************ */
  501. /*     ReadSR : Read the SR (Status Register)                           * */
  502. /*                                                                      * */
  503. /*      SYNTAX: unsigned long ReadSR(void);                             * */
  504. /*     RETURNS: SR value                                                * */
  505. /*                                                                      * */
  506. /************************************************************************ */
  507. .ent ReadSR
  508. ReadSR:
  509. .set noreorder
  510. mfc0 v0, C0_SR
  511. nop
  512. j ra
  513. nop
  514. .set reorder
  515. .end ReadSR
  517. /************************************************************************ */
  518. /*     SetSR  : Set the SR (Status Register)                            * */
  519. /*                                                                      * */
  520. /*      SYNTAX: unsigned long ReadSR(unsigned long);                    * */
  521. /*     RETURNS: SR value                                                * */
  522. /*                                                                      * */
  523. /************************************************************************ */
  524. .ent SetSR
  525. SetSR:
  526. .set    noreorder
  527. mfc0    v0, C0_SR
  528. nop
  529. mtc0    a0, C0_SR
  530. nop
  531. j       ra
  532. nop
  533. .set    reorder
  534. .end SetSR
  535.         
  537. #define CACHEBITS       3
  538. #define WRITETHROUGH    0
  539. #define CACHEDISABLE    2
  540. #define CACHEWRITEBACK  3  
  542. /***********************************************************************/
  543. /*                                                                     */
  544. /*     EnableCache: enable the caches        */
  545. /*                                                                     */
  546. /***********************************************************************/
  547. .ent EnableCache
  548. EnableCache:
  550. .set noreorder
  552.         /* Caches must be enabled from KSEG1 */        
  553.         la      t0, 1f
  554.         li      t1, K1BASE             
  555.         or      t0, t1                 
  556.         j       t0
  557.         nop
  558. 1:
  560. mfc0 t1, $16
  561. nop
  563.         and t1, t1, ~(CACHEBITS)
  564.         
  565. #if USER_D_CACHE_MODE == CACHE_DISABLED
  566.         or t1, t1, CACHEDISABLE
  567. #else        
  568. #if USER_D_CACHE_MODE == CACHE_COPYBACK
  569. or     t1, t1, CACHEWRITEBACK 
  570. #endif
  571. #endif
  573. mtc0 t1, $16 # enable D Cache
  574.         nop
  576. j ra
  577. nop
  578. .set reorder
  579. .end EnableCache
  580.                   
  581. /************************************************************************/
  582. /*                                                                      */
  583. /*     DisableCache: disable the caches         */
  584. /*                                                                      */
  585. /************************************************************************/
  586. .ent DisableCache
  587. DisableCache:
  589. .set noreorder
  590. mfc0 t1, $16
  591. nop
  592.         and t1, t1, ~(CACHEBITS)
  593.         or      t1, t1, CACHEDISABLE
  594. mtc0 t1, $16  # disable D Cache
  595. j ra
  596. nop
  597. .set reorder
  598. .end DisableCache
  599.         
  600. /* Some performance and debug tools */
  601.         
  602.         .globl readCount
  603.         .globl readInstr
  604. .globl readStatus
  605. .globl readConfig
  606.         
  607. #define MFC0_SEL_OPCODE(dst, src, sel)
  608.    .word (0x40000000 | ((dst)<<16) | ((src)<<11) | (sel))
  610. #define MTC0_SEL_OPCODE(dst, src, sel)
  611.    .word (0x40800000 | ((dst)<<16) | ((src)<<11) | (sel))
  612.                 
  613. #define INSTR      4
  616.         .set    noreorder
  617.                 
  618.         .ent    readCount
  619. readCount:
  621. mfc0 v0, C0_COUNT
  622.         nop
  623.         
  624.         jr      ra
  625.         nop
  626.         
  627.         .end    readCount        
  628.         
  629.         .ent    readInstr
  631. readInstr:
  633.         MFC0_SEL_OPCODE(2, 25, INSTR)
  634.         nop
  635.         
  636.         jr      ra
  637.         nop
  638.         
  639.         .end    readInstr
  641. .ent readStatus
  642. readStatus:
  643. mfc0 v0, $12
  644. nop
  646. jr ra
  647. nop
  649. .end readStatus
  651. .ent readConfig
  652. readConfig:
  653. mfc0 v0, $16
  654. nop
  656. jr ra
  657. nop
  659. .end readConfig
  662. /*************************************************************
  663. *
  664. * Support functions for sysBackTrace
  665. *
  666. */
  667.         
  668.              .ent vxSpGet
  669. vxSpGet:
  670.               .set noreorder
  671.                j ra
  672.                or v0,sp,sp
  673.                .set reorder
  674.                .end vxSpGet
  677.               .ent vxPcGet
  678. vxPcGet:
  679.               .set noreorder
  680.                or v0,ra,ra
  681.                j ra
  682.                nop
  683.                .set reorder
  684.                .end vxPcGet