git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_M7_SAMV71_Xplained_IAR_Keil/libboard_samv7-ek/source/wm8904.c

   1 /* ----------------------------------------------------------------------------\r
   2  *         SAM Software Package License \r
   3  * ----------------------------------------------------------------------------\r
   4  * Copyright (c) 2014, Atmel Corporation\r
   5  *\r
   6  * All rights reserved.\r
   7  *\r
   8  * Redistribution and use in source and binary forms, with or without\r
   9  * modification, are permitted provided that the following conditions are met:\r
  10  *\r
  11  * - Redistributions of source code must retain the above copyright notice,\r
  12  * this list of conditions and the disclaimer below.\r
  13  *\r
  14  * Atmel's name may not be used to endorse or promote products derived from\r
  15  * this software without specific prior written permission.\r
  16  *\r
  17  * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR\r
  18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF\r
  19  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE\r
  20  * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,\r
  21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT\r
  22  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,\r
  23  * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF\r
  24  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING\r
  25  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,\r
  26  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.\r
  27  * ----------------------------------------------------------------------------\r
  28  */\r
  29 \r
  30 /**\r
  31  * \file\r
  32  *\r
  33  * Implementation WM8904 driver.\r
  34  *\r
  35  */\r
  36 \r
  37 /*----------------------------------------------------------------------------\r
  38  *        Headers\r
  39  *----------------------------------------------------------------------------*/\r
  40 \r
  41 #include "board.h"\r
  42 \r
  43 /*----------------------------------------------------------------------------\r
  44  *        Type\r
  45  *----------------------------------------------------------------------------*/\r
  46 typedef struct {\r
  47     uint16_t value;\r
  48     uint8_t address;\r
  49 }WM8904_PARA;\r
  50 \r
  51 /*----------------------------------------------------------------------------\r
  52  *        Exported functions\r
  53  *----------------------------------------------------------------------------*/\r
  54 /**\r
  55  * \brief Read data from WM8904 Register.\r
  56  *\r
  57  * \param pTwid   Pointer to twi driver structure\r
  58  * \param device  Twi slave address.\r
  59  * \param regAddr Register address to read.\r
  60  * \return value in the given register.\r
  61  */\r
  62 uint16_t WM8904_Read(Twid *pTwid,\r
  63         uint32_t device,\r
  64         uint32_t regAddr)\r
  65 {\r
  66     uint16_t bitsDataRegister;\r
  67     uint8_t Tdata[2]={0,0};\r
  68 \r
  69     TWID_Read(pTwid, device, regAddr, 1, Tdata, 2, 0);\r
  70     bitsDataRegister = (Tdata[0] << 8) | Tdata[1];\r
  71     return bitsDataRegister;\r
  72 }\r
  73 \r
  74 /**\r
  75  * \brief  Write data to WM8904 Register.\r
  76  *\r
  77  * \param pTwid   Pointer to twi driver structure\r
  78  * \param device  Twi slave address.\r
  79  * \param regAddr Register address to read.\r
  80  * \param data    Data to write\r
  81  */\r
  82 void WM8904_Write(Twid *pTwid,\r
  83         uint32_t device,\r
  84         uint32_t regAddr,\r
  85         uint16_t data)\r
  86 {\r
  87     uint8_t tmpData[2];\r
  88 \r
  89     tmpData[0] = (data & 0xff00) >> 8;\r
  90     tmpData[1] = data & 0xff;\r
  91     TWID_Write(pTwid, device, regAddr, 1, tmpData, 2, 0);\r
  92 }\r
  93 \r
  94 static WM8904_PARA wm8904_access_slow[]=\r
  95 { \r
  96     { 0x0000, 0},         /** R0   - SW Reset and ID */ \r
  97     { 0x001A, 4},       /** R4   - Bias Control 0 */ \r
  98     { 0x0047, 5},       /** R5   - VMID Control 0 */     /*insert_delay_ms 5*/\r
  99 \r
 100     { 0x0043, 5},       /** R5   - VMID Control 0 */ \r
 101     { 0x000B, 4},       /** R4   - Bias Control 0 */ \r
 102 \r
 103     { 0x0003, 0x0C},      /** R12  - Power Management 0 CC */ \r
 104 \r
 105     { 0x0003, 0x0E},      /** R14  - Power Management 2 */ \r
 106     { 0x000C, 0x12},      /** R18  - Power Management 6 */\r
 107     { 0x0000, 0x21},      /** R33  - DAC Digital 1 */ \r
 108     { 0x0000, 0x3D},      /** R61  - Analogue OUT12 ZC */ \r
 109     { 0x0001, 0x62},      /** R98  - Charge Pump 0 */ \r
 110     { 0x0005, 0x68},     /** R104 - Class W 0 */ \r
 111 \r
 112     //FLL setting,32.768KHZ MCLK input,12.288M output.\r
 113     { 0x0000, 0x74},     /** R116 - FLL Control 1 */ \r
 114     { 0x0704, 0x75},     /** R117 - FLL Control 2 */ \r
 115     { 0x8000, 0x76},     /** R118 - FLL Control 3 */ \r
 116     { 0x1760, 0x77},     /** R119 - FLL Control 4 */ \r
 117     { 0x0005, 0x74},     /** R116 - FLL Control 1 */     /*insert_delay_ms 5*/\r
 118 \r
 119     { 0x0C05, 0x15},      /** R21  - Clock Rates 1 */ \r
 120     { 0x845E, 0x14},      /** R20  - Clock Rates 0 */     \r
 121     { 0x4006, 0x16},      /** R22  - Clock Rates 2 */\r
 122 \r
 123     ////////////////WM8904 IIS master\r
 124     //BCLK=12.288MHz/8=1.536MHz\r
 125     //LRCK=1.536MHz/32=48KHz\r
 126     //{ 0x0042, 0x18},      /** R24  - Audio Interface 0 */ \r
 127     { 0x0042, 0x19},      /** R25  - Audio Interface 1 */ \r
 128     { 0x00E8, 0x1A},      /** R26  - Audio Interface 2 */ \r
 129     { 0x0820, 0x1B},      /** R27  - Audio Interface 3 */ \r
 130     ////////////////ADC\r
 131 \r
 132     { 0x0003, 0x0C},      /** R12  - Power Management 0 */ \r
 133     { 0x000F, 0x12},      /** R18  - Power Management 6 */     /*insert_delay_ms 5*/\r
 134 \r
 135     { 0x0010, 0x2C},      /** R44  - Analogue Left Input 0 */ \r
 136     { 0x0010, 0x2D},      /** R45  - Analogue Right Input 0 */ \r
 137     { 0x0044, 0x2E},      /** R46  - Analogue Left Input 1 */ \r
 138     { 0x0044, 0x2F},      /** R47  - Analogue Right Input 1 */\r
 139 \r
 140     { 0x0011, 0x5A},      /** R90  - Analogue HP 0 */ \r
 141     { 0x0033, 0x5A},      /** R90  - Analogue HP 0 */ \r
 142 \r
 143     { 0x000F, 0x43},      /** R67  - DC Servo 0 */ \r
 144     { 0x00F0, 0x44},      /** R68  - DC Servo 1 */     /*insert_delay_ms 100*/\r
 145 \r
 146     //{ 0x0000, 0xFF},      /** end */ \r
 147     { 0x0077, 0x5A},      /** R90  - Analogue HP 0 */ \r
 148     { 0x00FF, 0x5A},      /** R90  - Analogue HP 0 */ \r
 149     { 0x00B9, 0x39},      /** R57  - Analogue OUT1 Left */ \r
 150     { 0x00B9, 0x3A},      /** R58  - Analogue OUT1 Right */  \r
 151 \r
 152     //{ 0x0150, 0x18}  ;Loopback\r
 153 };\r
 154 \r
 155 static WM8904_PARA wm8904_access_main[] = \r
 156 { \r
 157     //{ 0x8904, 0}, /** R0   - SW Reset and ID */ \r
 158     //{ 0x0000, 1}, /** R1   - Revision */ \r
 159     //{ 0x0000, 2}, /** R2 */ \r
 160     //{ 0x0000, 3}, /** R3 */ \r
 161     { 0x0019, 4},   /** R4   - Bias Control 0 */ \r
 162     { 0x0043, 5},   /** R5   - VMID Control 0 */ \r
 163     //{ 0x0003, 6},   /** R6   - Mic Bias Control 0 */ \r
 164     //{ 0xC000, 7},   /** R7   - Mic Bias Control 1 */ \r
 165     //{ 0x001E, 8},   /** R8   - Analogue DAC 0 */ \r
 166     //{ 0xFFFF, 9},   /** R9   - mic Filter Control */ \r
 167     //{ 0x0001, 10},  /** R10  - Analogue ADC 0 */ \r
 168     //{ 0x0000, 11},  /** R11 */ \r
 169     { 0x0003, 12},  /** R12  - Power Management 0 */ \r
 170     //{ 0x0000, 13},  /** R13 */ \r
 171     { 0x0003, 14},  /** R14  - Power Management 2 */ \r
 172     //{ 0x0003, 15},  /** R15  - Power Management 3 */ \r
 173     //{ 0x0000, 16},  /** R16 */ \r
 174     //{ 0x0000, 17},  /** R17 */ \r
 175     { 0x000F, 18},  /** R18  - Power Management 6 */ \r
 176     //{ 0x0000, 19},  /** R19 */ \r
 177     { 0x845E, 20},  /** R20  - Clock Rates 0 */ \r
 178     //{ 0x3C07, 21},  /** R21  - Clock Rates 1 */ \r
 179     { 0x0006, 22},  /** R22  - Clock Rates 2 */ \r
 180     //{ 0x0000, 23},  /** R23 */ \r
 181     //{ 0x1FFF, 24},  /** R24  - Audio Interface 0 */ \r
 182     { 0x404A, 25},  /** R25  - Audio Interface 1 */ \r
 183     //{ 0x0004, 26},  /** R26  - Audio Interface 2 */ \r
 184     { 0x0840, 27},  /** R27  - Audio Interface 3 */ \r
 185     //{ 0x0000, 28},  /** R28 */ \r
 186     //{ 0x0000, 29},  /** R29 */ \r
 187     //{ 0x00FF, 30},  /** R30  - DAC Digital Volume Left */ \r
 188     //{ 0x00FF, 31},  /** R31  - DAC Digital Volume Right */ \r
 189     //{ 0x0FFF, 32},  /** R32  - DAC Digital 0 */ \r
 190     { 0x0000, 33},  /** R33  - DAC Digital 1 */ \r
 191     //{ 0x0000, 34},  /** R34 */ \r
 192     //{ 0x0000, 35},  /** R35 */ \r
 193     //{ 0x00FF, 36},  /** R36  - ADC Digital Volume Left */ \r
 194     //{ 0x00FF, 37},  /** R37  - ADC Digital Volume Right */ \r
 195     //{ 0x0073, 38},  /** R38  - ADC Digital 0 */ \r
 196     //{ 0x1800, 39},  /** R39  - Digital Microphone 0 */ \r
 197     //{ 0xDFEF, 40},  /** R40  - DRC 0 */ \r
 198     //{ 0xFFFF, 41},  /** R41  - DRC 1 */ \r
 199     //{ 0x003F, 42},  /** R42  - DRC 2 */ \r
 200     //{ 0x07FF, 43},  /** R43  - DRC 3 */ \r
 201     { 0x0005, 44},  /** R44  - Analogue Left Input 0 */ \r
 202     { 0x0005, 45},  /** R45  - Analogue Right Input 0 */ \r
 203     { 0x0000, 46},  /** R46  - Analogue Left Input 1 */ \r
 204     { 0x0000, 47},  /** R47  - Analogue Right Input 1 */ \r
 205     //{ 0x0000, 48},  /** R48 */ \r
 206     //{ 0x0000, 49},  /** R49 */ \r
 207     //{ 0x0000, 50},  /** R50 */ \r
 208     //{ 0x0000, 51},  /** R51 */ \r
 209     //{ 0x0000, 52},  /** R52 */ \r
 210     //{ 0x0000, 53},  /** R53 */ \r
 211     //{ 0x0000, 54},  /** R54 */ \r
 212     //{ 0x0000, 55},  /** R55 */ \r
 213     //{ 0x0000, 56},  /** R56 */ \r
 214     //{ 0x017F, 57},  /** R57  - Analogue OUT1 Left */ \r
 215     { 0x00AD, 58},  /** R58  - Analogue OUT1 Right */ \r
 216     //{ 0x017F, 59},  /** R59  - Analogue OUT2 Left */ \r
 217     //{ 0x017F, 60},  /** R60  - Analogue OUT2 Right */ \r
 218     //{ 0x000F, 61},  /** R61  - Analogue OUT12 ZC */ \r
 219     //{ 0x0000, 62},  /** R62 */ \r
 220     //{ 0x0000, 63},  /** R63 */ \r
 221     //{ 0x0000, 64},  /** R64 */ \r
 222     //{ 0x0000, 65},  /** R65 */ \r
 223     //{ 0x0000, 66},  /** R66 */ \r
 224     { 0x0003, 67},  /** R67  - DC Servo 0 */ \r
 225     //{ 0xFFFF, 68},  /** R68  - DC Servo 1 */ \r
 226     //{ 0x0F0F, 69},  /** R69  - DC Servo 2 */ \r
 227     //{ 0x0000, 70},  /** R70 */ \r
 228     //{ 0x007F, 71},  /** R71  - DC Servo 4 */ \r
 229     //{ 0x007F, 72},  /** R72  - DC Servo 5 */ \r
 230     //{ 0x00FF, 73},  /** R73  - DC Servo 6 */ \r
 231     //{ 0x00FF, 74},  /** R74  - DC Servo 7 */ \r
 232     //{ 0x00FF, 75},  /** R75  - DC Servo 8 */ \r
 233     //{ 0x00FF, 76},  /** R76  - DC Servo 9 */ \r
 234     //{ 0x0FFF, 77},  /** R77  - DC Servo Readback 0 */ \r
 235     //{ 0x0000, 78},  /** R78 */ \r
 236     //{ 0x0000, 79},  /** R79 */ \r
 237     //{ 0x0000, 80},  /** R80 */ \r
 238     //{ 0x0000, 81},  /** R81 */ \r
 239     //{ 0x0000, 82},  /** R82 */ \r
 240     //{ 0x0000, 83},  /** R83 */ \r
 241     //{ 0x0000, 84},  /** R84 */ \r
 242     //{ 0x0000, 85},  /** R85 */ \r
 243     //{ 0x0000, 86},  /** R86 */ \r
 244     //{ 0x0000, 87},  /** R87 */ \r
 245     //{ 0x0000, 88},  /** R88 */ \r
 246     //{ 0x0000, 89},  /** R89 */ \r
 247     { 0x00FF, 90},  /** R90  - Analogue HP 0 */ \r
 248     //{ 0x0000, 91},  /** R91 */ \r
 249     //{ 0x0000, 92},  /** R92 */ \r
 250     //{ 0x0000, 93},  /** R93 */ \r
 251     //{ 0x00FF, 94},  /** R94  - Analogue Lineout 0 */ \r
 252     //{ 0x0000, 95},  /** R95 */ \r
 253     //{ 0x0000, 96},  /** R96 */ \r
 254     //{ 0x0000, 97},  /** R97 */ \r
 255     { 0x0001, 98},  /** R98  - Charge Pump 0 */ \r
 256     //{ 0x0000, 99},  /** R99 */ \r
 257     //{ 0x0000, 100}, /** R100 */\r
 258     //{ 0x0000, 101}, /** R101 */ \r
 259     //{ 0x0000, 102}, /** R102 */ \r
 260     //{ 0x0000, 103}, /** R103 */ \r
 261     { 0x0005, 104}, /** R104 - Class W 0 */ \r
 262     //{ 0x0000, 105}, /** R105 */ \r
 263     //{ 0x0000, 106}, /** R106 */ \r
 264     //{ 0x0000, 107}, /** R107 */ \r
 265     //{ 0x011F, 108}, /** R108 - Write Sequencer 0 */ \r
 266     //{ 0x7FFF, 109}, /** R109 - Write Sequencer 1 */ \r
 267     //{ 0x4FFF, 110}, /** R110 - Write Sequencer 2 */ \r
 268     //{ 0x003F, 111}, /** R111 - Write Sequencer 3 */ \r
 269     //{ 0x03F1, 112}, /** R112 - Write Sequencer 4 */ \r
 270     //{ 0x0000, 113}, /** R113 */ \r
 271     //{ 0x0000, 114}, /** R114 */ \r
 272     //{ 0x0000, 115}, /** R115 */ \r
 273     { 0x0004, 116}, /** R116 - FLL Control 1 */ \r
 274     { 0x0704, 117}, /** R117 - FLL Control 2 */ \r
 275     { 0x8000, 118}, /** R118 - FLL Control 3 */ \r
 276     { 0x1760, 119}, /** R119 - FLL Control 4 */ \r
 277     //{ 0x001B, 120}, /** R120 - FLL Control 5 */ \r
 278     //{ 0x0014, 121}, /** R121 - GPIO Control 1 */ \r
 279     //{ 0x0010, 122}, /** R122 - GPIO Control 2 */ \r
 280     //{ 0x0010, 123}, /** R123 - GPIO Control 3 */ \r
 281     //{ 0x0000, 124}, /** R124 - GPIO Control 4 */ \r
 282     //{ 0x0000, 125}, /** R125 */ \r
 283     //{ 0x000A, 126}, /** R126 - Digital Pulls */ \r
 284     //{ 0x07FF, 127}, /** R127 - Interrupt Status */ \r
 285     //{ 0x03FF, 128}, /** R128 - Interrupt Status Mask */ \r
 286     //{ 0x03FF, 129}, /** R129 - Interrupt Polarity */ \r
 287     //{ 0x03FF, 130}, /** R130 - Interrupt Debounce */\r
 288     //{ 0x0000, 131}, /** R131 */ \r
 289     //{ 0x0000, 132}, /** R132 */ \r
 290     //{ 0x0000, 133}, /** R133 */ \r
 291     //{ 0x0001, 134}, /** R134 - EQ1 */ \r
 292     //{ 0x001F, 135}, /** R135 - EQ2 */ \r
 293     //{ 0x001F, 136}, /** R136 - EQ3 */ \r
 294     //{ 0x001F, 137}, /** R137 - EQ4 */ \r
 295     //{ 0x001F, 138}, /** R138 - EQ5 */ \r
 296     //{ 0x001F, 139}, /** R139 - EQ6 */ \r
 297     //{ 0xFFFF, 140}, /** R140 - EQ7 */ \r
 298     //{ 0xFFFF, 141}, /** R141 - EQ8 */ \r
 299     //{ 0xFFFF, 142}, /** R142 - EQ9 */ \r
 300     //{ 0xFFFF, 143}, /** R143 - EQ10 */ \r
 301     //{ 0xFFFF, 144}, /** R144 - EQ11 */ \r
 302     //{ 0xFFFF, 145}, /** R145 - EQ12 */ \r
 303     //{ 0xFFFF, 146}, /** R146 - EQ13 */ \r
 304     //{ 0xFFFF, 147}, /** R147 - EQ14 */ \r
 305     //{ 0xFFFF, 148}, /** R148 - EQ15 */ \r
 306     //{ 0xFFFF, 149}, /** R149 - EQ16 */ \r
 307     //{ 0xFFFF, 150}, /** R150 - EQ17 */ \r
 308     //{ 0xFFFF, 151}, /** R151wm8523_dai - EQ18 */ \r
 309     //{ 0xFFFF, 152}, /** R152 - EQ19 */ \r
 310     //{ 0xFFFF, 153}, /** R153 - EQ20 */ \r
 311     //{ 0xFFFF, 154}, /** R154 - EQ21 */ \r
 312     //{ 0xFFFF, 155}, /** R155 - EQ22 */ \r
 313     //{ 0xFFFF, 156}, /** R156 - EQ23 */ \r
 314     //{ 0xFFFF, 157}, /** R157 - EQ24 */ \r
 315     //{ 0x0000, 158}, /** R158 */ \r
 316     //{ 0x0000, 159}, /** R159 */ \r
 317     //{ 0x0000, 160}, /** R160 */ \r
 318     //{ 0x0002, 161}, /** R161 - Control Interface Test 1 */ \r
 319     //{ 0x0000, 162}, /** R162 */ \r
 320     //{ 0x0000, 163}, /** R163 */ \r
 321     //{ 0x0000, 164}, /** R164 */ \r
 322     //{ 0x0000, 165}, /** R165 */ \r
 323     //{ 0x0000, 166}, /** R166 */ \r
 324     //{ 0x0000, 167}, /** R167 */ \r
 325     //{ 0x0000, 168}, /** R168 */ \r
 326     //{ 0x0000, 169}, /** R169 */ \r
 327     //{ 0x0000, 170}, /** R170 */ \r
 328     //{ 0x0000, 171}, /** R171 */ \r
 329     //{ 0x0000, 172}, /** R172 */ \r
 330     //{ 0x0000, 173}, /** R173 */ \r
 331     //{ 0x0000, 174}, /** R174 */ \r
 332     //{ 0x0000, 175}, /** R175 */ \r
 333     //{ 0x0000, 176}, /** R176 */ \r
 334     //{ 0x0000, 177}, /** R177 */ \r
 335     //{ 0x0000, 178}, /** R178 */ \r
 336     //{ 0x0000, 179}, /** R179 */ \r
 337     //{ 0x0000, 180}, /** R180 */ \r
 338     //{ 0x0000, 181}, /** R181 */ \r
 339     //{ 0x0000, 182}, /** R182 */ \r
 340     //{ 0x0000, 183}, /** R183 */ \r
 341     //{ 0x0000, 184}, /** R184 */ \r
 342     //{ 0x0000, 185}, /** R185 */ \r
 343     //{ 0x0000, 186}, /** R186 */ \r
 344     //{ 0x0000, 187}, /** R187 */ \r
 345     //{ 0x0000, 188}, /** R188 */ \r
 346     //{ 0x0000, 189}, /** R189 */ \r
 347     //{ 0x0000, 190}, /** R190 */ \r
 348     //{ 0x0000, 191}, /** R191 */ \r
 349     //{ 0x0000, 192}, /** R192 */ \r
 350     //{ 0x0000, 193}, /** R193 */ \r
 351     //{ 0x0000, 194}, /** R194 */ \r
 352     //{ 0x0000, 195}, /** R195 */ \r
 353     //{ 0x0000, 196}, /** R196 */ \r
 354     //{ 0x0000, 197}, /** R197 */ \r
 355     //{ 0x0000, 198}, /** R198 */ \r
 356     //{ 0x0000, 199}, /** R199 */ \r
 357     //{ 0x0000, 200}, /** R200 */ \r
 358     //{ 0x0000, 201}, /** R201 */ \r
 359     //{ 0x0000, 202}, /** R202 */ \r
 360     //{ 0x0000, 203}, /** R203 */ \r
 361     //{ 0x0070, 204}, /** R204 - Analogue Output Bias 0 */ \r
 362     //{ 0x0000, 205}, /** R205 */ \r
 363     //{ 0x0000, 206}, /** R206 */ \r
 364     //{ 0x0000, 207}, /** R207 */ \r
 365     //{ 0x0000, 208}, /** R208 */ \r
 366     //{ 0x0000, 209}, /** R209 */ \r
 367     //{ 0x0000, 210}, /** R210 */ \r
 368     //{ 0x0000, 211}, /** R211 */ \r
 369     //{ 0x0000, 212}, /** R212 */ \r
 370     //{ 0x0000, 213}, /** R213 */ \r
 371     //{ 0x0000, 214}, /** R214 */ \r
 372     //{ 0x0000, 215}, /** R215 */ \r
 373     //{ 0x0000, 216}, /** R216 */ \r
 374     //{ 0x0000, 217}, /** R217 */ \r
 375     //{ 0x0000, 218}, /** R218 */ \r
 376     //{ 0x0000, 219}, /** R219 */ \r
 377     //{ 0x0000, 220}, /** R220 */ \r
 378     //{ 0x0000, 221}, /** R221 */ \r
 379     //{ 0x0000, 222}, /** R222 */ \r
 380     //{ 0x0000, 223}, /** R223 */ \r
 381     //{ 0x0000, 224}, /** R224 */ \r
 382     //{ 0x0000, 225}, /** R225 */ \r
 383     //{ 0x0000, 226}, /** R226 */ \r
 384     //{ 0x0000, 227}, /** R227 */ \r
 385     //{ 0x0000, 228}, /** R228 */ \r
 386     //{ 0x0000, 229}, /** R229 */ \r
 387     //{ 0x0000, 230}, /** R230 */ \r
 388     //{ 0x0000, 231}, /** R231 */ \r
 389     //{ 0x0000, 232}, /** R232 */ \r
 390     //{ 0x0000, 233}, /** R233 */ \r
 391     //{ 0x0000, 234}, /** R234 */ \r
 392     //{ 0x0000, 235}, /** R235 */ \r
 393     //{ 0x0000, 236}, /** R236 */ \r
 394     //{ 0x0000, 237}, /** R237 */ \r
 395     //{ 0x0000, 238}, /** R238 */ \r
 396     //{ 0x0000, 239}, /** R239 */ \r
 397     //{ 0x0000, 240}, /** R240 */ \r
 398     //{ 0x0000, 241}, /** R241 */ \r
 399     //{ 0x0000, 242}, /** R242 */ \r
 400     //{ 0x0000, 243}, /** R243 */ \r
 401     //{ 0x0000, 244}, /** R244 */ \r
 402     //{ 0x0000, 245}, /** R245 */ \r
 403     //{ 0x0000, 246}, /** R246 */ \r
 404     //{ 0x0000, 247}, /** R247 - FLL NCO Test 0 */ \r
 405     //{ 0x0019, 248}, /** R248 - FLL NCO Test 1 */ \r
 406     { 0x55AA, 255}  /** end */ \r
 407 };\r
 408 \r
 409 uint8_t WM8904_Init(Twid *pTwid, uint32_t device,  uint32_t PCK)\r
 410 {\r
 411     uint8_t count, size;\r
 412     uint16_t data = 0;\r
 413 \r
 414     // Reset (write Reg@0x0 to reset)\r
 415     WM8904_Write(pTwid, device, 0, 0xFFFF);\r
 416 \r
 417     for(data=0;data<1000;data++);\r
 418     //wait ready    \r
 419     while(data!=0x8904)\r
 420         data=WM8904_Read(pTwid, device, 0);\r
 421 \r
 422     if (PMC_MCKR_CSS_SLOW_CLK == PCK)\r
 423     {\r
 424         {\r
 425             size = sizeof(wm8904_access_slow)/4+1;\r
 426             for(count=0; count<size; count++)\r
 427             {\r
 428                 WM8904_Write(pTwid, device, wm8904_access_slow[count].address, wm8904_access_slow[count].value);\r
 429                 if(((wm8904_access_slow[count].address==0x05)&&(wm8904_access_slow[count].value==0x0047))\r
 430                         ||((wm8904_access_slow[count].address==0x74)&&(wm8904_access_slow[count].value==0x0005))\r
 431                         ||((wm8904_access_slow[count].address==0x12)&&(wm8904_access_slow[count].value==0x000F)))\r
 432                 {\r
 433                     Wait(5);\r
 434                 }\r
 435                 if (((wm8904_access_slow[count].address==0x44)&&(wm8904_access_slow[count].value==0x00F0))\r
 436                         ||((wm8904_access_slow[count].address==0x3A)&&(wm8904_access_slow[count].value==0x00B9)))\r
 437                 {          \r
 438                     Wait(100);\r
 439                 }\r
 440             }    \r
 441         }            \r
 442     }\r
 443     else if (PMC_MCKR_CSS_MAIN_CLK == PCK)\r
 444     {\r
 445         for(count=0;count<255;count++)\r
 446         {\r
 447             if(wm8904_access_main[count].address<255)\r
 448             {\r
 449                 WM8904_Write(pTwid, device, wm8904_access_main[count].address, wm8904_access_main[count].value);\r
 450             }\r
 451             else\r
 452             {\r
 453                 break;\r
 454             }\r
 455         }            \r
 456     }\r
 457     else\r
 458     {\r
 459         printf("W: PCK not supported! \n\r");\r
 460         while(1);\r
 461     }\r
 462 \r
 463 \r
 464     return 0;\r
 465 }\r
 466 \r
 467 void WM8904_IN2R_IN1L(Twid *pTwid, uint32_t device)\r
 468 {\r
 469     //{ 0x0005, 44},  /** R44  - Analogue Left Input 0 */ \r
 470     //{ 0x0005, 45},  /** R45  - Analogue Right Input 0 */ \r
 471     //{ 0x0000, 46},  /** R46  - Analogue Left Input 1 */ \r
 472     //{ 0x0010, 47},  /** R47  - Analogue Right Input 1 */\r
 473     WM8904_Write(pTwid, device, 0x2C, 0x0008);\r
 474     WM8904_Write(pTwid, device, 0x2D, 0x0005);\r
 475     WM8904_Write(pTwid, device, 0x2E, 0x0000);\r
 476     WM8904_Write(pTwid, device, 0x2F, 0x0010);\r
 477 }\r