Make PCB args are now SKY9X and GRUVIN9X instead of ARM and V4

[sky9x] Temperature calibration [sky9x] RTC modifications
2012-10-02 10:07:19 +00:00
parent 194c9b7978
commit 81c6bb1ba7
119 changed files with 474 additions and 744 deletions
@@ -0,0 +1,154 @@
+/*
+ * 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 "../open9x.h"
+
+#ifndef SIMU
+
+extern "C" {
+#include "usb/device/massstorage/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_Msk;
+    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            1
+
+/** Media index for different disks */
+#define DRV_SDMMC           0    /** SD card */
+
+Media medias[MAX_LUNS];
+
+/*----------------------------------------------------------------------------
+ *        Local variables
+ *----------------------------------------------------------------------------*/
+
+/** Device LUNs. */
+MSDLun luns[MAX_LUNS];
+
+char *bytes2Str(char *str, uint32_t bytes)
+{
+  if (bytes < 1024*100)
+    sprintf(str, "%lu.%luK", bytes / 1024, (bytes % 1024) / 103);
+  else if (bytes < 1024*1024)
+    sprintf(str, "%luK", bytes / 1024);
+  else if (bytes < 1024*1024*100)
+    sprintf(str, "%lu.%luM", bytes / (1024*1024), (bytes % (1024*1024)) / 104858);
+  else
+    sprintf(str, "%luM", bytes / (1024*1024));
+  return str;
+}
+
+static void MSDCallbacks_Data( unsigned char flowDirection, unsigned int dataLength,
+                               unsigned int fifoNullCount, unsigned int fifoFullCount )
+{
+  if (flowDirection)
+    msdReadTotal += dataLength;
+  else
+    msdWriteTotal += dataLength;
+
+  char rdStr[10];
+  char wrStr[10];
+
+  sprintf(statusLineMsg, "USB Rd:%s Wr:%s", bytes2Str(rdStr, msdReadTotal), bytes2Str(wrStr, msdWriteTotal));
+  showStatusLine();
+}
+
+void usbMassStorage()
+{
+  static bool initialized = false;
+
+  if (usbPlugged() && sd_card_ready()) {
+    TRACE_DEBUG("usbMassStorage\n\r");
+
+    if (sd_card_mounted()) {
+      Card_state = SD_ST_DATA;
+      audioQueue.stopSD();
+      closeLogs();
+      f_mount(0, 0); // unmount SD
+    }
+
+    if (!initialized) {
+
+      ConfigureUsbClock();
+
+      /* Initialize LUN */
+      MEDSdcard_Initialize(&(medias[DRV_SDMMC]), 0);
+
+      LUN_Init(&(luns[DRV_SDMMC]), &(medias[DRV_SDMMC]),
+          msdBuffer, MSD_BUFFER_SIZE,
+          0, 0, 0, 0,
+          MSDCallbacks_Data);
+
+      /* BOT driver initialization */
+      MSDDriver_Initialize(luns, 1);
+
+      // VBus_Configure();
+      USBD_Connect();
+
+      initialized = true;
+    }
+
+    /* Mass storage state machine */
+    for (uint8_t i=0; i<50; i++)
+      MSDDriver_StateMachine();
+  }
+  else {
+    msdReadTotal = 0;
+    msdWriteTotal = 0;
+  }
+}
+
+#endif