1 /* 2 * Copyright (C) 2005 Mips Technologies 3 * Author: Chris Dearman, chris@mips.com 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 19 #define DSP_MASK 0x3f 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(); \ 51 tsk->thread.dsp.dspcontrol = rddsp(DSP_MASK); \ 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]); \ 68 wrdsp(tsk->thread.dsp.dspcontrol, DSP_MASK); \ 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 */ 86