Subversion Repositories HelenOS

Rev

Rev 1882 | Rev 2071 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1882 Rev 1884
Line 37... Line 37...
37 
#include <arch/register.h>
 37 
#include <arch/register.h>
38 
#include <arch/asm.h>
 38 
#include <arch/asm.h>
39 
 
 39 
 
40 
void fpu_context_save(fpu_context_t *fctx)
 40 
void fpu_context_save(fpu_context_t *fctx)
41 
{
 41 
{
42 
    fprs_reg_t fprs;
 42 
    __asm__ volatile (
- 
 
 43 
        "std %%f0, %0\n"
- 
 
 44 
        "std %%f2, %1\n"
- 
 
 45 
        "std %%f4, %2\n"
- 
 
 46 
        "std %%f6, %3\n"
- 
 
 47 
        "std %%f8, %4\n"
- 
 
 48 
        "std %%f10, %5\n"
- 
 
 49 
        "std %%f12, %6\n"
- 
 
 50 
        "std %%f14, %7\n"
- 
 
 51 
        "std %%f16, %8\n"
- 
 
 52 
        "std %%f18, %9\n"
- 
 
 53 
        "std %%f20, %10\n"
- 
 
 54 
        "std %%f22, %11\n"
- 
 
 55 
        "std %%f24, %12\n"
- 
 
 56 
        "std %%f26, %13\n"
- 
 
 57 
        "std %%f28, %14\n"
- 
 
 58 
        "std %%f30, %15\n"
- 
 
 59 
        : "=m" (fctx->d[0]), "=m" (fctx->d[1]), "=m" (fctx->d[2]), "=m" (fctx->d[3]),
- 
 
 60 
          "=m" (fctx->d[4]), "=m" (fctx->d[5]), "=m" (fctx->d[6]), "=m" (fctx->d[7]),
- 
 
 61 
          "=m" (fctx->d[8]), "=m" (fctx->d[9]), "=m" (fctx->d[10]), "=m" (fctx->d[11]),
- 
 
 62 
          "=m" (fctx->d[12]), "=m" (fctx->d[13]), "=m" (fctx->d[14]), "=m" (fctx->d[15])
43 
   
 63 
    );
44 
    fprs.value = fprs_read();
 - 
 
45 
 
 64 
 
46 
    if (fprs.dl) {
 - 
 
47 
        /*
 65 
    /*
48 
         * The lower half of floating-point registers is dirty.
 66 
     * We need to split loading of the floating-point registers because
49 
         * Spill it to memory.
 - 
 
50 
         */
 - 
 
51 
        __asm__ volatile (
 - 
 
52 
            "std %%f0, %0\n"
 - 
 
53 
            "std %%f2, %1\n"
 - 
 
54 
            "std %%f4, %2\n"
 - 
 
55 
            "std %%f6, %3\n"
 - 
 
56 
            "std %%f8, %4\n"
 - 
 
57 
            "std %%f10, %5\n"
 - 
 
58 
            "std %%f12, %6\n"
 - 
 
59 
            "std %%f14, %7\n"
 - 
 
60 
            "std %%f16, %8\n"
 - 
 
61 
            "std %%f18, %9\n"
 - 
 
62 
            "std %%f20, %10\n"
 - 
 
63 
            "std %%f22, %11\n"
 - 
 
64 
            "std %%f24, %12\n"
 - 
 
65 
            "std %%f26, %13\n"
 - 
 
66 
            "std %%f28, %14\n"
 - 
 
67 
            "std %%f30, %15\n"
 - 
 
68 
            : "=m" (fctx->d[0]), "=m" (fctx->d[1]), "=m" (fctx->d[2]), "=m" (fctx->d[3]),
 - 
 
69 
              "=m" (fctx->d[4]), "=m" (fctx->d[5]), "=m" (fctx->d[6]), "=m" (fctx->d[7]),
 - 
 
70 
              "=m" (fctx->d[8]), "=m" (fctx->d[9]), "=m" (fctx->d[10]), "=m" (fctx->d[11]),
 - 
 
71 
              "=m" (fctx->d[12]), "=m" (fctx->d[13]), "=m" (fctx->d[14]), "=m" (fctx->d[15])
 - 
 
72 
        );
 - 
 
73 
        fprs.dl = false;
 - 
 
74 
    }
 - 
 
75 
   
 - 
 
76 
    if (fprs.du) { 
 - 
 
77 
        /*
 - 
 
78 
         * The upper half of floating-point registers is dirty.
 67 
     * GCC (4.1.1) can't handle more than 30 operands in one asm statement.
79 
         * Spill it to memory.
 - 
 
80 
         */
 68 
     */
81 
        __asm__ volatile (
 - 
 
82 
            "std %%f32, %0\n"
 - 
 
83 
            "std %%f34, %1\n"
 - 
 
84 
            "std %%f36, %2\n"
 - 
 
85 
            "std %%f38, %3\n"
 - 
 
86 
            "std %%f40, %4\n"
 - 
 
87 
            "std %%f42, %5\n"
 - 
 
88 
            "std %%f44, %6\n"
 - 
 
89 
            "std %%f46, %7\n"
 - 
 
90 
            "std %%f48, %8\n"
 - 
 
91 
            "std %%f50, %9\n"
 - 
 
92 
            "std %%f52, %10\n"
 - 
 
93 
            "std %%f54, %11\n"
 - 
 
94 
            "std %%f56, %12\n"
 - 
 
95 
            "std %%f58, %13\n"
 - 
 
96 
            "std %%f60, %14\n"
 - 
 
97 
            "std %%f62, %15\n"
 - 
 
98 
            : "=m" (fctx->d[16]), "=m" (fctx->d[17]), "=m" (fctx->d[18]), "=m" (fctx->d[19]),
 - 
 
99 
              "=m" (fctx->d[20]), "=m" (fctx->d[21]), "=m" (fctx->d[22]), "=m" (fctx->d[23]),
 - 
 
100 
              "=m" (fctx->d[24]), "=m" (fctx->d[25]), "=m" (fctx->d[26]), "=m" (fctx->d[27]),
 - 
 
101 
              "=m" (fctx->d[28]), "=m" (fctx->d[29]), "=m" (fctx->d[30]), "=m" (fctx->d[31])
 - 
 
102 
        );
 - 
 
103 
        fprs.du = false;
 - 
 
104 
    }
 - 
 
105 
   
 69 
   
106 
    fprs_write(fprs.value);
 70 
    __asm__ volatile (
- 
 
 71 
        "std %%f32, %0\n"
- 
 
 72 
        "std %%f34, %1\n"
- 
 
 73 
        "std %%f36, %2\n"
- 
 
 74 
        "std %%f38, %3\n"
- 
 
 75 
        "std %%f40, %4\n"
- 
 
 76 
        "std %%f42, %5\n"
- 
 
 77 
        "std %%f44, %6\n"
- 
 
 78 
        "std %%f46, %7\n"
- 
 
 79 
        "std %%f48, %8\n"
- 
 
 80 
        "std %%f50, %9\n"
- 
 
 81 
        "std %%f52, %10\n"
- 
 
 82 
        "std %%f54, %11\n"
- 
 
 83 
        "std %%f56, %12\n"
- 
 
 84 
        "std %%f58, %13\n"
- 
 
 85 
        "std %%f60, %14\n"
- 
 
 86 
        "std %%f62, %15\n"
- 
 
 87 
        : "=m" (fctx->d[16]), "=m" (fctx->d[17]), "=m" (fctx->d[18]), "=m" (fctx->d[19]),
- 
 
 88 
          "=m" (fctx->d[20]), "=m" (fctx->d[21]), "=m" (fctx->d[22]), "=m" (fctx->d[23]),
- 
 
 89 
          "=m" (fctx->d[24]), "=m" (fctx->d[25]), "=m" (fctx->d[26]), "=m" (fctx->d[27]),
- 
 
 90 
          "=m" (fctx->d[28]), "=m" (fctx->d[29]), "=m" (fctx->d[30]), "=m" (fctx->d[31])
- 
 
 91 
    );
107 
   
 92 
   
108 
    __asm__ volatile ("stx %%fsr, %0\n" : "=m" (fctx->fsr));
 93 
    __asm__ volatile ("stx %%fsr, %0\n" : "=m" (fctx->fsr));
109 
}
 94 
}
110 
 
 95 
 
