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

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

嵌入式Linux

开发平台：

Unix_Linux

fpu.c：源码内容
  1. /* $Id: fpu.c,v 1.29 2000/03/22 13:42:10 gniibe Exp $
  2.  *
  3.  * linux/arch/sh/kernel/fpu.c
  4.  *
  5.  * Save/restore floating point context for signal handlers.
  6.  *
  7.  * This file is subject to the terms and conditions of the GNU General Public
  8.  * License.  See the file "COPYING" in the main directory of this archive
  9.  * for more details.
  10.  *
  11.  * Copyright (C) 1999, 2000  Kaz Kojima & Niibe Yutaka
  12.  *
  13.  * FIXME! These routines can be optimized in big endian case.
  14.  */
  16. #include <linux/sched.h>
  17. #include <linux/signal.h>
  18. #include <asm/processor.h>
  19. #include <asm/io.h>
  21. void
  22. save_fpu(struct task_struct *tsk)
  23. {
  24. asm volatile("sts.l fpul, @-%0nt"
  25.      "sts.l fpscr, @-%0nt"
  26.      "lds %1, fpscrnt"
  27.      "frchgnt"
  28.      "fmov.s fr15, @-%0nt"
  29.      "fmov.s fr14, @-%0nt"
  30.      "fmov.s fr13, @-%0nt"
  31.      "fmov.s fr12, @-%0nt"
  32.      "fmov.s fr11, @-%0nt"
  33.      "fmov.s fr10, @-%0nt"
  34.      "fmov.s fr9, @-%0nt"
  35.      "fmov.s fr8, @-%0nt"
  36.      "fmov.s fr7, @-%0nt"
  37.      "fmov.s fr6, @-%0nt"
  38.      "fmov.s fr5, @-%0nt"
  39.      "fmov.s fr4, @-%0nt"
  40.      "fmov.s fr3, @-%0nt"
  41.      "fmov.s fr2, @-%0nt"
  42.      "fmov.s fr1, @-%0nt"
  43.      "fmov.s fr0, @-%0nt"
  44.      "frchgnt"
  45.      "fmov.s fr15, @-%0nt"
  46.      "fmov.s fr14, @-%0nt"
  47.      "fmov.s fr13, @-%0nt"
  48.      "fmov.s fr12, @-%0nt"
  49.      "fmov.s fr11, @-%0nt"
  50.      "fmov.s fr10, @-%0nt"
  51.      "fmov.s fr9, @-%0nt"
  52.      "fmov.s fr8, @-%0nt"
  53.      "fmov.s fr7, @-%0nt"
  54.      "fmov.s fr6, @-%0nt"
  55.      "fmov.s fr5, @-%0nt"
  56.      "fmov.s fr4, @-%0nt"
  57.      "fmov.s fr3, @-%0nt"
  58.      "fmov.s fr2, @-%0nt"
  59.      "fmov.s fr1, @-%0nt"
  60.      "fmov.s fr0, @-%0"
  61.      : /* no output */
  62.      : "r" ((char *)(&tsk->thread.fpu.hard.status)),
  63.        "r" (FPSCR_INIT)
  64.      : "memory");
  66. tsk->flags &= ~PF_USEDFPU;
  67. release_fpu();
  68. }
  70. static void
  71. restore_fpu(struct task_struct *tsk)
  72. {
  73. asm volatile("lds %1, fpscrnt"
  74.      "fmov.s @%0+, fr0nt"
  75.      "fmov.s @%0+, fr1nt"
  76.      "fmov.s @%0+, fr2nt"
  77.      "fmov.s @%0+, fr3nt"
  78.      "fmov.s @%0+, fr4nt"
  79.      "fmov.s @%0+, fr5nt"
  80.      "fmov.s @%0+, fr6nt"
  81.      "fmov.s @%0+, fr7nt"
  82.      "fmov.s @%0+, fr8nt"
  83.      "fmov.s @%0+, fr9nt"
  84.      "fmov.s @%0+, fr10nt"
  85.      "fmov.s @%0+, fr11nt"
  86.      "fmov.s @%0+, fr12nt"
  87.      "fmov.s @%0+, fr13nt"
  88.      "fmov.s @%0+, fr14nt"
  89.      "fmov.s @%0+, fr15nt"
  90.      "frchgnt"
  91.      "fmov.s @%0+, fr0nt"
  92.      "fmov.s @%0+, fr1nt"
  93.      "fmov.s @%0+, fr2nt"
  94.      "fmov.s @%0+, fr3nt"
  95.      "fmov.s @%0+, fr4nt"
  96.      "fmov.s @%0+, fr5nt"
  97.      "fmov.s @%0+, fr6nt"
  98.      "fmov.s @%0+, fr7nt"
  99.      "fmov.s @%0+, fr8nt"
  100.      "fmov.s @%0+, fr9nt"
  101.      "fmov.s @%0+, fr10nt"
  102.      "fmov.s @%0+, fr11nt"
  103.      "fmov.s @%0+, fr12nt"
  104.      "fmov.s @%0+, fr13nt"
  105.      "fmov.s @%0+, fr14nt"
  106.      "fmov.s @%0+, fr15nt"
  107.      "frchgnt"
  108.      "lds.l @%0+, fpscrnt"
  109.      "lds.l @%0+, fpulnt"
  110.      : /* no output */
  111.      : "r" (&tsk->thread.fpu), "r" (FPSCR_INIT)
  112.      : "memory");
  113. }
  115. /*
  116.  * Load the FPU with signalling NANS.  This bit pattern we're using
  117.  * has the property that no matter wether considered as single or as
  118.  * double precission represents signaling NANS.  
  119.  */
  121. void fpu_init(void)
  122. {
  123. asm volatile("lds %0, fpulnt"
  124.      "lds %1, fpscrnt"
  125.      "fsts fpul, fr0nt"
  126.      "fsts fpul, fr1nt"
  127.      "fsts fpul, fr2nt"
  128.      "fsts fpul, fr3nt"
  129.      "fsts fpul, fr4nt"
  130.      "fsts fpul, fr5nt"
  131.      "fsts fpul, fr6nt"
  132.      "fsts fpul, fr7nt"
  133.      "fsts fpul, fr8nt"
  134.      "fsts fpul, fr9nt"
  135.      "fsts fpul, fr10nt"
  136.      "fsts fpul, fr11nt"
  137.      "fsts fpul, fr12nt"
  138.      "fsts fpul, fr13nt"
  139.      "fsts fpul, fr14nt"
  140.      "fsts fpul, fr15nt"
  141.      "frchgnt"
  142.      "fsts fpul, fr0nt"
  143.      "fsts fpul, fr1nt"
  144.      "fsts fpul, fr2nt"
  145.      "fsts fpul, fr3nt"
  146.      "fsts fpul, fr4nt"
  147.      "fsts fpul, fr5nt"
  148.      "fsts fpul, fr6nt"
  149.      "fsts fpul, fr7nt"
  150.      "fsts fpul, fr8nt"
  151.      "fsts fpul, fr9nt"
  152.      "fsts fpul, fr10nt"
  153.      "fsts fpul, fr11nt"
  154.      "fsts fpul, fr12nt"
  155.      "fsts fpul, fr13nt"
  156.      "fsts fpul, fr14nt"
  157.      "fsts fpul, fr15nt"
  158.      "frchg"
  159.      : /* no output */
  160.      : "r" (0), "r" (FPSCR_INIT));
  161. }
  163. asmlinkage void
  164. do_fpu_error(unsigned long r4, unsigned long r5, unsigned long r6, unsigned long r7,
  165.      struct pt_regs regs)
  166. {
  167. struct task_struct *tsk = current;
  169. regs.pc += 2;
  171. grab_fpu();
  172. save_fpu(tsk);
  173. tsk->thread.trap_no = 11;
  174. tsk->thread.error_code = 0;
  175. force_sig(SIGFPE, tsk);
  176. }
  178. asmlinkage void
  179. do_fpu_state_restore(unsigned long r4, unsigned long r5, unsigned long r6,
  180.      unsigned long r7, struct pt_regs regs)
  181. {
  182. struct task_struct *tsk = current;
  184. if (!user_mode(&regs)) {
  185. if (tsk != &init_task) {
  186. unlazy_fpu(tsk);
  187. }
  188. tsk = &init_task;
  189. if (tsk->flags & PF_USEDFPU) {
  190. /*
  191.  * This weird situation can be occurred.
  192.  *
  193.  * There's race condition in __cli:
  194.  *
  195.  *   (1) SR --> register
  196.  *   (2) Set IMASK of register
  197.  *   (3) SR <-- register
  198.  *
  199.  * Between (1) and (2), or (2) and (3) getting
  200.  * interrupt, and interrupt handler (or
  201.  * softirq) may use FPU.
  202.  *
  203.  * Then, SR.FD is overwritten by (3).
  204.  *
  205.  * This results init_task.PF_USEDFPU is on,
  206.  * with SR.FD == 1.
  207.  *
  208.  */
  209. release_fpu();
  210. return;
  211. }
  212. }
  214. grab_fpu();
  215. if (tsk->used_math) {
  216. /* Using the FPU again.  */
  217. restore_fpu(tsk);
  218. } else {
  219. /* First time FPU user.  */
  220. fpu_init();
  221. tsk->used_math = 1;
  222. }
  223. tsk->flags |= PF_USEDFPU;
  224. release_fpu();
  225. }
  227. /*
  228.  * Change current FD flag to set FD flag back to exception
  229.  */
  230. asmlinkage void
  231. fpu_prepare_fd(unsigned long sr, unsigned long r5, unsigned long r6,
  232.        unsigned long r7, struct pt_regs regs)
  233. {
  234. __cli();
  235. if (!user_mode(&regs)) {
  236. if (init_task.flags & PF_USEDFPU)
  237. grab_fpu();
  238. else {
  239. if (!(sr & SR_FD)) {
  240. BUG();
  241. release_fpu();
  242. }
  243. }
  244. return;
  245. }
  247. if (sr & SR_FD) { /* Kernel doesn't grab FPU */
  248. if (current->flags & PF_USEDFPU)
  249. grab_fpu();
  250. else {
  251. if (init_task.flags & PF_USEDFPU) {
  252. /*
  253.  * This weird situation can be occurred.
  254.  * See the comment in do_fpu_state_restore.
  255.  */
  256. grab_fpu();
  257. save_fpu(&init_task);
  258. }
  259. }
  260. } else {
  261. if (init_task.flags & PF_USEDFPU)
  262. save_fpu(&init_task);
  263. else {
  264. BUG();
  265. release_fpu();
  266. }
  267. }
  268. }
  270. /* Short cut for the FPU exception */
  271. asmlinkage void
  272. enable_fpu_in_danger(void)
  273. {
  274. struct task_struct *tsk = current;
  276. if (tsk != &init_task)
  277. unlazy_fpu(tsk);
  279. tsk = &init_task;
  280. if (tsk->used_math) {
  281. /* Using the FPU again.  */
  282. restore_fpu(tsk);
  283. } else {
  284. /* First time FPU user.  */
  285. fpu_init();
  286. tsk->used_math = 1;
  287. }
  288. tsk->flags |= PF_USEDFPU;
  289. }