]>
Commit | Line | Data |
---|---|---|
e50c0a8f RB |
1 | /* |
2 | * Copyright (C) 2005 Mips Technologies | |
3 | * Author: Chris Dearman, [email protected] derived from fpu.h | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify it | |
6 | * under the terms of the GNU General Public License as published by the | |
7 | * Free Software Foundation; either version 2 of the License, or (at your | |
8 | * option) any later version. | |
9 | */ | |
10 | #ifndef _ASM_DSP_H | |
11 | #define _ASM_DSP_H | |
12 | ||
13 | #include <asm/cpu.h> | |
14 | #include <asm/cpu-features.h> | |
15 | #include <asm/hazards.h> | |
16 | #include <asm/mipsregs.h> | |
17 | ||
18 | #define DSP_DEFAULT 0x00000000 | |
07a801de | 19 | #define DSP_MASK 0x3ff |
e50c0a8f RB |
20 | |
21 | #define __enable_dsp_hazard() \ | |
22 | do { \ | |
23 | asm("_ehb"); \ | |
24 | } while (0) | |
25 | ||
26 | static inline void __init_dsp(void) | |
27 | { | |
28 | mthi1(0); | |
29 | mtlo1(0); | |
30 | mthi2(0); | |
31 | mtlo2(0); | |
32 | mthi3(0); | |
33 | mtlo3(0); | |
34 | wrdsp(DSP_DEFAULT, DSP_MASK); | |
35 | } | |
36 | ||
37 | static inline void init_dsp(void) | |
38 | { | |
39 | if (cpu_has_dsp) | |
40 | __init_dsp(); | |
41 | } | |
42 | ||
43 | #define __save_dsp(tsk) \ | |
44 | do { \ | |
45 | tsk->thread.dsp.dspr[0] = mfhi1(); \ | |
46 | tsk->thread.dsp.dspr[1] = mflo1(); \ | |
47 | tsk->thread.dsp.dspr[2] = mfhi2(); \ | |
48 | tsk->thread.dsp.dspr[3] = mflo2(); \ | |
49 | tsk->thread.dsp.dspr[4] = mfhi3(); \ | |
50 | tsk->thread.dsp.dspr[5] = mflo3(); \ | |
07a801de | 51 | tsk->thread.dsp.dspcontrol = rddsp(DSP_MASK); \ |
e50c0a8f RB |
52 | } while (0) |
53 | ||
54 | #define save_dsp(tsk) \ | |
55 | do { \ | |
56 | if (cpu_has_dsp) \ | |
57 | __save_dsp(tsk); \ | |
58 | } while (0) | |
59 | ||
60 | #define __restore_dsp(tsk) \ | |
61 | do { \ | |
62 | mthi1(tsk->thread.dsp.dspr[0]); \ | |
63 | mtlo1(tsk->thread.dsp.dspr[1]); \ | |
64 | mthi2(tsk->thread.dsp.dspr[2]); \ | |
65 | mtlo2(tsk->thread.dsp.dspr[3]); \ | |
66 | mthi3(tsk->thread.dsp.dspr[4]); \ | |
67 | mtlo3(tsk->thread.dsp.dspr[5]); \ | |
07a801de | 68 | wrdsp(tsk->thread.dsp.dspcontrol, DSP_MASK); \ |
e50c0a8f RB |
69 | } while (0) |
70 | ||
71 | #define restore_dsp(tsk) \ | |
72 | do { \ | |
73 | if (cpu_has_dsp) \ | |
74 | __restore_dsp(tsk); \ | |
75 | } while (0) | |
76 | ||
77 | #define __get_dsp_regs(tsk) \ | |
78 | ({ \ | |
79 | if (tsk == current) \ | |
80 | __save_dsp(current); \ | |
81 | \ | |
82 | tsk->thread.dsp.dspr; \ | |
83 | }) | |
84 | ||
85 | #endif /* _ASM_DSP_H */ |