Merge branch 'merge-1.0.5' into ide-1.5.x-discovery

1 files changed, 182 insertions, 0 deletions

diff --git a/libraries/Robot_Control/SquawkSD.cpp b/libraries/Robot_Control/SquawkSD.cpp
new file mode 100644
index 0000000..3c97ef4
--- /dev/null
+++ b/libraries/Robot_Control/SquawkSD.cpp
@@ -0,0 +1,182 @@
+#include <SquawkSD.h>
+
+SquawkSynthSD SquawkSD;
+
+class StreamFile : public SquawkStream {
+  private:
+    Fat16 f;
+	public:
+		StreamFile(Fat16 file = Fat16()) { f = file; }
+    uint8_t read() { return f.read(); }
+    void seek(size_t offset) { f.seekSet(offset); }
+};
+
+static StreamFile file;
+
+extern uint16_t period_tbl[84] PROGMEM;
+
+void SquawkSynthSD::play(Fat16 melody) {
+	SquawkSynth::pause();
+	file = StreamFile(melody);
+	SquawkSynth::play(&file);
+}
+
+/*
+void SquawkSynthSD::convert(Fat16 in, Fat16 out) {
+  unsigned int n;
+  uint8_t patterns = 0, order_count;
+  unsigned int ptn, row, chn;
+  uint8_t temp;
+
+  uint8_t fxc[4], fxp[4], note[4], sample[4];
+  uint16_t period;
+
+  out.write('S'); // ID
+  out.write('Q');
+  out.write('M');
+  out.write('1');
+  out.write((uint8_t)0); // No meta data
+  out.write((uint8_t)0);
+  
+  // Write order list, count patterns
+  in.seek(0x3B6);
+  order_count = in.read();
+  out.write(order_count);
+  in.seek(0x3B8);
+  for(n = 0; n < order_count; n++) {
+    temp = in.read();
+    if(temp >= patterns) patterns = temp + 1;
+    out.write(temp);
+  }
+  
+  // Write patterns
+  in.seek(0x43C);
+  for(ptn = 0; ptn < patterns; ptn++) {
+    for(row = 0; row < 64; row++) {
+      for(chn = 0; chn < 4; chn++) {
+        
+        // Basic extraction
+        temp         = in.read();          // sample.msb and period.msb
+        period       = (temp & 0x0F) << 8;
+        sample[chn]  = temp & 0xF0;
+        period      |= in.read();          // period.lsb
+        temp         = in.read();          // sample.lsb and effect
+        sample[chn] |= temp >> 4;
+        fxc[chn]     = (temp & 0x0F) << 4;
+        fxp[chn]     = in.read();          // parameters
+        if(fxc[chn] == 0xE0) {
+          fxc[chn]    |= fxp[chn] >> 4;    // extended parameters
+          fxp[chn]    &= 0x0F;
+        }
+        
+        #define DIF(A, B) ((A) > (B) ? ((int32_t)(A) - (int32_t)(B)) : ((int32_t)(B) - (int32_t)(A)))
+        // Find closest matching period
+        if(period == 0) {
+          note[chn] = 0x7F;
+        } else {
+          int16_t best = DIF(period, pgm_read_word(&period_tbl[0]));
+          note[chn] = 0;
+          for(n = 0; n < sizeof(period_tbl) / sizeof(uint16_t); n++) {
+            if(DIF(period, pgm_read_word(&period_tbl[n])) < best) {
+              note[chn] = n;
+              best = DIF(period, pgm_read_word(&period_tbl[n]));
+            }
+          }
+        }
+        
+        // Crunch volume/decimal commands
+        if(fxc[chn] == 0x50 || fxc[chn] == 0x60 || fxc[chn] == 0xA0) {
+          fxp[chn] = (fxp[chn] >> 1) & 0x77;
+        } else if(fxc[chn] == 0x70) {
+          fxp[chn] = (fxp[chn] & 0xF0) | ((fxp[chn] & 0x0F) >> 1);
+        } else if(fxc[chn] == 0xC0 || fxc[chn] == 0xEA || fxc[chn] == 0xEB) {
+          fxp[chn] >>= 1;
+        } else if(fxc[chn] == 0xD0) {
+          fxp[chn] = ((fxp[chn] >> 4) * 10) | (fxp[chn] & 0x0F);
+        }
+
+        // Re-nibblify - it's a word!
+        if(chn != 3) {
+          if((fxc[chn] & 0xF0) == 0xE0) fxp[chn] |= fxc[chn] << 4;
+          fxc[chn] >>= 4;       
+        }
+
+      }
+
+      // Ghetto crunch the last channel to save a byte
+      switch(fxc[3]) {
+        case 0x50: case 0x60: case 0xA0:
+          fxc[3] = 0x1;
+          if((fxp[3] >> 4) >= (fxp[3] & 0x0F)) {
+            fxp[3] = 0x80 + ((fxp[3] >> 4) - (fxp[3] & 0x0F));
+          } else {
+            fxp[3] = ((fxp[3] & 0x0F) - (fxp[3] >> 4));
+          }
+          break;
+        case 0x70:
+          fxc[3] = (fxp[3] & 0x4) ? 0x3 : 0x2;
+          fxp[3] = (fxp[3] >> 4) | ((fxp[3] & 0x03) << 4);
+          break;
+        case 0xC0:
+          fxc[3] = 0x4;
+          fxp[3] &= 0x1F;
+          break;
+        case 0xB0:
+          fxc[3] = 0x5;
+          fxp[3] &= 0x1F;
+          break;
+        case 0xD0:
+          fxc[3] = 0x6;
+          if(fxp[3] > 63) fxp[3] = 0;
+          break;
+        case 0xF0:
+          if(fxp[3] > 0x20) {
+            fxc[3] = 0x0;
+            fxp[3] = 0x00;
+          } else {
+            fxc[3] = 0x7;             
+          }
+          break;
+        case 0xE7:
+          fxc[3] = 0x8;
+          break;
+        case 0xE9:
+          fxc[3] = 0x9;
+          break;
+        case 0xEA:
+          fxc[3] = 0xA;
+          fxp[3] |= 0x08;
+          break;
+        case 0xEB:
+          fxc[3] = 0xA;
+          break;
+        case 0xEC:
+          fxc[3] = 0xB;
+          break;
+        case 0xED:
+          fxc[3] = 0xB;
+          fxp[3] |= 0x10;
+          break;
+        case 0xEE:
+          fxc[3] = 0xC;
+          break;
+        default:
+          fxc[3] = 0;
+          fxp[3] = 0;
+      }
+      if(note[3] != 0x7F) fxp[3] |= 0x80;
+      if(sample[3]) fxp[3] |= 0x40;
+
+      // Write out
+      out.write((fxc[0]) | fxc[1] << 4);
+      out.write(fxp[0]);
+      out.write(fxp[1]);
+      out.write((fxc[2]) | fxc[3] << 4);
+      out.write(fxp[2]);
+      out.write(fxp[3]);
+      out.write(note[0] | (sample[0] == 0 ? 0x00 : 0x80));
+      out.write(note[1] | (sample[1] == 0 ? 0x00 : 0x80));
+      out.write(note[2] | (sample[2] == 0 ? 0x00 : 0x80));
+    }
+  }
+}*/
\ No newline at end of file