arch/mips/include/asm/dsp.h

   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 */