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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
fp_movem.S
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：8k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

fp_movem.S：源码内容
  1. /*
  2.  * fp_movem.S
  3.  *
  4.  * Copyright Roman Zippel, 1997.  All rights reserved.
  5.  *
  6.  * Redistribution and use in source and binary forms, with or without
  7.  * modification, are permitted provided that the following conditions
  8.  * are met:
  9.  * 1. Redistributions of source code must retain the above copyright
  10.  *    notice, and the entire permission notice in its entirety,
  11.  *    including the disclaimer of warranties.
  12.  * 2. Redistributions in binary form must reproduce the above copyright
  13.  *    notice, this list of conditions and the following disclaimer in the
  14.  *    documentation and/or other materials provided with the distribution.
  15.  * 3. The name of the author may not be used to endorse or promote
  16.  *    products derived from this software without specific prior
  17.  *    written permission.
  18.  *
  19.  * ALTERNATIVELY, this product may be distributed under the terms of
  20.  * the GNU General Public License, in which case the provisions of the GPL are
  21.  * required INSTEAD OF the above restrictions.  (This clause is
  22.  * necessary due to a potential bad interaction between the GPL and
  23.  * the restrictions contained in a BSD-style copyright.)
  24.  *
  25.  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
  26.  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  27.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  28.  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
  29.  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  30.  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  31.  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  32.  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
  33.  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  34.  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
  35.  * OF THE POSSIBILITY OF SUCH DAMAGE.
  36.  */
  38. #include "fp_emu.h"
  39. #include "fp_decode.h"
  41. | set flags for decode macros for fmovem
  42. do_fmovem=1
  44. .globl fp_fmovem_fp, fp_fmovem_cr
  46. | %d1 contains the mask and count of the register list
  47. | for other register usage see fp_decode.h
  49. fp_fmovem_fp:
  50. printf PDECODE,"fmovem.x "
  51. | get register list and count them
  52. btst #11,%d2
  53. jne 1f
  54. bfextu %d2{#24,#8},%d0 | static register list
  55. jra 2f
  56. 1: bfextu %d2{#25,#3},%d0 | dynamic register list
  57. jsr fp_get_data_reg
  58. 2: move.l %d0,%d1
  59. swap %d1
  60. jra 2f
  61. 1: addq.w #1,%d1 | count the # of registers in
  62. 2: lsr.b #1,%d0 | register list and keep it in %d1
  63. jcs 1b
  64. jne 2b
  65. printf PDECODE,"#%08x",1,%d1
  66. #ifdef FPU_EMU_DEBUG
  67. btst #12,%d2
  68. jne 1f
  69. printf PDECODE,"-" | decremental move
  70. jra 2f
  71. 1: printf PDECODE,"+" | incremental move
  72. 2: btst #13,%d2
  73. jeq 1f
  74. printf PDECODE,"->" | fpu -> cpu
  75. jra 2f
  76. 1: printf PDECODE,"<-" | fpu <- cpu
  77. 2:
  78. #endif
  80. | decode address mode
  81. fp_decode_addr_mode
  83. .long fp_ill, fp_ill
  84. .long fpr_indirect, fpr_postinc
  85. .long fpr_predecr, fpr_disp16
  86. .long fpr_extmode0, fpr_extmode1
  88. | addressing mode: address register indirect
  89. fpr_indirect:
  90. fp_mode_addr_indirect
  91. jra fpr_do_movem
  93. | addressing mode: address register indirect with postincrement
  94. fpr_postinc:
  95. fp_mode_addr_indirect_postinc
  96. jra fpr_do_movem
  98. fpr_predecr:
  99. fp_mode_addr_indirect_predec
  100. jra fpr_do_movem
  102. | addressing mode: address register/programm counter indirect
  103. |    with 16bit displacement
  104. fpr_disp16:
  105. fp_mode_addr_indirect_disp16
  106. jra fpr_do_movem
  108. fpr_extmode0:
  109. fp_mode_addr_indirect_extmode0
  110. jra fpr_do_movem
  112. fpr_extmode1:
  113. fp_decode_addr_reg
  114. jmp ([0f:w,%pc,%d0*4])
  116. .align 4
  117. 0:
  118. .long fpr_absolute_short, fpr_absolute_long
  119. .long fpr_disp16, fpr_extmode0
  120. .long fp_ill, fp_ill
  121. .long fp_ill, fp_ill
  123. fpr_absolute_short:
  124. fp_mode_abs_short
  125. jra fpr_do_movem
  127. fpr_absolute_long:
  128. fp_mode_abs_long
  129. | jra fpr_do_movem
  131. fpr_do_movem:
  132. swap %d1 | get fpu register list
  133. lea (FPD_FPREG,FPDATA),%a1
  134. moveq #12,%d0
  135. btst #12,%d2
  136. jne 1f
  137. lea (-12,%a1,%d0*8),%a1
  138. neg.l %d0
  139. 1: btst #13,%d2
  140. jne 4f
  141. | move register from memory into fpu
  142. jra 3f
  143. 1: printf PMOVEM,"(%p>%p)",2,%a0,%a1
  144. getuser.l (%a0)+,%d2,fp_err_ua1,%a0
  145. lsr.l #8,%d2
  146. lsr.l #7,%d2
  147. lsr.w #1,%d2
  148. move.l %d2,(%a1)+
  149. getuser.l (%a0)+,%d2,fp_err_ua1,%a0
  150. move.l %d2,(%a1)+
  151. getuser.l (%a0),%d2,fp_err_ua1,%a0
  152. move.l %d2,(%a1)
  153. subq.l #8,%a0
  154. subq.l #8,%a1
  155. add.l %d0,%a0
  156. 2: add.l %d0,%a1
  157. 3: lsl.b #1,%d1
  158. jcs 1b
  159. jne 2b
  160. jra 5f
  161. | move register from fpu into memory
  162. 1: printf PMOVEM,"(%p>%p)",2,%a1,%a0
  163. move.l (%a1)+,%d2
  164. lsl.w #1,%d2
  165. lsl.l #7,%d2
  166. lsl.l #8,%d2
  167. putuser.l %d2,(%a0)+,fp_err_ua1,%a0
  168. move.l (%a1)+,%d2
  169. putuser.l %d2,(%a0)+,fp_err_ua1,%a0
  170. move.l (%a1),%d2
  171. putuser.l %d2,(%a0),fp_err_ua1,%a0
  172. subq.l #8,%a1
  173. subq.l #8,%a0
  174. add.l %d0,%a0
  175. 2: add.l %d0,%a1
  176. 4: lsl.b #1,%d1
  177. jcs 1b
  178. jne 2b
  179. 5:
  180. printf PDECODE,"n"
  181. #if 0
  182. lea (FPD_FPREG,FPDATA),%a0
  183. printf PMOVEM,"fp:"
  184. printx PMOVEM,%a0@(0)
  185. printx PMOVEM,%a0@(12)
  186. printf PMOVEM,"n   "
  187. printx PMOVEM,%a0@(24)
  188. printx PMOVEM,%a0@(36)
  189. printf PMOVEM,"n   "
  190. printx PMOVEM,%a0@(48)
  191. printx PMOVEM,%a0@(60)
  192. printf PMOVEM,"n   "
  193. printx PMOVEM,%a0@(72)
  194. printx PMOVEM,%a0@(84)
  195. printf PMOVEM,"n"
  196. #endif
  197. jra fp_end
  199. | set flags for decode macros for fmovem control register
  200. do_fmovem=1
  201. do_fmovem_cr=1
  203. fp_fmovem_cr:
  204. printf PDECODE,"fmovem.cr "
  205. | get register list and count them
  206. bfextu %d2{#19,#3},%d0
  207. move.l %d0,%d1
  208. swap %d1
  209. jra 2f
  210. 1: addq.w #1,%d1
  211. 2: lsr.l #1,%d0
  212. jcs 1b
  213. jne 2b
  214. printf PDECODE,"#%08x",1,%d1
  215. #ifdef FPU_EMU_DEBUG
  216. btst #13,%d2
  217. jeq 1f
  218. printf PDECODE,"->" | fpu -> cpu
  219. jra 2f
  220. 1: printf PDECODE,"<-" | fpu <- cpu
  221. 2:
  222. #endif
  224. | decode address mode
  225. fp_decode_addr_mode
  227. .long fpc_data, fpc_addr
  228. .long fpc_indirect, fpc_postinc
  229. .long fpc_predecr, fpc_disp16
  230. .long fpc_extmode0, fpc_extmode1
  232. fpc_data:
  233. fp_mode_data_direct
  234. move.w %d0,%d1
  235. bfffo %d2{#19,#3},%d0
  236. sub.w #19,%d0
  237. lea (FPD_FPCR,FPDATA,%d0.w*4),%a1
  238. btst #13,%d2
  239. jne 1f
  240. move.w %d1,%d0
  241. jsr fp_get_data_reg
  242. move.l %d0,(%a1)
  243. jra fpc_movem_fin
  244. 1: move.l (%a1),%d0
  245. jsr fp_put_data_reg
  246. jra fpc_movem_fin
  248. fpc_addr:
  249. fp_decode_addr_reg
  250. printf PDECODE,"a%d",1,%d0
  251. btst #13,%d2
  252. jne 1f
  253. jsr fp_get_addr_reg
  254. move.l %a0,(FPD_FPIAR,FPDATA)
  255. jra fpc_movem_fin
  256. 1: move.l (FPD_FPIAR,FPDATA),%a0
  257. jsr fp_put_addr_reg
  258. jra fpc_movem_fin
  260. fpc_indirect:
  261. fp_mode_addr_indirect
  262. jra fpc_do_movem
  264. fpc_postinc:
  265. fp_mode_addr_indirect_postinc
  266. jra fpc_do_movem
  268. fpc_predecr:
  269. fp_mode_addr_indirect_predec
  270. jra fpc_do_movem
  272. fpc_disp16:
  273. fp_mode_addr_indirect_disp16
  274. jra fpc_do_movem
  276. fpc_extmode0:
  277. fp_mode_addr_indirect_extmode0
  278. jra fpc_do_movem
  280. fpc_extmode1:
  281. fp_decode_addr_reg
  282. jmp ([0f:w,%pc,%d0*4])
  284. .align 4
  285. 0:
  286. .long fpc_absolute_short, fpc_absolute_long
  287. .long fpc_disp16, fpc_extmode0
  288. .long fpc_immediate, fp_ill
  289. .long fp_ill, fp_ill
  291. fpc_absolute_short:
  292. fp_mode_abs_short
  293. jra fpc_do_movem
  295. fpc_absolute_long:
  296. fp_mode_abs_long
  297. jra fpc_do_movem
  299. fpc_immediate:
  300. fp_get_pc %a0
  301. lea (%a0,%d1.w*4),%a1
  302. fp_put_pc %a1
  303. printf PDECODE,"#imm"
  304. | jra fpc_do_movem
  305. #if 0
  306. swap %d1
  307. lsl.l #5,%d1
  308. lea (FPD_FPCR,FPDATA),%a0
  309. jra 3f
  310. 1: move.l %d0,(%a0)
  311. 2: addq.l #4,%a0
  312. 3: lsl.b #1,%d1
  313. jcs 1b
  314. jne 2b
  315. jra fpc_movem_fin
  316. #endif
  318. fpc_do_movem:
  319. swap %d1 | get fpu register list
  320. lsl.l #5,%d1
  321. lea (FPD_FPCR,FPDATA),%a1
  322. 1: btst #13,%d2
  323. jne 4f
  325. | move register from memory into fpu
  326. jra 3f
  327. 1: printf PMOVEM,"(%p>%p)",2,%a0,%a1
  328. getuser.l (%a0)+,%d0,fp_err_ua1,%a0
  329. move.l %d0,(%a1)
  330. 2: addq.l #4,%a1
  331. 3: lsl.b #1,%d1
  332. jcs 1b
  333. jne 2b
  334. jra fpc_movem_fin
  336. | move register from fpu into memory
  337. 1: printf PMOVEM,"(%p>%p)",2,%a1,%a0
  338. move.l (%a1),%d0
  339. putuser.l %d0,(%a0)+,fp_err_ua1,%a0
  340. 2: addq.l #4,%a1
  341. 4: lsl.b #1,%d1
  342. jcs 1b
  343. jne 2b
  345. fpc_movem_fin:
  346. and.l #0x0000fff0,(FPD_FPCR,FPDATA)
  347. and.l #0x0ffffff8,(FPD_FPSR,FPDATA)
  348. move.l (FPD_FPCR,FPDATA),%d0
  349. lsr.l #4,%d0
  350. moveq #3,%d1
  351. and.l %d0,%d1
  352. move.w %d1,(FPD_RND,FPDATA)
  353. lsr.l #2,%d0
  354. moveq #3,%d1
  355. and.l %d0,%d1
  356. move.w %d1,(FPD_PREC,FPDATA)
  357. printf PDECODE,"n"
  358. #if 0
  359. printf PMOVEM,"fpcr : %08xn",1,FPDATA@(FPD_FPCR)
  360. printf PMOVEM,"fpsr : %08xn",1,FPDATA@(FPD_FPSR)
  361. printf PMOVEM,"fpiar: %08xn",1,FPDATA@(FPD_FPIAR)
  362. clr.l %d0
  363. move.w (FPD_PREC,FPDATA),%d0
  364. printf PMOVEM,"prec : %04xn",1,%d0
  365. move.w (FPD_RND,FPDATA),%d0
  366. printf PMOVEM,"rnd  : %04xn",1,%d0
  367. #endif
  368. jra fp_end