Rotorhead
/
MainMitFreq
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: mbed
Diff: MainWithFreq.cpp
- Revision:
- 2:7900c18cebd5
- Parent:
- 1:c3ba9212f103
- Child:
- 3:c9341431a333
--- a/MainWithFreq.cpp Mon Jun 23 16:36:02 2014 +0000
+++ b/MainWithFreq.cpp Wed Jun 25 15:22:02 2014 +0000
@@ -1,13 +1,13 @@
#include "mbed.h"
-
+
SPI spiR(p11, p12, p13); // mosi, miso, sclk
DigitalOut lpR(p10);
DigitalOut bpR(p14);
-
+
SPI spiL(p5, p6, p7);
DigitalOut lpL(p8);
DigitalOut bpL(p9);
-
+
void latch()
{
lpR = 1;
@@ -19,10 +19,10 @@
lpR = 0;
lpL = 0;
}
-
+
-
- //FREQ CONTROL CONFIG
+
+//FREQ CONTROL CONFIG
Ticker tick;
InterruptIn in(p22);
@@ -32,13 +32,17 @@
//INTERRUPT FEEDBACK LED
DigitalOut led(LED1);
+DigitalOut led2(LED2);
+DigitalOut led3(LED3);
+DigitalOut led4(LED4);
//RUNTIME VARS
-int t_period = 0; // This is the period between interrupts in microseconds
+float t_period = 0; // This is the period between interrupts in microseconds
float t_freq = 0;
int last = -1;
-int curt = 0;
+float curt = 0;
+int f = 0;
//DUMMY FUNCTION AS THERE IS NO HEADER FILE
@@ -50,144 +54,220 @@
t1.reset(); // Reset timer and wait for next interrupt
t2.reset();
led = !led;
-}
-
-short outp[48][48]={{0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
- {0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}, };
-
- //short actualrowR[48]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
- //short actualrowL[48]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
- int x,j;
-
- short actualrowR[24]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
- short actualrowL[24]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
-
- short cakeempty[24]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
- short cakefull[24]={0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,
- 0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF};
-
- short radaroff[24]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
- short radaron[24]={0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,
- 0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF};
- short radardot[24]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0};
-
+ f++;
+}
+
+short outp[48][48]= {{0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0,0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+ {0xFFF,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0},
+};
+
+//short actualrowR[48]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
+//short actualrowL[48]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
+int x,j;
+
+short actualrowR[24]= {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
+short actualrowL[24]= {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
+
+short cakeempty[24]= {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
+short cakefull[24]= {0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,
+ 0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF
+ };
+
+short radaroff[24]= {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
+short radaron[24]= {0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,
+ 0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF,0xFFF
+ };
+short radardot[24]= {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xFFF,0,0,0,0,0,0,0,0};
+
int lookupport(int j)
{
-int led, p;
-
-if(j%2 == 1) //Alle ungeradezahligen Ports
- //werden vom rechten Controller angesteuert
- //entsprechend wird "R" als "Side" zugewiesen
+ int led, p;
+
+ if(j%2 == 1) //Alle ungeradezahligen Ports
+ //werden vom rechten Controller angesteuert
+ //entsprechend wird "R" als "Side" zugewiesen
{
-
- p = j/2; //Durch Division /2 bekommen wir eine "normierte Reihe" also (0,1 ,2 ... 12)
-
- if (p%2 == 0) //nochmal %2 da Ports sich abwechseln (0, 23, 1, 22... siehe Tabelle)
- led = 23 - (p/2); //also von "p" ausgegangen, beginnen gerade Zahlen von hinten an (Ports 23, 22, 21... 12)
- else
- led = (p/2); // ungerade Zahlen beginnen von vorne an (Port 0, 1, 2... 11)
+
+ p = j/2; //Durch Division /2 bekommen wir eine "normierte Reihe" also (0,1 ,2 ... 12)
+
+ if (p%2 == 0) //nochmal %2 da Ports sich abwechseln (0, 23, 1, 22... siehe Tabelle)
+ led = 23 - (p/2); //also von "p" ausgegangen, beginnen gerade Zahlen von hinten an (Ports 23, 22, 21... 12)
+ else
+ led = (p/2); // ungerade Zahlen beginnen von vorne an (Port 0, 1, 2... 11)
}
-
- else
-
- {
+
+ else
+
+ {
p = (j-1)/2;
-
+
if (p%2 == 0)
- led = 23 - (p/2);
+ led = 23 - (p/2);
else
- led = (p/2);
- }
-return led;
-
+ led = (p/2);
+ }
+ return led;
+
}
-
+
//returns 1 if right Port, else 0
-int lookupLR(int j){
- return j % 2;
+int lookupLR(int j)
+{
+ return j % 2;
}
-
+
//Hier kommt die Funktion
-
-
+
+
int main()
-{
-
+{
+
lpR = 0;
lpL = 0;
spiR.format(12, 0);
spiR.frequency(30 * 1000 * 1000);
spiL.format(12, 0);
spiL.frequency(30 * 1000 * 1000);
- bpR=0;
- bpL = 0;
-
-
-
-
-
- for(x=0;x<2;x++) {
-
- for(int i=47;i>=0;i--){
+ bpR=1;
+ bpL = 1;
+
+ /*
+ LocalFileSystem local("local");
+ FILE *fp;
+ fp = fopen("/local/curstate.txt", "a+"); // Open "out.txt" on the local file system for writing
+
+ if (fp==NULL) {
+ fp = freopen("/local/curstate.txt","w", fp);
+ led =1;
+ freopen(NULL, "r",fp);
+
+ //error("File could not be opened!");
+ }
+ led4 = 1;
+ int cstate = fgetc(fp);
+ int state = -1;
+ if (cstate == EOF) {
+ freopen(NULL, "w", fp);
+ if (fputc('0',fp) == EOF) {
+ led2=1;
+ //error("File can not be used!");
+ }
+ freopen(NULL, "r", fp);
+ }
+ led4 =1;
+ switch (cstate) {
+ case '0': {
+ state = 0;
+ break;
+ }
+ case '1': {
+ state = 1;
+ break;
+ }
+ case '2': {
+ state = 2;
+ break;
+ }
+ default: {
+ freopen(NULL, "r", fp);
+ if (fputc('0',fp) == EOF) {
+ led3=1;
+ //error("File can not be used!");
+ }
+ freopen(NULL, "r", fp);
+ state = 0;
+ break;
+ }
+ }
+
+ fclose(fp);
+ */
+
+
+
+ for (int v = 0; v<5; ++v) {
+
+ for(int i=47; i>=0; i--) {
bpR=1;
bpL = 1;
- for(int j = 0;j<sizeof(outp[0])/sizeof(outp[0][0]);j++){
- if (lookupLR(j)){
+ for(int j = 0; j<sizeof(outp[0])/sizeof(outp[0][0]); j++) {
+ if (lookupLR(j)) {
actualrowR[lookupport(j)] = outp[i][j];
- }else{
+ } else {
actualrowL[lookupport(j)] = outp[i][j];
}
}
- for (int k =0; k<sizeof(actualrowR)/sizeof(actualrowR[0]);++k){
+ for (int k =0; k<sizeof(actualrowR)/sizeof(actualrowR[0]); ++k) {
spiR.write(actualrowR[k]);
}
- for (int k =0; k<sizeof(actualrowL)/sizeof(actualrowL[0]);++k){
+ for (int k =0; k<sizeof(actualrowL)/sizeof(actualrowL[0]); ++k) {
+ spiL.write(actualrowL[k]);
+ }
+ latch();
+ bpR=0;
+ bpL = 0;
+ wait(0.08);
+ }
+ for(int i=0; i<sizeof(outp)/sizeof(outp[0]); i++) {
+ bpR=1;
+ bpL = 1;
+ for(int j = 0; j<sizeof(outp[0])/sizeof(outp[0][0]); j++) {
+ if (lookupLR(j)) {
+ actualrowR[lookupport(j)] = outp[i][j];
+ } else {
+ actualrowL[lookupport(j)] = outp[i][j];
+ }
+ }
+ for (int k =0; k<sizeof(actualrowR)/sizeof(actualrowR[0]); ++k) {
+ spiR.write(actualrowR[k]);
+ }
+ for (int k =0; k<sizeof(actualrowL)/sizeof(actualrowL[0]); ++k) {
spiL.write(actualrowL[k]);
}
latch();
@@ -195,220 +275,244 @@
bpL = 0;
wait(0.08);
}
- for(int i=0;i<sizeof(outp)/sizeof(outp[0]);i++){
- bpR=1;
- bpL = 1;
- for(int j = 0;j<sizeof(outp[0])/sizeof(outp[0][0]);j++){
- if (lookupLR(j)){
- actualrowR[lookupport(j)] = outp[i][j];
- }else{
- actualrowL[lookupport(j)] = outp[i][j];
+
+ }
+
+ //****************************//
+ //CAKE FUNCTION - YUM YUM
+ //****************************//
+
+
+ {
+ in.mode(PullDown); // Set the pin to Pull Down mode.
+ in.rise(&flip); // Set up the interrupt for rising edge
+ t1.start(); // start the timer
+ t2.start();
+
+ for(; f<500;) { //as a placeholder until we find a way to navigate between programmes
+
+ if(t_period == 0) {
+ continue;
+ }
+ curt = t2.read_us();
+ if (curt < t_period/8
+ || (t_period/4 < curt && curt < (t_period/8)*3 )
+ || (t_period/2 < curt && curt < (t_period/8)*5 )
+ || ((t_period/4)*3 < curt && curt < (t_period/8)*7 )
+ ) {
+ if (last != 0) {
+ //cake empty
+
+ bpL=1;
+ bpR=1;
+ for (int j = 0; j<48; j++) {
+ spiR.write(0x000);
+ spiL.write(0x000);
+ }
+ //for(int j=0; j<sizeof(cakeempty)/sizeof(cakeempty[0]); j++) {
+ // spiR.write(cakeempty[j]);
+ //spiL.write(cakeempty[j]);
+ //}
+ latch();
+ bpL=0;
+ bpR=0;
+ last = 0;
+ }
+ } else {
+ if (last != 1) {
+
+ //cake full
+ bpL=1;
+ bpR=1;
+
+ for (int j = 0; j<48; j++) {
+ spiR.write(0xFFF);
+ spiL.write(0xFFF);
+ }
+
+ //for(int j=0; j<sizeof(cakefull)/sizeof(cakefull[0]); j++) {
+ // spiR.write(cakefull[j]);
+ //spiL.write(cakefull[j]);
+ //}
+ latch();
+ bpL=0;
+ bpR=0;
+ last = 1;
}
}
- for (int k =0; k<sizeof(actualrowR)/sizeof(actualrowR[0]);++k){
- spiR.write(actualrowR[k]);
- }
- for (int k =0; k<sizeof(actualrowL)/sizeof(actualrowL[0]);++k){
- spiL.write(actualrowL[k]);
- }
- latch();
- bpR=0;
- bpL = 0;
- wait(0.08);
- }
-
- }
-
- //****************************//
- //CAKE FUNCTION - YUM YUM
- //****************************//
-
-
-
-{
- in.mode(PullDown); // Set the pin to Pull Down mode.
- in.rise(&flip); // Set up the interrupt for rising edge
- t1.start(); // start the timer
- t2.start();
- int a = 0;
-
- while(a<40) { //as a placeholder until we find a way to navigate between programmes
- a++;
- if(t_period == 0) {
- continue;
- }
- curt = t2.read_us();
- if (curt < t_period/8
- || (t_period/4 < curt && curt < (t_period/8)*3 )
- || (t_period/2 < curt && curt < (t_period/8)*5 )
- || ((t_period/4)*3 < curt && curt < (t_period/8)*7 )
- ) {
-
- } else {
- if (last != 0) {
- //cake empty
- bpL=1;
- bpR=1;
- for (int j = 0; j<48; j++){
- spiR.write(0x000);
- spiL.write(0x000);
- }
- //for(int j=0; j<sizeof(cakeempty)/sizeof(cakeempty[0]); j++) {
- // spiR.write(cakeempty[j]);
- //spiL.write(cakeempty[j]);
- //}
- latch();
- bpL=0;
- bpR=0;
- last = 0;
- }
- if (last != 1) {
-
- //cake full
- bpL=1;
- bpR=1;
-
- for (int j = 0; j<48; j++){
- spiR.write(0x00F);
- spiL.write(0x00F);
- }
-
- //for(int j=0; j<sizeof(cakefull)/sizeof(cakefull[0]); j++) {
- // spiR.write(cakefull[j]);
- //spiL.write(cakefull[j]);
- //}
- latch();
- bpL=0;
- bpR=0;
- last = 1;
- }
}
- bpL=1;
- bpR=1;
- for(j=0;j<sizeof(radaron)/sizeof(radaron[0]);j++){
- spiR.write(radaron[j]);
- }
- latch();
- bpL=0;
- bpR=0;
- wait(0.05); //tentative wait value
-
- //right side off
- bpL=1;
- bpR=1;
- for(j=0;j<sizeof(radaroff)/sizeof(radaroff[0]);j++){
- spiR.write(radaroff[j]);
- }
- bpL=0;
- bpR=0;
- wait(t_period+0.05); //tentative additional wait value
- }
-}
-
-
+
/*********************************/
// RADAR FUNCTION FUCK YEAH //
/**********************************/
-
-
- {
- in.mode(PullDown); // Set the pin to Pull Down mode.
- in.rise(&flip); // Set up the interrupt for rising edge
- t1.start(); // start the timer
- t2.start();
- int a = 0;
-
- while(a<40) { //as a placeholder until we find a way to navigate between programmes
- a++;
- if(t_period == 0) {
- continue;
- }
- curt = t2.read_us();
- if (curt !=t_period)
- {
-
- } else {
- if (last != 0) {
- //cake empty
+
+ f = 0;
+ in.mode(PullDown); // Set the pin to Pull Down mode.
+ in.rise(&flip); // Set up the interrupt for rising edge
+ t1.start(); // start the timer
+ t2.start();
+ //t3.start();
+
+ lpR = 0;
+ lpL = 0;
+ bpR=0;
+ bpL = 0;
- //HERE COMES THE DOT, YO
-
- bpL=1;
- for(j=0;j<sizeof(radardot)/sizeof(radardot[0]);j++){
- spiL.write(radardot[j]);
+ for(; f<500;) {
+ bpL=1;
+ bpR=1;
+ for(j=0; j<sizeof(radaron)/sizeof(radaron[0]); j++) {
+ if(j%2==1) {
+ spiR.write(radaron[j]);
}
- latch();
- bpL=0;
- bpR=0;
- last = 0;
}
- if (last != 1) {
-
- bpL=1;
- for(j=0;j<sizeof(radardot)/sizeof(radardot[0]);j++){
- spiL.write(radaroff[j]);
- }
- latch();
- bpL=0;
- bpR=0;
- last = 1;
- }
- }
- }
+ latch();
+ bpL=0;
+ bpR=0;
+ wait(0.15);
-}
-
-
-
- //Please notice that the wait times for the needle and the dot are different - THIS IS INTENDED
-
-
- //radaron
-
-/*for(x=0;x<20;x++){
- bpL=1;
- bpR=1;
- for(j=0;j<sizeof(radaron)/sizeof(radaron[0]);j++){
- spiR.write(radaron[j]);
- }
- latch();
- bpL=0;
- bpR=0;
- wait(0.15);
-
- //radaroff
+ //right side off, left side on
+ //only if needed
+ bpL=1;
+ bpR=1;
+ for(j=0; j<sizeof(radaroff)/sizeof(radaroff[0]); j++) {
+ spiR.write(radaroff[j]);
+ }
+ bpL=0;
+ bpR=0;
+ wait(0.15);
+
+ //HERE COMES THE DOT, YO
- bpL=1;
- bpR=1;
- for(j=0;j<sizeof(radaroff)/sizeof(radaroff[0]);j++){
- spiR.write(radaroff[j]);
- }
- bpL=0;
- bpR=0;
- wait(0.15);
-
- //HERE COMES THE DOT, YO
-
- bpL=1;
- for(j=0;j<sizeof(radardot)/sizeof(radardot[0]);j++){
- spiL.write(radardot[j]);
- }
- latch();
- bpL=0;
- bpR=0;
- wait(0.1);
-
- bpL=1;
- for(j=0;j<sizeof(radardot)/sizeof(radardot[0]);j++){
- spiL.write(radaroff[j]);
- }
- latch();
- bpL=0;
- bpR=0;
- wait(0.1);
-}*/
+ bpL=1;
+ for(j=0; j<sizeof(radardot)/sizeof(radardot[0]); j++) {
+ spiL.write(radardot[j]);
+ }
+ latch();
+ bpL=0;
+ bpR=0;
+ wait(0.1);
+
+ bpL=1;
+ for(j=0; j<sizeof(radardot)/sizeof(radardot[0]); j++) {
+ spiL.write(radaroff[j]);
+ }
+ latch();
+ bpL=0;
+ bpR=0;
+ wait(0.1);
+
+ /*
+ if(t_period == 0) {
+ continue;
+ }*/
+
+
-}
\ No newline at end of file
+ /* OLD FUNCTION
+ *
+ *
+
+ in.mode(PullDown); // Set the pin to Pull Down mode.
+ in.rise(&flip); // Set up the interrupt for rising edge
+ t1.start(); // start the timer
+ t2.start();
+ int a = 0;
+
+ while(1) { //as a placeholder until we find a way to navigate between programmes
+ a++;
+ if(t_period == 0) {
+ continue;
+ }
+ curt = t2.read_us();
+ if (curt !=t_period) {
+
+ } else {
+ if (last != 0) {
+ //cake empty
+
+ //HERE COMES THE DOT, YO
+
+ bpL=1;
+ for(j=0; j<sizeof(radardot)/sizeof(radardot[0]); j++) {
+ spiL.write(radardot[j]);
+ }
+ latch();
+ bpL=0;
+ bpR=0;
+ last = 0;
+ }
+ if (last != 1) {
+
+ bpL=1;
+ for(j=0; j<sizeof(radardot)/sizeof(radardot[0]); j++) {
+ spiL.write(radaroff[j]);
+ }
+ latch();
+ bpL=0;
+ bpR=0;
+ last = 1;
+ }
+ }
+ }
+ */
+
+
+
+ }
+
+
+
+//Please notice that the wait times for the needle and the dot are different - THIS IS INTENDED
+
+
+//radaron
+
+ /*for(x=0;x<20;x++){
+ bpL=1;
+ bpR=1;
+ for(j=0;j<sizeof(radaron)/sizeof(radaron[0]);j++){
+ spiR.write(radaron[j]);
+ }
+ latch();
+ bpL=0;
+ bpR=0;
+ wait(0.15);
+
+ //radaroff
+
+ bpL=1;
+ bpR=1;
+ for(j=0;j<sizeof(radaroff)/sizeof(radaroff[0]);j++){
+ spiR.write(radaroff[j]);
+ }
+ bpL=0;
+ bpR=0;
+ wait(0.15);
+
+ //HERE COMES THE DOT, YO
+
+ bpL=1;
+ for(j=0;j<sizeof(radardot)/sizeof(radardot[0]);j++){
+ spiL.write(radardot[j]);
+ }
+ latch();
+ bpL=0;
+ bpR=0;
+ wait(0.1);
+
+ bpL=1;
+ for(j=0;j<sizeof(radardot)/sizeof(radardot[0]);j++){
+ spiL.write(radaroff[j]);
+ }
+ latch();
+ bpL=0;
+ bpR=0;
+ wait(0.1);
+ }*/
+ }
+
+ }
\ No newline at end of file