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

源码开发语言/平台
当前位置：首页 > 源码/资料 > Linux/Unix编程 > 查看源码
misc.S
资源名称：linux-2.4.20.tar.gz　[点击查看]
上传用户：jlfgdled
上传日期：2013-04-10
资源大小：33168k
文件大小：23k
源码类别：

Linux/Unix编程

开发平台：

Unix_Linux

misc.S：源码内容
  1. /*
  2.  * BK Id: %F% %I% %G% %U% %#%
  3.  */
  4. /*
  5.  * This file contains miscellaneous low-level functions.
  6.  *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
  7.  *
  8.  * Largely rewritten by Cort Dougan (cort@cs.nmt.edu)
  9.  * and Paul Mackerras.
  10.  *
  11.  * This program is free software; you can redistribute it and/or
  12.  * modify it under the terms of the GNU General Public License
  13.  * as published by the Free Software Foundation; either version
  14.  * 2 of the License, or (at your option) any later version.
  15.  *
  16.  */
  18. #include <linux/config.h>
  19. #include <linux/sys.h>
  20. #include <asm/unistd.h>
  21. #include <asm/errno.h>
  22. #include <asm/processor.h>
  23. #include <asm/page.h>
  24. #include <asm/cache.h>
  25. #include <asm/cputable.h>
  26. #include <asm/mmu.h>
  27. #include <asm/ppc_asm.h>
  28. #include "ppc_defs.h"
  30. .text
  32. .align 5
  33. _GLOBAL(__delay)
  34. cmpwi 0,r3,0
  35. mtctr r3
  36. beqlr
  37. 1: bdnz 1b
  38. blr
  40. /*
  41.  * Returns (address we're running at) - (address we were linked at)
  42.  * for use before the text and data are mapped to KERNELBASE.
  43.  */
  44. _GLOBAL(reloc_offset)
  45. mflr r0
  46. bl 1f
  47. 1: mflr r3
  48. lis r4,1b@ha
  49. addi r4,r4,1b@l
  50. subf r3,r4,r3
  51. mtlr r0
  52. blr
  54. /*
  55.  * add_reloc_offset(x) returns x + reloc_offset().
  56.  */
  57. _GLOBAL(add_reloc_offset)
  58. mflr r0
  59. bl 1f
  60. 1: mflr r5
  61. lis r4,1b@ha
  62. addi r4,r4,1b@l
  63. subf r5,r4,r5
  64. add r3,r3,r5
  65. mtlr r0
  66. blr
  68. /*
  69.  * sub_reloc_offset(x) returns x - reloc_offset().
  70.  */
  71. _GLOBAL(sub_reloc_offset)
  72. mflr r0
  73. bl 1f
  74. 1: mflr r5
  75. lis r4,1b@ha
  76. addi r4,r4,1b@l
  77. subf r5,r4,r5
  78. subf r3,r5,r3
  79. mtlr r0
  80. blr
  82. /*
  83.  * reloc_got2 runs through the .got2 section adding an offset
  84.  * to each entry.
  85.  */
  86. _GLOBAL(reloc_got2)
  87. mflr r11
  88. lis r7,__got2_start@ha
  89. addi r7,r7,__got2_start@l
  90. lis r8,__got2_end@ha
  91. addi r8,r8,__got2_end@l
  92. subf r8,r7,r8
  93. srwi. r8,r8,2
  94. beqlr
  95. mtctr r8
  96. bl 1f
  97. 1: mflr r0
  98. lis r4,1b@ha
  99. addi r4,r4,1b@l
  100. subf r0,r4,r0
  101. add r7,r0,r7
  102. 2: lwz r0,0(r7)
  103. add r0,r0,r3
  104. stw r0,0(r7)
  105. addi r7,r7,4
  106. bdnz 2b
  107. mtlr r11
  108. blr
  110. /*
  111.  * identify_cpu,
  112.  * called with r3 = data offset and r4 = CPU number
  113.  * doesn't change r3
  114.  */
  115. _GLOBAL(identify_cpu)
  116. addis r8,r3,cpu_specs@ha
  117. addi r8,r8,cpu_specs@l
  118. mfpvr r7
  119. 1:
  120. lwz r5,CPU_SPEC_PVR_MASK(r8)
  121. and r5,r5,r7
  122. lwz r6,CPU_SPEC_PVR_VALUE(r8)
  123. cmplw 0,r6,r5
  124. beq 1f
  125. addi r8,r8,CPU_SPEC_ENTRY_SIZE
  126. b 1b
  127. 1:
  128. addis r6,r3,cur_cpu_spec@ha
  129. addi r6,r6,cur_cpu_spec@l
  130. slwi r4,r4,2
  131. sub r8,r8,r3
  132. stwx r8,r4,r6
  133. blr
  135. /*
  136.  * do_cpu_ftr_fixups - goes through the list of CPU feature fixups
  137.  * and writes nop's over sections of code that don't apply for this cpu.
  138.  * r3 = data offset (not changed)
  139.  */
  140. _GLOBAL(do_cpu_ftr_fixups)
  141. /* Get CPU 0 features */
  142. addis r6,r3,cur_cpu_spec@ha
  143. addi r6,r6,cur_cpu_spec@l
  144. lwz r4,0(r6)
  145. add r4,r4,r3
  146. lwz r4,CPU_SPEC_FEATURES(r4)
  148. /* Get the fixup table */
  149. addis r6,r3,__start___ftr_fixup@ha
  150. addi r6,r6,__start___ftr_fixup@l
  151. addis r7,r3,__stop___ftr_fixup@ha
  152. addi r7,r7,__stop___ftr_fixup@l
  154. /* Do the fixup */
  155. 1: cmplw 0,r6,r7
  156. bgelr
  157. addi r6,r6,16
  158. lwz r8,-16(r6) /* mask */
  159. and r8,r8,r4
  160. lwz r9,-12(r6) /* value */
  161. cmplw 0,r8,r9
  162. beq 1b
  163. lwz r8,-8(r6) /* section begin */
  164. lwz r9,-4(r6) /* section end */
  165. subf. r9,r8,r9
  166. beq 1b
  167. /* write nops over the section of code */
  168. /* todo: if large section, add a branch at the start of it */
  169. srwi r9,r9,2
  170. mtctr r9
  171. add r8,r8,r3
  172. lis r0,0x60000000@h /* nop */
  173. 3: stw r0,0(r8)
  174. andi. r10,r4,CPU_FTR_SPLIT_ID_CACHE@l
  175. beq 2f
  176. dcbst 0,r8 /* suboptimal, but simpler */
  177. sync
  178. icbi 0,r8
  179. 2: addi r8,r8,4
  180. bdnz 3b
  181. sync /* additional sync needed on g4 */
  182. isync
  183. b 1b
  185. /*
  186.  * call_setup_cpu - call the setup_cpu function for this cpu
  187.  * r3 = data offset, r24 = cpu number
  188.  *
  189.  * Setup function is called with:
  190.  *   r3 = data offset
  191.  *   r4 = CPU number
  192.  *   r5 = ptr to CPU spec (relocated)
  193.  */
  194. _GLOBAL(call_setup_cpu)
  195. addis r5,r3,cur_cpu_spec@ha
  196. addi r5,r5,cur_cpu_spec@l
  197. slwi r4,r24,2
  198. lwzx r5,r4,r5
  199. add r5,r5,r3
  200. lwz r6,CPU_SPEC_SETUP(r5)
  201. add r6,r6,r3
  202. mtctr r6
  203. mr r4,r24
  204. bctr
  206. /* void __save_flags_ptr(unsigned long *flags) */
  207. _GLOBAL(__save_flags_ptr)
  208. mfmsr r4
  209. stw r4,0(r3)
  210. blr
  211. /* 
  212.  * Need these nops here for taking over save/restore to
  213.  * handle lost intrs
  214.  * -- Cort
  215.  */
  216. nop
  217. nop
  218. nop
  219. nop
  220. nop
  221. nop
  222. nop
  223. nop
  224. nop
  225. nop
  226. nop
  227. nop
  228. nop
  229. nop
  230. nop
  231. nop
  232. nop
  233. _GLOBAL(__save_flags_ptr_end)
  235. /* void __restore_flags(unsigned long flags) */
  236. _GLOBAL(__restore_flags)
  237. /*
  238.  * Just set/clear the MSR_EE bit through restore/flags but do not
  239.  * change anything else.  This is needed by the RT system and makes
  240.  * sense anyway.
  241.  *    -- Cort
  242.  */
  243. mfmsr  r4
  244. /* Copy all except the MSR_EE bit from r4 (current MSR value)
  245.    to r3.  This is the sort of thing the rlwimi instruction is
  246.    designed for.  -- paulus. */
  247. rlwimi r3,r4,0,17,15
  248.  /* Check if things are setup the way we want _already_. */
  249. cmpw 0,r3,r4
  250. beqlr
  251. 1: SYNC
  252. mtmsr r3
  253. SYNC
  254. blr
  255. nop
  256. nop
  257. nop
  258. nop
  259. nop
  260. nop
  261. nop
  262. nop
  263. nop
  264. nop
  265. nop
  266. nop
  267. nop
  268. nop
  269. nop
  270. nop
  271. nop
  272. nop
  273. nop
  274. _GLOBAL(__restore_flags_end)
  276. _GLOBAL(__cli)
  277. mfmsr r0 /* Get current interrupt state */
  278. rlwinm r3,r0,16+1,32-1,31 /* Extract old value of 'EE' */
  279. rlwinm r0,r0,0,17,15 /* clear MSR_EE in r0 */
  280. SYNC /* Some chip revs have problems here... */
  281. mtmsr r0 /* Update machine state */
  282. blr /* Done */
  283. /* 
  284.  * Need these nops here for taking over save/restore to
  285.  * handle lost intrs
  286.  * -- Cort
  287.  */
  288. nop
  289. nop
  290. nop
  291. nop
  292. nop
  293. nop
  294. nop
  295. nop
  296. nop
  297. nop
  298. nop
  299. nop
  300. nop
  301. nop
  302. nop
  303. _GLOBAL(__cli_end)
  305. _GLOBAL(__sti)
  306. mfmsr r3 /* Get current state */
  307. ori r3,r3,MSR_EE /* Turn on 'EE' bit */
  308. SYNC /* Some chip revs have problems here... */
  309. mtmsr r3 /* Update machine state */
  310. blr
  311. /* 
  312.  * Need these nops here for taking over save/restore to
  313.  * handle lost intrs
  314.  * -- Cort
  315.  */
  316. nop
  317. nop
  318. nop
  319. nop
  320. nop
  321. nop
  322. nop
  323. nop
  324. nop
  325. nop
  326. nop
  327. nop
  328. nop
  329. nop
  330. nop
  331. nop
  332. _GLOBAL(__sti_end)
  335. /*
  336.  * complement mask on the msr then "or" some values on.
  337.  *     _nmask_and_or_msr(nmask, value_to_or)
  338.  */
  339. _GLOBAL(_nmask_and_or_msr)
  340. mfmsr r0 /* Get current msr */
  341. andc r0,r0,r3 /* And off the bits set in r3 (first parm) */
  342. or r0,r0,r4 /* Or on the bits in r4 (second parm) */
  343. sync /* Some chip revs have problems here... */
  344. isync
  345. mtmsr r0 /* Update machine state */
  346. isync
  347. blr /* Done */
  350. /*
  351.  * Flush MMU TLB
  352.  */
  353. _GLOBAL(_tlbia)
  354. #if defined(CONFIG_SMP)
  355. mfmsr r10
  356. SYNC
  357. rlwinm r0,r10,0,17,15 /* clear bit 16 (MSR_EE) */
  358. mtmsr r0
  359. SYNC
  360. lis r9,hash_table_lock@h
  361. ori r9,r9,hash_table_lock@l
  362. lwz r8,PROCESSOR(r2)
  363. oris r8,r8,10
  364. 10: lwarx r7,0,r9
  365. cmpi 0,r7,0
  366. bne- 10b
  367. stwcx. r8,0,r9
  368. bne- 10b
  369. #endif /* CONFIG_SMP */
  370. isync
  371. tlbia
  372. sync
  373. #ifdef CONFIG_SMP
  374. TLBSYNC
  375. li r0,0
  376. stw r0,0(r9) /* clear hash_table_lock */
  377. mtmsr r10
  378. SYNC
  379. #endif /* CONFIG_SMP */
  380. blr
  382. /*
  383.  * Flush MMU TLB for a particular address
  384.  */
  385. _GLOBAL(_tlbie)
  386. #if defined(CONFIG_SMP)
  387. mfmsr r10
  388. SYNC
  389. rlwinm r0,r10,0,17,15 /* clear bit 16 (MSR_EE) */
  390. mtmsr r0
  391. SYNC
  392. lis r9,hash_table_lock@h
  393. ori r9,r9,hash_table_lock@l
  394. lwz r8,PROCESSOR(r2)
  395. oris r8,r8,11
  396. 10: lwarx r7,0,r9
  397. cmpi 0,r7,0
  398. bne- 10b
  399. stwcx. r8,0,r9
  400. bne- 10b
  401. #endif /* CONFIG_SMP */
  402. isync
  403. tlbie r3
  404. sync
  405. #ifdef CONFIG_SMP
  406. TLBSYNC
  407. li r0,0
  408. stw r0,0(r9) /* clear hash_table_lock */
  409. mtmsr r10
  410. SYNC
  411. #endif
  412. blr
  414. /*
  415.  * Flush instruction cache.
  416.  * This is a no-op on the 601.
  417.  */
  418. _GLOBAL(flush_instruction_cache)
  419. #if defined(CONFIG_8xx)
  420. isync
  421. lis r5, IDC_INVALL@h
  422. mtspr IC_CST, r5
  423. #elif defined(CONFIG_4xx)
  424. lis r3, KERNELBASE@h
  425. iccci 0,r3
  426. #else
  427. mfspr r3,PVR
  428. rlwinm r3,r3,16,16,31
  429. cmpi 0,r3,1
  430. beqlr /* for 601, do nothing */
  431. /* 603/604 processor - use invalidate-all bit in HID0 */
  432. mfspr r3,HID0
  433. ori r3,r3,HID0_ICFI
  434. mtspr HID0,r3
  435. #endif /* CONFIG_8xx */
  436. isync
  437. blr
  439. /*
  440.  * Write any modified data cache blocks out to memory
  441.  * and invalidate the corresponding instruction cache blocks.
  442.  * This is a no-op on the 601.
  443.  *
  444.  * flush_icache_range(unsigned long start, unsigned long stop)
  445.  */
  446. _GLOBAL(flush_icache_range)
  447. mfspr r5,PVR
  448. rlwinm r5,r5,16,16,31
  449. cmpi 0,r5,1
  450. beqlr /* for 601, do nothing */
  451. li r5,L1_CACHE_LINE_SIZE-1
  452. andc r3,r3,r5
  453. subf r4,r3,r4
  454. add r4,r4,r5
  455. srwi. r4,r4,LG_L1_CACHE_LINE_SIZE
  456. beqlr
  457. mtctr r4
  458. mr r6,r3
  459. 1: dcbst 0,r3
  460. addi r3,r3,L1_CACHE_LINE_SIZE
  461. bdnz 1b
  462. sync /* wait for dcbst's to get to ram */
  463. mtctr r4
  464. 2: icbi 0,r6
  465. addi r6,r6,L1_CACHE_LINE_SIZE
  466. bdnz 2b
  467. sync /* additional sync needed on g4 */
  468. isync
  469. blr
  470. /*
  471.  * Write any modified data cache blocks out to memory.
  472.  * Does not invalidate the corresponding cache lines (especially for
  473.  * any corresponding instruction cache).
  474.  *
  475.  * clean_dcache_range(unsigned long start, unsigned long stop)
  476.  */
  477. _GLOBAL(clean_dcache_range)
  478. li r5,L1_CACHE_LINE_SIZE-1
  479. andc r3,r3,r5
  480. subf r4,r3,r4
  481. add r4,r4,r5
  482. srwi. r4,r4,LG_L1_CACHE_LINE_SIZE
  483. beqlr
  484. mtctr r4
  486. 1: dcbst 0,r3
  487. addi r3,r3,L1_CACHE_LINE_SIZE
  488. bdnz 1b
  489. sync /* wait for dcbst's to get to ram */
  490. blr
  492. /*
  493.  * Write any modified data cache blocks out to memory and invalidate them.
  494.  * Does not invalidate the corresponding instruction cache blocks.
  495.  *
  496.  * flush_dcache_range(unsigned long start, unsigned long stop)
  497.  */
  498. _GLOBAL(flush_dcache_range)
  499. li r5,L1_CACHE_LINE_SIZE-1
  500. andc r3,r3,r5
  501. subf r4,r3,r4
  502. add r4,r4,r5
  503. srwi. r4,r4,LG_L1_CACHE_LINE_SIZE
  504. beqlr
  505. mtctr r4
  507. 1: dcbf 0,r3
  508. addi r3,r3,L1_CACHE_LINE_SIZE
  509. bdnz 1b
  510. sync /* wait for dcbst's to get to ram */
  511. blr
  513. /*
  514.  * Like above, but invalidate the D-cache.  This is used by the 8xx
  515.  * to invalidate the cache so the PPC core doesn't get stale data
  516.  * from the CPM (no cache snooping here :-).
  517.  *
  518.  * invalidate_dcache_range(unsigned long start, unsigned long stop)
  519.  */
  520. _GLOBAL(invalidate_dcache_range)
  521. li r5,L1_CACHE_LINE_SIZE-1
  522. andc r3,r3,r5
  523. subf r4,r3,r4
  524. add r4,r4,r5
  525. srwi. r4,r4,LG_L1_CACHE_LINE_SIZE
  526. beqlr
  527. mtctr r4
  529. 1: dcbi 0,r3
  530. addi r3,r3,L1_CACHE_LINE_SIZE
  531. bdnz 1b
  532. sync /* wait for dcbi's to get to ram */
  533. blr
  535. /*
  536.  * Flush a particular page from the data cache to RAM.
  537.  * Note: this is necessary because the instruction cache does *not*
  538.  * snoop from the data cache.
  539.  * This is a no-op on the 601 which has a unified cache.
  540.  *
  541.  * void __flush_dcache_icache(void *page)
  542.  */
  543. _GLOBAL(__flush_dcache_icache)
  544. mfspr r5,PVR
  545. rlwinm r5,r5,16,16,31
  546. cmpi 0,r5,1
  547. beqlr /* for 601, do nothing */
  548. rlwinm r3,r3,0,0,19 /* Get page base address */
  549. li r4,4096/L1_CACHE_LINE_SIZE /* Number of lines in a page */
  550. mtctr r4
  551. mr r6,r3
  552. 0: dcbst 0,r3 /* Write line to ram */
  553. addi r3,r3,L1_CACHE_LINE_SIZE
  554. bdnz 0b
  555. sync
  556. mtctr r4
  557. 1: icbi 0,r6
  558. addi r6,r6,L1_CACHE_LINE_SIZE
  559. bdnz 1b
  560. sync
  561. isync
  562. blr
  564. /*
  565.  * Clear a page using the dcbz instruction, which doesn't cause any
  566.  * memory traffic (except to write out any cache lines which get
  567.  * displaced).  This only works on cacheable memory.
  568.  */
  569. _GLOBAL(clear_page)
  570. li r0,4096/L1_CACHE_LINE_SIZE
  571. mtctr r0
  572. #ifdef CONFIG_8xx
  573. li r4, 0
  574. 1: stw r4, 0(r3)
  575. stw r4, 4(r3)
  576. stw r4, 8(r3)
  577. stw r4, 12(r3)
  578. #else
  579. 1: dcbz 0,r3
  580. #endif
  581. addi r3,r3,L1_CACHE_LINE_SIZE
  582. bdnz 1b
  583. blr
  585. /*
  586.  * Copy a whole page.  We use the dcbz instruction on the destination
  587.  * to reduce memory traffic (it eliminates the unnecessary reads of
  588.  * the destination into cache).  This requires that the destination
  589.  * is cacheable.
  590.  */
  591. #define COPY_16_BYTES
  592. lwz r6,4(r4);
  593. lwz r7,8(r4);
  594. lwz r8,12(r4);
  595. lwzu r9,16(r4);
  596. stw r6,4(r3);
  597. stw r7,8(r3);
  598. stw r8,12(r3);
  599. stwu r9,16(r3)
  601. _GLOBAL(copy_page)
  602. addi r3,r3,-4
  603. addi r4,r4,-4
  604. li r5,4
  606. #ifndef CONFIG_8xx
  607. #if MAX_L1_COPY_PREFETCH > 1
  608. li r0,MAX_L1_COPY_PREFETCH
  609. li r11,4
  610. mtctr r0
  611. 11: dcbt r11,r4
  612. addi r11,r11,L1_CACHE_LINE_SIZE
  613. bdnz 11b
  614. #else /* MAX_L1_COPY_PREFETCH == 1 */
  615. dcbt r5,r4
  616. li r11,L1_CACHE_LINE_SIZE+4
  617. #endif /* MAX_L1_COPY_PREFETCH */
  618. #endif /* CONFIG_8xx */
  620. li r0,4096/L1_CACHE_LINE_SIZE
  621. mtctr r0
  622. 1:
  623. #ifndef CONFIG_8xx
  624. dcbt r11,r4
  625. dcbz r5,r3
  626. #endif
  627. COPY_16_BYTES
  628. #if L1_CACHE_LINE_SIZE >= 32
  629. COPY_16_BYTES
  630. #if L1_CACHE_LINE_SIZE >= 64
  631. COPY_16_BYTES
  632. COPY_16_BYTES
  633. #if L1_CACHE_LINE_SIZE >= 128
  634. COPY_16_BYTES
  635. COPY_16_BYTES
  636. COPY_16_BYTES
  637. COPY_16_BYTES
  638. #endif
  639. #endif
  640. #endif
  641. bdnz 1b
  642. blr
  644. /*
  645.  * Atomic [test&set] exchange
  646.  *
  647.  * unsigned long xchg_u32(void *ptr, unsigned long val)
  648.  * Changes the memory location '*ptr' to be val and returns
  649.  * the previous value stored there.
  650.  */
  651. _GLOBAL(xchg_u32)
  652. mr r5,r3 /* Save pointer */
  653. 10: lwarx r3,0,r5 /* Fetch old value & reserve */
  654. stwcx. r4,0,r5 /* Update with new value */
  655. bne- 10b /* Retry if "reservation" (i.e. lock) lost */
  656. blr
  658. /*
  659.  * void atomic_clear_mask(atomic_t mask, atomic_t *addr)
  660.  * void atomic_set_mask(atomic_t mask, atomic_t *addr);
  661.  */
  662. _GLOBAL(atomic_clear_mask)
  663. 10: lwarx r5,0,r4
  664. andc r5,r5,r3
  665. stwcx. r5,0,r4
  666. bne- 10b
  667. blr
  668. _GLOBAL(atomic_set_mask)
  669. 10: lwarx r5,0,r4
  670. or r5,r5,r3
  671. stwcx. r5,0,r4
  672. bne- 10b
  673. blr
  675. /*
  676.  * I/O string operations
  677.  *
  678.  * insb(port, buf, len)
  679.  * outsb(port, buf, len)
  680.  * insw(port, buf, len)
  681.  * outsw(port, buf, len)
  682.  * insl(port, buf, len)
  683.  * outsl(port, buf, len)
  684.  * insw_ns(port, buf, len)
  685.  * outsw_ns(port, buf, len)
  686.  * insl_ns(port, buf, len)
  687.  * outsl_ns(port, buf, len)
  688.  *
  689.  * The *_ns versions don't do byte-swapping.
  690.  */
  691. _GLOBAL(_insb)
  692. cmpwi 0,r5,0
  693. mtctr r5
  694. subi r4,r4,1
  695. blelr-
  696. 00: lbz r5,0(r3)
  697. eieio
  698. stbu r5,1(r4)
  699. bdnz 00b
  700. blr
  702. _GLOBAL(_outsb)
  703. cmpwi 0,r5,0
  704. mtctr r5
  705. subi r4,r4,1
  706. blelr-
  707. 00: lbzu r5,1(r4)
  708. stb r5,0(r3)
  709. eieio
  710. bdnz 00b
  711. blr
  713. _GLOBAL(_insw)
  714. cmpwi 0,r5,0
  715. mtctr r5
  716. subi r4,r4,2
  717. blelr-
  718. 00: lhbrx r5,0,r3
  719. eieio
  720. sthu r5,2(r4)
  721. bdnz 00b
  722. blr
  724. _GLOBAL(_outsw)
  725. cmpwi 0,r5,0
  726. mtctr r5
  727. subi r4,r4,2
  728. blelr-
  729. 00: lhzu r5,2(r4)
  730. eieio
  731. sthbrx r5,0,r3
  732. bdnz 00b
  733. blr
  735. _GLOBAL(_insl)
  736. cmpwi 0,r5,0
  737. mtctr r5
  738. subi r4,r4,4
  739. blelr-
  740. 00: lwbrx r5,0,r3
  741. eieio
  742. stwu r5,4(r4)
  743. bdnz 00b
  744. blr
  746. _GLOBAL(_outsl)
  747. cmpwi 0,r5,0
  748. mtctr r5
  749. subi r4,r4,4
  750. blelr-
  751. 00: lwzu r5,4(r4)
  752. stwbrx r5,0,r3
  753. eieio
  754. bdnz 00b
  755. blr
  757. _GLOBAL(ide_insw)
  758. _GLOBAL(_insw_ns)
  759. cmpwi 0,r5,0
  760. mtctr r5
  761. subi r4,r4,2
  762. blelr-
  763. 00: lhz r5,0(r3)
  764. eieio
  765. sthu r5,2(r4)
  766. bdnz 00b
  767. blr
  769. _GLOBAL(ide_outsw)
  770. _GLOBAL(_outsw_ns)
  771. cmpwi 0,r5,0
  772. mtctr r5
  773. subi r4,r4,2
  774. blelr-
  775. 00: lhzu r5,2(r4)
  776. sth r5,0(r3)
  777. eieio
  778. bdnz 00b
  779. blr
  781. _GLOBAL(_insl_ns)
  782. cmpwi 0,r5,0
  783. mtctr r5
  784. subi r4,r4,4
  785. blelr-
  786. 00: lwz r5,0(r3)
  787. eieio
  788. stwu r5,4(r4)
  789. bdnz 00b
  790. blr
  792. _GLOBAL(_outsl_ns)
  793. cmpwi 0,r5,0
  794. mtctr r5
  795. subi r4,r4,4
  796. blelr-
  797. 00: lwzu r5,4(r4)
  798. stw r5,0(r3)
  799. eieio
  800. bdnz 00b
  801. blr
  803. /*
  804.  * Extended precision shifts.
  805.  * 
  806.  * Updated to be valid for shift counts from 0 to 63 inclusive.
  807.  * -- Gabriel
  808.  *
  809.  * R3/R4 has 64 bit value
  810.  * R5    has shift count
  811.  * result in R3/R4
  812.  *
  813.  *  ashrdi3: arithmetic right shift (sign propagation)     
  814.  *  lshrdi3: logical right shift
  815.  *  ashldi3: left shift
  816.  */
  817. _GLOBAL(__ashrdi3)
  818. subfic r6,r5,32
  819. srw r4,r4,r5 # LSW = count > 31 ? 0 : LSW >> count
  820. addi r7,r5,32 # could be xori, or addi with -32
  821. slw r6,r3,r6 # t1 = count > 31 ? 0 : MSW << (32-count)
  822. rlwinm r8,r7,0,32 # t3 = (count < 32) ? 32 : 0
  823. sraw r7,r3,r7 # t2 = MSW >> (count-32)
  824. or r4,r4,r6 # LSW |= t1
  825. slw r7,r7,r8 # t2 = (count < 32) ? 0 : t2
  826. sraw r3,r3,r5 # MSW = MSW >> count
  827. or r4,r4,r7 # LSW |= t2
  828. blr
  830. _GLOBAL(__ashldi3)
  831. subfic r6,r5,32
  832. slw r3,r3,r5 # MSW = count > 31 ? 0 : MSW << count
  833. addi r7,r5,32 # could be xori, or addi with -32
  834. srw r6,r4,r6 # t1 = count > 31 ? 0 : LSW >> (32-count)
  835. slw r7,r4,r7 # t2 = count < 32 ? 0 : LSW << (count-32)
  836. or r3,r3,r6 # MSW |= t1
  837. slw r4,r4,r5 # LSW = LSW << count
  838. or r3,r3,r7 # MSW |= t2
  839. blr
  841. _GLOBAL(__lshrdi3)
  842. subfic r6,r5,32
  843. srw r4,r4,r5 # LSW = count > 31 ? 0 : LSW >> count
  844. addi r7,r5,32 # could be xori, or addi with -32
  845. slw r6,r3,r6 # t1 = count > 31 ? 0 : MSW << (32-count)
  846. srw r7,r3,r7 # t2 = count < 32 ? 0 : MSW >> (count-32)
  847. or r4,r4,r6 # LSW |= t1
  848. srw r3,r3,r5 # MSW = MSW >> count
  849. or r4,r4,r7 # LSW |= t2 
  850. blr
  852. _GLOBAL(abs)
  853. srawi r4,r3,31
  854. xor r3,r3,r4
  855. sub r3,r3,r4
  856. blr
  858. _GLOBAL(_get_SP)
  859. mr r3,r1 /* Close enough */
  860. blr
  862. /*
  863.  * These are used in the alignment trap handler when emulating
  864.  * single-precision loads and stores.
  865.  * We restore and save the fpscr so the task gets the same result
  866.  * and exceptions as if the cpu had performed the load or store.
  867.  */
  869. #if defined(CONFIG_4xx)
  870. _GLOBAL(cvt_fd)
  871. lfs 0,0(r3)
  872. stfd 0,0(r4)
  873. blr
  875. _GLOBAL(cvt_df)
  876. lfd 0,0(r3)
  877. stfs 0,0(r4)
  878. blr
  879. #else
  880. _GLOBAL(cvt_fd)
  881. lfd 0,-4(r5) /* load up fpscr value */
  882. mtfsf 0xff,0
  883. lfs 0,0(r3)
  884. stfd 0,0(r4)
  885. mffs 0 /* save new fpscr value */
  886. stfd 0,-4(r5)
  887. blr
  889. _GLOBAL(cvt_df)
  890. lfd 0,-4(r5) /* load up fpscr value */
  891. mtfsf 0xff,0
  892. lfd 0,0(r3)
  893. stfs 0,0(r4)
  894. mffs 0 /* save new fpscr value */
  895. stfd 0,-4(r5)
  896. blr
  897. #endif
  899. /*
  900.  * Create a kernel thread
  901.  *   kernel_thread(fn, arg, flags)
  902.  */
  903. _GLOBAL(kernel_thread)
  904. mr r6,r3 /* function */
  905. ori r3,r5,CLONE_VM /* flags */
  906. li r0,__NR_clone
  907. sc
  908. cmpi 0,r3,0 /* parent or child? */
  909. bnelr /* return if parent */
  910. li r0,0 /* make top-level stack frame */
  911. stwu r0,-16(r1)
  912. mtlr r6              /* fn addr in lr */
  913. mr r3,r4         /* load arg and call fn */
  914. blrl
  915. li r0,__NR_exit /* exit after child exits */
  916. li r3,0
  917. sc
  919. /*
  920.  * This routine is just here to keep GCC happy - sigh...
  921.  */
  922. _GLOBAL(__main)
  923. blr
  925. #define SYSCALL(name) 
  926. _GLOBAL(name) 
  927. li r0,__NR_##name; 
  928. sc; 
  929. bnslr; 
  930. lis r4,errno@ha; 
  931. stw r3,errno@l(r4); 
  932. li r3,-1; 
  933. blr
  935. #define __NR__exit __NR_exit
  937. SYSCALL(sync)
  938. SYSCALL(setsid)
  939. SYSCALL(write)
  940. SYSCALL(dup)
  941. SYSCALL(execve)
  942. SYSCALL(open)
  943. SYSCALL(close)
  944. SYSCALL(waitpid)
  945. SYSCALL(fork)
  946. SYSCALL(delete_module)
  947. SYSCALL(_exit)
  948. SYSCALL(lseek)
  949. SYSCALL(read)
  951. /* Why isn't this a) automatic, b) written in 'C'? */
  952. .data
  953. .align 4
  954. _GLOBAL(sys_call_table)
  955. .long sys_ni_syscall /* 0  -  old "setup()" system call */
  956. .long sys_exit
  957. .long sys_fork
  958. .long sys_read
  959. .long sys_write
  960. .long sys_open /* 5 */
  961. .long sys_close
  962. .long sys_waitpid
  963. .long sys_creat
  964. .long sys_link
  965. .long sys_unlink /* 10 */
  966. .long sys_execve
  967. .long sys_chdir
  968. .long sys_time
  969. .long sys_mknod
  970. .long sys_chmod /* 15 */
  971. .long sys_lchown
  972. .long sys_ni_syscall /* old break syscall holder */
  973. .long sys_stat
  974. .long sys_lseek
  975. .long sys_getpid /* 20 */
  976. .long sys_mount
  977. .long sys_oldumount
  978. .long sys_setuid
  979. .long sys_getuid
  980. .long sys_stime /* 25 */
  981. .long sys_ptrace
  982. .long sys_alarm
  983. .long sys_fstat
  984. .long sys_pause
  985. .long sys_utime /* 30 */
  986. .long sys_ni_syscall /* old stty syscall holder */
  987. .long sys_ni_syscall /* old gtty syscall holder */
  988. .long sys_access
  989. .long sys_nice
  990. .long sys_ni_syscall /* 35 */ /* old ftime syscall holder */
  991. .long sys_sync
  992. .long sys_kill
  993. .long sys_rename
  994. .long sys_mkdir
  995. .long sys_rmdir /* 40 */
  996. .long sys_dup
  997. .long sys_pipe
  998. .long sys_times
  999. .long sys_ni_syscall /* old prof syscall holder */
  1000. .long sys_brk /* 45 */
  1001. .long sys_setgid
  1002. .long sys_getgid
  1003. .long sys_signal
  1004. .long sys_geteuid
  1005. .long sys_getegid /* 50 */
  1006. .long sys_acct
  1007. .long sys_umount /* recycled never used phys() */
  1008. .long sys_ni_syscall /* old lock syscall holder */
  1009. .long sys_ioctl
  1010. .long sys_fcntl /* 55 */
  1011. .long sys_ni_syscall /* old mpx syscall holder */
  1012. .long sys_setpgid
  1013. .long sys_ni_syscall /* old ulimit syscall holder */
  1014. .long sys_olduname
  1015. .long sys_umask /* 60 */
  1016. .long sys_chroot
  1017. .long sys_ustat
  1018. .long sys_dup2
  1019. .long sys_getppid
  1020. .long sys_getpgrp /* 65 */
  1021. .long sys_setsid
  1022. .long sys_sigaction
  1023. .long sys_sgetmask
  1024. .long sys_ssetmask
  1025. .long sys_setreuid /* 70 */
  1026. .long sys_setregid
  1027. .long sys_sigsuspend
  1028. .long sys_sigpending
  1029. .long sys_sethostname
  1030. .long sys_setrlimit /* 75 */
  1031. .long sys_old_getrlimit
  1032. .long sys_getrusage
  1033. .long sys_gettimeofday
  1034. .long sys_settimeofday
  1035. .long sys_getgroups /* 80 */
  1036. .long sys_setgroups
  1037. .long ppc_select
  1038. .long sys_symlink
  1039. .long sys_lstat
  1040. .long sys_readlink /* 85 */
  1041. .long sys_uselib
  1042. .long sys_swapon
  1043. .long sys_reboot
  1044. .long old_readdir
  1045. .long sys_mmap /* 90 */
  1046. .long sys_munmap
  1047. .long sys_truncate
  1048. .long sys_ftruncate
  1049. .long sys_fchmod
  1050. .long sys_fchown /* 95 */
  1051. .long sys_getpriority
  1052. .long sys_setpriority
  1053. .long sys_ni_syscall /* old profil syscall holder */
  1054. .long sys_statfs
  1055. .long sys_fstatfs /* 100 */
  1056. .long sys_ioperm
  1057. .long sys_socketcall
  1058. .long sys_syslog
  1059. .long sys_setitimer
  1060. .long sys_getitimer /* 105 */
  1061. .long sys_newstat
  1062. .long sys_newlstat
  1063. .long sys_newfstat
  1064. .long sys_uname
  1065. .long sys_iopl /* 110 */
  1066. .long sys_vhangup
  1067. .long sys_ni_syscall /* old 'idle' syscall */
  1068. .long sys_vm86
  1069. .long sys_wait4
  1070. .long sys_swapoff /* 115 */
  1071. .long sys_sysinfo
  1072. .long sys_ipc
  1073. .long sys_fsync
  1074. .long sys_sigreturn
  1075. .long sys_clone /* 120 */
  1076. .long sys_setdomainname
  1077. .long sys_newuname
  1078. .long sys_modify_ldt
  1079. .long sys_adjtimex
  1080. .long sys_mprotect /* 125 */
  1081. .long sys_sigprocmask
  1082. .long sys_create_module
  1083. .long sys_init_module
  1084. .long sys_delete_module
  1085. .long sys_get_kernel_syms /* 130 */
  1086. .long sys_quotactl
  1087. .long sys_getpgid
  1088. .long sys_fchdir
  1089. .long sys_bdflush
  1090. .long sys_sysfs /* 135 */
  1091. .long sys_personality
  1092. .long sys_ni_syscall /* for afs_syscall */
  1093. .long sys_setfsuid
  1094. .long sys_setfsgid
  1095. .long sys_llseek /* 140 */
  1096. .long sys_getdents
  1097. .long ppc_select
  1098. .long sys_flock
  1099. .long sys_msync
  1100. .long sys_readv /* 145 */
  1101. .long sys_writev
  1102. .long sys_getsid
  1103. .long sys_fdatasync
  1104. .long sys_sysctl
  1105. .long sys_mlock /* 150 */
  1106. .long sys_munlock
  1107. .long sys_mlockall
  1108. .long sys_munlockall
  1109. .long sys_sched_setparam
  1110. .long sys_sched_getparam /* 155 */
  1111. .long sys_sched_setscheduler
  1112. .long sys_sched_getscheduler
  1113. .long sys_sched_yield
  1114. .long sys_sched_get_priority_max
  1115. .long sys_sched_get_priority_min  /* 160 */
  1116. .long sys_sched_rr_get_interval
  1117. .long sys_nanosleep
  1118. .long sys_mremap
  1119. .long sys_setresuid
  1120. .long sys_getresuid /* 165 */
  1121. .long sys_query_module
  1122. .long sys_poll
  1123. .long sys_nfsservctl
  1124. .long sys_setresgid
  1125. .long sys_getresgid /* 170 */
  1126. .long sys_prctl
  1127. .long sys_rt_sigreturn
  1128. .long sys_rt_sigaction
  1129. .long sys_rt_sigprocmask
  1130. .long sys_rt_sigpending /* 175 */
  1131. .long sys_rt_sigtimedwait
  1132. .long sys_rt_sigqueueinfo
  1133. .long sys_rt_sigsuspend
  1134. .long sys_pread
  1135. .long sys_pwrite /* 180 */
  1136. .long sys_chown
  1137. .long sys_getcwd
  1138. .long sys_capget
  1139. .long sys_capset
  1140. .long sys_sigaltstack /* 185 */
  1141. .long sys_sendfile
  1142. .long sys_ni_syscall /* streams1 */
  1143. .long sys_ni_syscall /* streams2 */
  1144. .long sys_vfork
  1145. .long sys_getrlimit /* 190 */
  1146. .long sys_readahead
  1147. .long sys_mmap2
  1148. .long sys_truncate64
  1149. .long sys_ftruncate64
  1150. .long sys_stat64 /* 195 */
  1151. .long sys_lstat64
  1152. .long sys_fstat64
  1153. .long sys_pciconfig_read
  1154. .long sys_pciconfig_write 
  1155. .long sys_pciconfig_iobase  /* 200 */
  1156. .long sys_ni_syscall /* 201 - reserved - MacOnLinux - new */
  1157. .long sys_getdents64
  1158. .long sys_pivot_root
  1159. .long sys_fcntl64
  1160. .long sys_madvise /* 205 */
  1161. .long sys_mincore
  1162. .long sys_gettid
  1163. .long sys_tkill
  1164. .long sys_setxattr
  1165. .long sys_lsetxattr /* 210 */
  1166. .long sys_fsetxattr
  1167. .long sys_getxattr
  1168. .long sys_lgetxattr
  1169. .long sys_fgetxattr
  1170. .long sys_listxattr /* 215 */
  1171. .long sys_llistxattr
  1172. .long sys_flistxattr
  1173. .long sys_removexattr
  1174. .long sys_lremovexattr
  1175. .long sys_fremovexattr /* 220  */
  1176. .long sys_ni_syscall  /* reserved for sys_futex */
  1177. .long sys_ni_syscall  /* reserved for sys_sched_setaffinity */
  1178. .long sys_ni_syscall  /* reserved for sys_sched_getaffinity */
  1179. .long sys_ni_syscall  /* reserved for sys_security */
  1180. .long sys_ni_syscall  /* 225 reserved for Tux */
  1181. .long sys_ni_syscall  /* reserved for sys_sendfile64 */
  1182. .long sys_ni_syscall  /* reserved for sys_io_setup */
  1183. .long sys_ni_syscall  /* reserved for sys_io_destroy */
  1184. .long sys_ni_syscall  /* reserved for sys_io_getevents */
  1185. .long sys_ni_syscall  /* 230 reserved for sys_io_submit */
  1186. .long sys_ni_syscall  /* reserved for sys_io_cancel */
  1188. .rept NR_syscalls-(.-sys_call_table)/4
  1189. .long sys_ni_syscall
  1190. .endr