111 
void fpu_context_restore(fpu_context_t *fctx)
 96 
void fpu_context_restore(fpu_context_t *fctx)
112 
{
 97 
{
113 
    fprs_reg_t fprs;
 - 
 
114 
   
 - 
 
115 
    fprs.value = fprs_read();
 - 
 
116 
   
 - 
 
117 
    __asm__ volatile (
 98 
    __asm__ volatile (
118 
        "ldd %0, %%f0\n"
 99 
        "ldd %0, %%f0\n"
119 
        "ldd %1, %%f2\n"
 100 
        "ldd %1, %%f2\n"
120 
        "ldd %2, %%f4\n"
 101 
        "ldd %2, %%f4\n"
121 
        "ldd %3, %%f6\n"
 102 
        "ldd %3, %%f6\n"
Line 165... Line 146...
165 
          "m" (fctx->d[20]), "m" (fctx->d[21]), "m" (fctx->d[22]), "m" (fctx->d[23]),
 146 
          "m" (fctx->d[20]), "m" (fctx->d[21]), "m" (fctx->d[22]), "m" (fctx->d[23]),
166 
          "m" (fctx->d[24]), "m" (fctx->d[25]), "m" (fctx->d[26]), "m" (fctx->d[27]),
 147 
          "m" (fctx->d[24]), "m" (fctx->d[25]), "m" (fctx->d[26]), "m" (fctx->d[27]),
167 
          "m" (fctx->d[28]), "m" (fctx->d[29]), "m" (fctx->d[30]), "m" (fctx->d[31])
 148 
          "m" (fctx->d[28]), "m" (fctx->d[29]), "m" (fctx->d[30]), "m" (fctx->d[31])
168 
    );
 149 
    );
169 
   
 150 
   
170 
    fprs.dl = fprs.du = false;
 - 
 
171 
    fprs_write(fprs.value);
 - 
 
172 
   
 - 
 
173 
    __asm__ volatile ("ldx %0, %%fsr\n" : : "m" (fctx->fsr));
 151 
    __asm__ volatile ("ldx %0, %%fsr\n" : : "m" (fctx->fsr));
174 
}
 152 
}
175 
 
 153 
 
176 
void fpu_enable(void)
 154 
void fpu_enable(void)
177 
{
 155 
{