Mike's bootloader sources + added as option, for Taranis only for now (not as clean as it could be, bootloader is always built even if not selected - didn't find how to nest ifs in makefile :\ ) (Issue #546)
This commit is contained in:
Andre Bernet
@@ -0,0 +1,233 @@
|
||||
/*
|
||||
* Authors (alphabetical order)
|
||||
* - Bertrand Songis <bsongis@gmail.com>
|
||||
* - Bryan J. Rentoul (Gruvin) <gruvin@gmail.com>
|
||||
* - Cameron Weeks <th9xer@gmail.com>
|
||||
* - Erez Raviv
|
||||
* - Jean-Pierre Parisy
|
||||
* - Karl Szmutny <shadow@privy.de>
|
||||
* - Michael Blandford
|
||||
* - Michal Hlavinka
|
||||
* - Pat Mackenzie
|
||||
* - Philip Moss
|
||||
* - Rob Thomson
|
||||
* - Romolo Manfredini <romolo.manfredini@gmail.com>
|
||||
* - Thomas Husterer
|
||||
*
|
||||
* open9x is based on code named
|
||||
* gruvin9x by Bryan J. Rentoul: http://code.google.com/p/gruvin9x/,
|
||||
* er9x by Erez Raviv: http://code.google.com/p/er9x/,
|
||||
* and the original (and ongoing) project by
|
||||
* Thomas Husterer, th9x: http://code.google.com/p/th9x/
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
*/
|
||||
|
||||
#include "radio.h"
|
||||
#include "board.h"
|
||||
//#include "debug.h"
|
||||
//#include "Audio.h"
|
||||
|
||||
//#ifndef SIMU
|
||||
//#include "CoOS.h"
|
||||
//#endif
|
||||
|
||||
#ifndef SIMU
|
||||
|
||||
extern "C" {
|
||||
#include "MSDDriver.h"
|
||||
extern unsigned char MEDSdcard_Initialize(Media *media, unsigned char mciID);
|
||||
}
|
||||
|
||||
/** Size of one block in bytes. */
|
||||
#define BLOCK_SIZE 512
|
||||
|
||||
/** Size of the MSD IO buffer in bytes (6K, more the better). */
|
||||
#define MSD_BUFFER_SIZE (12*BLOCK_SIZE)
|
||||
|
||||
/** LUN read/write buffer. */
|
||||
unsigned char msdBuffer[MSD_BUFFER_SIZE];
|
||||
|
||||
unsigned int msdReadTotal=0, msdWriteTotal=0;
|
||||
|
||||
static void ConfigureUsbClock(void)
|
||||
{
|
||||
/* Enable PLLB for USB */
|
||||
PMC->CKGR_PLLBR = CKGR_PLLBR_DIVB(1)
|
||||
| CKGR_PLLBR_MULB(7)
|
||||
| CKGR_PLLBR_PLLBCOUNT;
|
||||
while((PMC->PMC_SR & PMC_SR_LOCKB) == 0); // TODO && (timeout++ < CLOCK_TIMEOUT));
|
||||
/* USB Clock uses PLLB */
|
||||
PMC->PMC_USB = PMC_USB_USBDIV(1) /* /2 */
|
||||
| PMC_USB_USBS; /* PLLB */
|
||||
}
|
||||
|
||||
/** Maximum number of LUNs which can be defined. */
|
||||
#define MAX_LUNS 2
|
||||
|
||||
/** Media index for different disks */
|
||||
#define DRV_SDMMC 0 /** SD card */
|
||||
#define DRV_EEPROM 1 /** EEPROM */
|
||||
|
||||
Media medias[MAX_LUNS];
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
* Local variables
|
||||
*----------------------------------------------------------------------------*/
|
||||
|
||||
#ifdef HID
|
||||
|
||||
uint8_t hid_iBuffer[64] ;
|
||||
uint8_t hid_oBuffer[64] ;
|
||||
|
||||
static void hid_transfer()
|
||||
{
|
||||
uint32_t dwCnt=0 ;
|
||||
uint32_t dwLen ;
|
||||
|
||||
dwLen = HIDDTransferDriver_Read( hid_iBuffer, 64 ) ;
|
||||
if ( dwLen )
|
||||
{
|
||||
// printf( "Data In(%u):", (unsigned int)dwLen ) ;
|
||||
// _ShowBuffer( iBuffer, dwLen ) ;
|
||||
|
||||
// bmLEDs = iBuffer[0] ;
|
||||
// update = 1 ;
|
||||
}
|
||||
|
||||
dwLen = HIDDTransferDriver_ReadReport( iBuffer, 64 ) ;
|
||||
if ( dwLen )
|
||||
{
|
||||
// printf( "Report In(%u):", (unsigned int)dwLen ) ;
|
||||
// _ShowBuffer( iBuffer, dwLen ) ;
|
||||
|
||||
// bmLEDs = iBuffer[0] ;
|
||||
// update = 1 ;
|
||||
}
|
||||
|
||||
oBuffer[0] = 0x80 ;
|
||||
if ( PIO_Get( &pinsButtons[PUSHBUTTON_BP1]) == 0 )
|
||||
{
|
||||
oBuffer[0] |= 0x01 ;
|
||||
}
|
||||
if ( PIO_Get( &pinsButtons[PUSHBUTTON_BP2] ) == 0 )
|
||||
{
|
||||
oBuffer[0] |= 0x02 ;
|
||||
}
|
||||
|
||||
sprintf( (char*)&oBuffer[5], ":%04x:%05u!", (unsigned int)dwCnt, (unsigned int)dwCnt ) ;
|
||||
oBuffer[1] = (uint8_t)(dwCnt) ;
|
||||
oBuffer[2] = (uint8_t)(dwCnt >> 8) ;
|
||||
oBuffer[3] = (uint8_t)(dwCnt >> 16) ;
|
||||
oBuffer[4] = (uint8_t)(dwCnt >> 24) ;
|
||||
if ( USBD_STATUS_SUCCESS == HIDDTransferDriver_Write( oBuffer, 64, 0, 0 ) )
|
||||
{
|
||||
dwCnt ++ ;
|
||||
}
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
|
||||
/** Device LUNs. */
|
||||
MSDLun luns[MAX_LUNS];
|
||||
|
||||
static void MSDCallbacks_Data( unsigned char flowDirection, unsigned int dataLength,
|
||||
unsigned int fifoNullCount, unsigned int fifoFullCount )
|
||||
{
|
||||
#if 0
|
||||
if (flowDirection)
|
||||
msdReadTotal += dataLength;
|
||||
else
|
||||
msdWriteTotal += dataLength;
|
||||
#endif
|
||||
}
|
||||
|
||||
extern "C" unsigned char EEPROM_Initialize(Media *media, unsigned char mciID) ;
|
||||
extern uint32_t sd_card_ready( void ) ;
|
||||
|
||||
void usbMassStorage()
|
||||
{
|
||||
static bool initialized = false ;
|
||||
static bool active = false ;
|
||||
|
||||
if ( PIOC->PIO_PDSR & 0x02000000 )
|
||||
{
|
||||
// TRACE_DEBUG("usbMassStorage\n\r");
|
||||
|
||||
if (!initialized)
|
||||
{
|
||||
ConfigureUsbClock();
|
||||
/* Initialize LUN */
|
||||
MEDSdcard_Initialize(&(medias[DRV_SDMMC]), 0);
|
||||
EEPROM_Initialize(&(medias[DRV_EEPROM]), 0);
|
||||
LUN_Init(&(luns[DRV_SDMMC]), sd_card_ready() ? &(medias[DRV_SDMMC]) : 0 ,
|
||||
msdBuffer, MSD_BUFFER_SIZE,
|
||||
0, 0, 0, 0,
|
||||
MSDCallbacks_Data);
|
||||
|
||||
LUN_Init(&(luns[DRV_EEPROM]), &(medias[DRV_EEPROM]),
|
||||
msdBuffer, MSD_BUFFER_SIZE,
|
||||
0, 0, 0, 0,
|
||||
MSDCallbacks_Data);
|
||||
|
||||
/* BOT driver initialization */
|
||||
MSDDriver_Initialize( luns, 2 ) ;
|
||||
// VBus_Configure();
|
||||
USBD_Connect();
|
||||
initialized = true;
|
||||
}
|
||||
|
||||
if ( active == false )
|
||||
{
|
||||
#ifndef BOOT
|
||||
CoSchedLock() ;
|
||||
if ( Voice.VoiceLock == 0 )
|
||||
{
|
||||
Voice.VoiceLock = 1 ;
|
||||
#endif
|
||||
active = true ;
|
||||
#ifndef BOOT
|
||||
}
|
||||
CoSchedUnlock() ;
|
||||
#endif
|
||||
}
|
||||
if ( active )
|
||||
{
|
||||
/* Mass storage state machine */
|
||||
for (uint8_t i=0; i<50; i++)
|
||||
{
|
||||
#ifdef HID
|
||||
hid_transfer() ;
|
||||
#endif
|
||||
MSDDriver_StateMachine() ;
|
||||
}
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
if ( active )
|
||||
{
|
||||
active = false ;
|
||||
#ifndef BOOT
|
||||
Voice.VoiceLock = 0 ;
|
||||
#endif
|
||||
}
|
||||
|
||||
msdReadTotal = 0;
|
||||
msdWriteTotal = 0;
|
||||
}
|
||||
}
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user