00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070
00071
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081
00082
00083
00084
00085
00086
00087
00088
00089
00090
00091
00092
00093
00094
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104
00105
00106
00107
00108
00109
00110
00111
00112
00113 #include "board.h"
00114
00115 #include <HIDAUDDDriver.h>
00116 #include <HIDDKeyboard.h>
00117 #include <AUDDFunction.h>
00118
00119 #include <USBD_Config.h>
00120 #include <USBD_LEDs.h>
00121
00122 #include <string.h>
00123
00124
00125
00126
00127
00128 #define NO_PUSHBUTTON
00129
00130
00131
00132 #define NUM_KEYS 2
00133
00134
00135 #define NUM_NORMAL_KEYS 1
00136
00137
00138 #define NUM_MODIFIER_KEYS (NUM_KEYS - NUM_NORMAL_KEYS)
00139
00140
00141 #define LED_NUMLOCK USBD_LEDOTHER
00142
00143
00144
00145 #define BUFFER_NUMBER 500
00146
00147 #define BUFFER_SIZE (AUDDevice_BYTESPERFRAME)
00148
00149
00150
00151 #define DAC_DELAY 2
00152
00153
00154 #define SLOT_BY_FRAME (2)
00155
00156 #define BITS_BY_SLOT (16)
00157 #define I2S_SLAVE_TX_SETTING ((SSC_TCMR_CKS_TK) | \
00158 (SSC_TCMR_CKO_NONE) | \
00159 (SSC_TCMR_START_TF_EDGE) | \
00160 (SSC_TCMR_STTDLY(1)) | \
00161 (SSC_TCMR_PERIOD(0)))
00162
00163 #define I2S_SLAVE_TX_FRM_SETTING ((SSC_TFMR_DATLEN(BITS_BY_SLOT - 1)) |\
00164 (SSC_TFMR_MSBF) | \
00165 (SSC_TFMR_DATNB(SLOT_BY_FRAME - 1)) |\
00166 (SSC_TFMR_FSOS_NONE))
00167
00168
00169 #define I2S_SLAVE_RX_SETTING ((SSC_RCMR_CKS_TK) | \
00170 (SSC_RCMR_CKO_NONE) | \
00171 (SSC_RCMR_CKI) | \
00172 (SSC_RCMR_START_RF_EDGE) |\
00173 (SSC_RCMR_STTDLY(1)) | \
00174 (SSC_RCMR_PERIOD(0)))
00175
00176 #define I2S_SLAVE_RX_FRM_SETTING ((SSC_RFMR_DATLEN(BITS_BY_SLOT - 1)) |\
00177 (SSC_RFMR_MSBF) | \
00178 (SSC_RFMR_DATNB(SLOT_BY_FRAME - 1)) |\
00179 (SSC_RFMR_FSOS_NONE))
00180
00181
00182 #define TWI_CLOCK 400000
00183
00184 #define SAMPLE_RATE (48000)
00185
00186
00187
00188
00189
00190
00191
00192 extern const USBDDriverDescriptors hidauddDriverDescriptors;
00193
00194
00195
00196
00197
00198
00199
00200 #ifdef NO_PUSHBUTTON
00201 #else
00202
00203 static Pin pinsPushButtons[] = {PINS_PUSHBUTTONS};
00204 #endif
00205
00206
00207 static uint8_t keyCodes[NUM_KEYS] = {
00208 HIDKeypad_A,
00209 HIDKeypad_NUMLOCK,
00210 };
00211
00212
00213 static uint8_t keyStatus[NUM_KEYS];
00214
00215
00216
00217
00218 COMPILER_ALIGNED(32) static uint8_t buffers[BUFFER_NUMBER][BUFFER_SIZE];
00219
00220
00221 static uint32_t bufferSizes[BUFFER_NUMBER];
00222
00223 static uint32_t inBufferIndex = 0;
00224
00225 static uint32_t outBufferIndex = 0;
00226
00227 static volatile uint32_t numBuffersToSend = 0;
00228
00229
00230 static volatile uint32_t isDacActive = 0;
00231 static volatile uint32_t isFirstFrame = 1;
00232
00233 static volatile uint32_t dacDelay;
00234
00235
00236 static Twid twid;
00237
00238 COMPILER_ALIGNED(32) static sXdmad dmad;
00239
00240 static uint32_t sscDmaTxChannel;
00241
00242
00243 static const Pin pinsAudio[] = { PIN_TWI_TWD0,
00244 PIN_TWI_TWCK0,
00245 PIN_SSC_TD,
00246 PIN_SSC_TK,
00247 PIN_SSC_TF,
00248 PIN_SSC_RD,
00249 PIN_SSC_RK,
00250 PIN_SSC_RF,
00251 PIN_PCK2
00252 };
00253
00254
00255
00256
00257
00258
00259
00260 void XDMAC_Handler(void)
00261 {
00262 XDMAD_Handler(&dmad);
00263 }
00264
00265
00266
00267
00268 static void _SscDma(volatile uint32_t *pReg, uint32_t dmaChannel,
00269 void *pBuffer, uint16_t wSize)
00270 {
00271 sXdmad *pDmad = &dmad;
00272 sXdmadCfg xdmadCfg;
00273
00274
00275 xdmadCfg.mbr_ubc = wSize;
00276 xdmadCfg.mbr_sa = (uint32_t) pBuffer;
00277 xdmadCfg.mbr_da = (uint32_t) pReg;
00278 xdmadCfg.mbr_cfg = XDMAC_CC_TYPE_PER_TRAN
00279 | XDMAC_CC_MBSIZE_SINGLE
00280 | XDMAC_CC_DSYNC_MEM2PER
00281 | XDMAC_CC_CSIZE_CHK_1
00282 | XDMAC_CC_DWIDTH_HALFWORD
00283 | XDMAC_CC_SIF_AHB_IF1
00284 | XDMAC_CC_DIF_AHB_IF1
00285 | XDMAC_CC_SAM_INCREMENTED_AM
00286 | XDMAC_CC_DAM_FIXED_AM
00287 | XDMAC_CC_PERID(XDMAIF_Get_ChannelNumber(
00288 ID_SSC, XDMAD_TRANSFER_TX));
00289 xdmadCfg.mbr_bc = 0;
00290 xdmadCfg.mbr_ds = 0;
00291 xdmadCfg.mbr_sus = 0;
00292 xdmadCfg.mbr_dus = 0;
00293
00294 memory_sync();
00295 XDMAD_ConfigureTransfer(pDmad, dmaChannel, &xdmadCfg, 0, 0, (
00296 XDMAC_CIE_BIE |
00297 XDMAC_CIE_DIE |
00298 XDMAC_CIE_FIE |
00299 XDMAC_CIE_RBIE |
00300 XDMAC_CIE_WBIE |
00301 XDMAC_CIE_ROIE));
00302 SCB_CleanDCache_by_Addr((uint32_t *)pBuffer, wSize);
00303 XDMAD_StartTransfer(pDmad, dmaChannel);
00304 SSC_EnableTransmitter(SSC);
00305 }
00306
00307
00308
00309
00310 static void _SscTxCallback(uint8_t status, void *pArg)
00311 {
00312 sXdmad *pDmad = &dmad;
00313 Xdmac *pXdmac = pDmad->pXdmacs;
00314
00315 status = status;
00316 pArg = pArg;
00317
00318 if (numBuffersToSend == 0) {
00319
00320 isDacActive = 0;
00321 return;
00322 }
00323
00324
00325 memory_sync();
00326 XDMAC_SetSourceAddr(pXdmac, sscDmaTxChannel,
00327 (uint32_t) buffers[outBufferIndex]);
00328 XDMAC_SetMicroblockControl(pXdmac, sscDmaTxChannel,
00329 bufferSizes[outBufferIndex]);
00330 SCB_CleanDCache_by_Addr((uint32_t *) buffers[outBufferIndex],
00331 bufferSizes[outBufferIndex]);
00332 outBufferIndex = (outBufferIndex + 1) % BUFFER_NUMBER;
00333 numBuffersToSend --;
00334 XDMAD_StartTransfer(pDmad, sscDmaTxChannel);
00335 }
00336
00337
00338
00339
00340 static void _ConfigureDma(void)
00341 {
00342 sXdmad *pDmad = &dmad;
00343
00344 XDMAD_Initialize(pDmad, 0);
00345
00346 NVIC_EnableIRQ(XDMAC_IRQn);
00347
00348
00349 sscDmaTxChannel = XDMAD_AllocateChannel(pDmad, XDMAD_TRANSFER_MEMORY, ID_SSC);
00350
00351 if ( sscDmaTxChannel == XDMAD_ALLOC_FAILED) {
00352 printf("xDMA channel allocation error\n\r");
00353
00354 while (1);
00355 }
00356
00357
00358 XDMAD_SetCallback(pDmad, sscDmaTxChannel, (XdmadTransferCallback)_SscTxCallback,
00359 0);
00360 XDMAD_PrepareChannel(pDmad, sscDmaTxChannel);
00361 }
00362
00363
00364
00365
00366 static void AudioPlayEnable(uint8_t enable)
00367 {
00368 if (enable == 1)
00369 SSC_EnableTransmitter(SSC);
00370 else if (enable == 0)
00371 SSC_DisableTransmitter(SSC);
00372 }
00373
00374
00375
00376
00377
00378 static void _SyncAdjust(int32_t adjust)
00379 {
00380 if (adjust > 0) {
00381
00382 WM8904_Write(&twid, WM8904_SLAVE_ADDRESS, WM8904_REG_FLL_CRTL3, 0xFF00);
00383
00384 return;
00385 }
00386
00387 if (adjust < 0) {
00388
00389 WM8904_Write(&twid, WM8904_SLAVE_ADDRESS, WM8904_REG_FLL_CRTL3, 0x5000);
00390
00391 return;
00392 }
00393
00394
00395
00396
00397
00398 WM8904_Write(&twid, WM8904_SLAVE_ADDRESS, WM8904_REG_FLL_CRTL3,
00399 0x8000 + 0x3000);
00400
00401 return;
00402 }
00403
00404
00405
00406
00407
00408
00409 static void _ConfigureAudioPlay(uint32_t sampleRate, uint32_t mck)
00410 {
00411
00412 PIO_Configure(pinsAudio, PIO_LISTSIZE(pinsAudio));
00413
00414
00415 sampleRate = sampleRate;
00416 SSC_Configure(SSC, 0, mck);
00417 SSC_DisableTransmitter(SSC);
00418 SSC_DisableReceiver(SSC);
00419 SSC_ConfigureTransmitter(SSC, I2S_SLAVE_TX_SETTING, I2S_SLAVE_TX_FRM_SETTING);
00420 SSC_DisableTransmitter(SSC);
00421
00422
00423 PMC_EnablePeripheral(ID_TWIHS0);
00424
00425 TWI_ConfigureMaster(TWIHS0, TWI_CLOCK, mck);
00426 TWID_Initialize(&twid, TWIHS0);
00427
00428
00429
00430 WM8904_Write(&twid, WM8904_SLAVE_ADDRESS, WM8904_REG_RESET, 0);
00431 Wait(100);
00432
00433
00434 if (WM8904_Read(&twid, WM8904_SLAVE_ADDRESS, 0) != 0x8904) {
00435 printf("WM8904 not found!\n\r");
00436
00437 while (1);
00438 }
00439
00440 WM8904_Init(&twid, WM8904_SLAVE_ADDRESS, PMC_MCKR_CSS_SLOW_CLK);
00441 _SyncAdjust(0);
00442 PMC_ConfigurePCK2(PMC_MCKR_CSS_SLOW_CLK, PMC_MCKR_PRES_CLK_1);
00443
00444 AudioPlayEnable(0);
00445 }
00446
00447
00448
00449
00450 static void HIDDKeyboardProcessKeys(void)
00451 {
00452 uint32_t i;
00453 uint8_t pressedKeys[NUM_KEYS];
00454 uint8_t pressedKeysSize = 0;
00455 uint8_t releasedKeys[NUM_KEYS];
00456 uint8_t releasedKeysSize = 0;
00457
00458
00459 #ifdef NO_PUSHBUTTON
00460
00461 if (DBG_IsRxReady()) {
00462 uint8_t key = DBG_GetChar();
00463
00464 switch (key) {
00465 case '1': case '2':
00466 i = key - '1';
00467
00468 if (keyStatus[i]) {
00469
00470 TRACE_INFO("Key %u pressed\n\r", (unsigned int)i);
00471 keyStatus[i] = 0;
00472 pressedKeys[pressedKeysSize] = keyCodes[i];
00473 pressedKeysSize ++;
00474 HIDDKeyboard_RemoteWakeUp();
00475 } else {
00476
00477 TRACE_INFO("Key %u released\n\r", (unsigned int)i);
00478 keyStatus[i] = 1;
00479 releasedKeys[releasedKeysSize] = keyCodes[i];
00480 releasedKeysSize++;
00481 }
00482
00483 break;
00484
00485 default: DBG_PutChar(key);
00486 }
00487 }
00488
00489 #else
00490
00491 for (i = 0; i < PIO_LISTSIZE(pinsPushButtons); i++) {
00492
00493 uint8_t isButtonPressed = PIO_Get(&(pinsPushButtons[i]));
00494
00495 if (isButtonPressed != keyStatus[i]) {
00496
00497 if (!isButtonPressed) {
00498
00499 TRACE_INFO("Key %u has been pressed\n\r", i);
00500 keyStatus[i] = 0;
00501 pressedKeys[pressedKeysSize] = keyCodes[i];
00502 pressedKeysSize++;
00503 HIDDKeyboard_RemoteWakeUp();
00504 } else {
00505
00506 TRACE_INFO("Key %u has been released\n\r", i);
00507 keyStatus[i] = 1;
00508 releasedKeys[releasedKeysSize] = keyCodes[i];
00509 releasedKeysSize++;
00510 }
00511 }
00512 }
00513
00514 #endif
00515
00516
00517 if ((pressedKeysSize != 0) || (releasedKeysSize != 0)) {
00518 uint8_t status;
00519
00520 do {
00521 status = HIDDKeyboard_ChangeKeys(pressedKeys,
00522 pressedKeysSize,
00523 releasedKeys,
00524 releasedKeysSize);
00525 } while (status != USBD_STATUS_SUCCESS);
00526 }
00527 }
00528
00529
00530
00531
00532 static void FrameReceived(uint32_t unused,
00533 uint8_t status,
00534 uint32_t transferred,
00535 uint32_t remaining)
00536 {
00537 unused = unused;
00538 remaining = remaining;
00539
00540 if (status == USBD_STATUS_SUCCESS) {
00541 bufferSizes[inBufferIndex] = transferred / AUDDevice_BYTESPERSAMPLE;
00542 inBufferIndex = (inBufferIndex + 1) % BUFFER_NUMBER;
00543 numBuffersToSend++;
00544
00545
00546 if (!isDacActive) {
00547 dacDelay = DAC_DELAY;
00548 isDacActive = 1;
00549 }
00550
00551 else if (dacDelay > 0)
00552 dacDelay--;
00553
00554 else if (isFirstFrame) {
00555 isFirstFrame = 0;
00556
00557 _SscDma(&(SSC->SSC_THR), sscDmaTxChannel, buffers[outBufferIndex],
00558 bufferSizes[outBufferIndex]);
00559 outBufferIndex = (outBufferIndex + 1) % BUFFER_NUMBER;
00560 numBuffersToSend --;
00561 }
00562 } else if (status == USBD_STATUS_ABORTED) {
00563
00564 bufferSizes[inBufferIndex] = 0;
00565 } else {
00566
00567 }
00568
00569
00570 AUDDFunction_Read(buffers[inBufferIndex],
00571 AUDDevice_BYTESPERFRAME,
00572 (TransferCallback) FrameReceived,
00573 0);
00574 }
00575
00576
00577
00578
00579
00580
00581
00582
00583 void USBDDriverCallbacks_ConfigurationChanged(unsigned char cfgnum)
00584 {
00585 HIDAUDDDriver_ConfigurationChangedHandler(cfgnum);
00586 }
00587
00588
00589
00590
00591
00592
00593
00594 void USBDDriverCallbacks_InterfaceSettingChanged(unsigned char interface,
00595 unsigned char setting)
00596 {
00597 HIDAUDDDriver_InterfaceSettingChangedHandler(interface, setting);
00598 }
00599
00600
00601
00602
00603
00604 void USBDCallbacks_RequestReceived(const USBGenericRequest *request)
00605 {
00606 HIDAUDDDriver_RequestHandler(request);
00607 }
00608
00609
00610
00611
00612
00613
00614
00615
00616
00617
00618
00619
00620 void AUDDFunction_MuteChanged(uint8_t mic, uint8_t channel, uint8_t muted)
00621 {
00622 if (mic) return;
00623
00624
00625 if (channel == AUDD_CH_Master) {
00626 if (muted) {
00627 AudioPlayEnable(0);
00628 TRACE_WARNING("MuteMaster ");
00629 } else {
00630 TRACE_INFO("UnmuteMaster ");
00631 AudioPlayEnable(1);
00632 }
00633 }
00634 }
00635
00636
00637
00638
00639
00640
00641
00642 void AUDDFunction_StreamSettingChanged(uint8_t mic, uint8_t newSetting)
00643 {
00644 mic = mic;
00645
00646 if (newSetting) {
00647 LED_Set(USBD_LEDOTHER);
00648
00649 numBuffersToSend = 0;
00650 } else LED_Clear(USBD_LEDOTHER);
00651 }
00652
00653
00654
00655
00656
00657
00658
00659
00660 void HIDDKeyboardCallbacks_LedsChanged(
00661 uint8_t numLockStatus,
00662 uint8_t capsLockStatus,
00663 uint8_t scrollLockStatus)
00664 {
00665 capsLockStatus = capsLockStatus;
00666 scrollLockStatus = scrollLockStatus;
00667
00668
00669 if (numLockStatus)
00670 LED_Set(LED_NUMLOCK);
00671 else
00672 LED_Clear(LED_NUMLOCK);
00673 }
00674
00675
00676
00677
00678 static void _ConfigureUsbhs(void)
00679 {
00680
00681
00682 PMC->PMC_SCDR = PMC_SCDR_USBCLK;
00683
00684 PMC->PMC_USB = PMC_USB_USBS;
00685
00686 PMC_EnablePeripheral(ID_USBHS);
00687 USBHS->USBHS_CTRL = USBHS_CTRL_UIMOD_DEVICE;
00688
00689 PMC->CKGR_UCKR = CKGR_UCKR_UPLLEN | CKGR_UCKR_UPLLCOUNT(0xF);
00690
00691
00692 while (!(PMC->PMC_SR & PMC_SR_LOCKU));
00693
00694
00695 NVIC_EnableIRQ(USBHS_IRQn);
00696 }
00697
00698
00699
00700
00701
00702
00703
00704
00705
00706 int main(void)
00707 {
00708 volatile uint8_t usbConn = 0;
00709 volatile uint8_t audioOn = 0;
00710 int32_t numDiff = 0, prevDiff = 0;
00711 int8_t clockAdjust = 0;
00712
00713
00714 WDT_Disable(WDT);
00715
00716 SCB_EnableICache();
00717 SCB_EnableDCache();
00718
00719
00720 printf("-- USB HID + Audio Device Example %s --\n\r", SOFTPACK_VERSION);
00721 printf("-- %s\n\r", BOARD_NAME);
00722 printf("-- Compiled: %s %s With %s--\n\r", __DATE__, __TIME__ ,
00723 COMPILER_NAME);
00724
00725 TimeTick_Configure();
00726
00727 NVIC_SetPriority(USBHS_IRQn, 2);
00728
00729
00730 PIO_InitializeInterrupts(0);
00731
00732
00733 _ConfigureUsbhs();
00734
00735
00736 #ifdef NO_PUSHBUTTON
00737 printf("-- : DBG key 1 2 used as buttons\n\r");
00738 printf("-- : 1st press to push, 2nd press to release\n\r");
00739 #else
00740
00741 PIO_Configure(pinsPushButtons, PIO_LISTSIZE(pinsPushButtons));
00742 #endif
00743 memset(keyStatus, 1, NUM_KEYS);
00744
00745
00746
00747 LED_Configure(USBD_LEDOTHER);
00748
00749
00750 _ConfigureAudioPlay(AUDDevice_SAMPLERATE, BOARD_MCK);
00751
00752
00753 _ConfigureDma();
00754
00755
00756 HIDAUDDDriver_Initialize(&hidauddDriverDescriptors);
00757
00758
00759 USBD_Connect();
00760
00761
00762 while (1) {
00763 if (USBD_GetState() < USBD_STATE_CONFIGURED) {
00764 usbConn = 0;
00765 continue;
00766 }
00767
00768 if (audioOn) {
00769 if (isDacActive == 0) {
00770 AudioPlayEnable(0);
00771 printf("audE ");
00772 isFirstFrame = 1;
00773 audioOn = 0;
00774 } else {
00775 numDiff = numBuffersToSend - DAC_DELAY;
00776
00777 if (prevDiff != numDiff) {
00778 prevDiff = numDiff;
00779
00780 if (numDiff > 1 && clockAdjust != 1) {
00781 printf("+");
00782
00783 clockAdjust = 1;
00784 _SyncAdjust(1);
00785 }
00786
00787 if (numDiff < -1 && clockAdjust != -1) {
00788 printf("-");
00789
00790 clockAdjust = -1;
00791 _SyncAdjust(-1);
00792 }
00793
00794 if (numDiff == 0 && clockAdjust != 0) {
00795 clockAdjust = 0;
00796 _SyncAdjust(0);
00797 }
00798 }
00799 }
00800 } else if (isDacActive) {
00801 printf("audS ");
00802 audioOn = 1;
00803 }
00804
00805 if (usbConn == 0) {
00806 usbConn = 1;
00807
00808 AUDDFunction_Read(buffers[inBufferIndex],
00809 AUDDevice_BYTESPERFRAME,
00810 (TransferCallback) FrameReceived,
00811 0);
00812 }
00813
00814 HIDDKeyboardProcessKeys();
00815 }
00816 }
00817