|
@@ -0,0 +1,518 @@
|
|
|
|
+/*
|
|
|
|
+ Simple SPS System mit dem Arduino.
|
|
|
|
+*/
|
|
|
|
+
|
|
|
|
+// defining different hardware platforms
|
|
|
|
+#ifdef __AVR_ATmega328P__
|
|
|
|
+//#define SPS_USE_DISPLAY
|
|
|
|
+//#define SPS_RECEIVER
|
|
|
|
+//#define SPS_ENHANCEMENT
|
|
|
|
+//#define SPS_SERIAL_PRG
|
|
|
|
+//#define SPS_SERVO
|
|
|
|
+//#define SPS_TONE
|
|
|
|
+#endif
|
|
|
|
+
|
|
|
|
+// libraries
|
|
|
|
+#include <makros.h>
|
|
|
|
+#include <EEPROM.h>
|
|
|
|
+#include <avr/eeprom.h>
|
|
|
|
+
|
|
|
|
+#include "hardware.h"
|
|
|
|
+
|
|
|
|
+// Commands
|
|
|
|
+const byte PORT = 0x10;
|
|
|
|
+const byte DELAY = 0x20;
|
|
|
|
+const byte JUMP_BACK = 0x30;
|
|
|
|
+const byte SET_A = 0x40;
|
|
|
|
+const byte IS_A = 0x50;
|
|
|
|
+const byte A_IS = 0x60;
|
|
|
|
+const byte CALC = 0x70;
|
|
|
|
+const byte PAGE = 0x80;
|
|
|
|
+const byte JUMP = 0x90;
|
|
|
|
+const byte C_COUNT = 0xA0;
|
|
|
|
+const byte D_COUNT = 0xB0;
|
|
|
|
+const byte SKIP_IF = 0xC0;
|
|
|
|
+const byte CALL = 0xD0;
|
|
|
|
+const byte CALL_SUB = 0xE0;
|
|
|
|
+const byte CMD_BYTE = 0xF0;
|
|
|
|
+
|
|
|
|
+// debouncing with 100ms
|
|
|
|
+const byte DEBOUNCE = 100;
|
|
|
|
+
|
|
|
|
+// sub routines
|
|
|
|
+const byte subCnt = 7;
|
|
|
|
+word subs[subCnt];
|
|
|
|
+
|
|
|
|
+// the actual address of the program
|
|
|
|
+word addr;
|
|
|
|
+// page register
|
|
|
|
+word page;
|
|
|
|
+// defining register
|
|
|
|
+byte a, b, c, d;
|
|
|
|
+
|
|
|
|
+const byte SAVE_CNT = 1;
|
|
|
|
+
|
|
|
|
+word saveaddr[SAVE_CNT];
|
|
|
|
+byte saveCnt;
|
|
|
|
+
|
|
|
|
+unsigned long tmpValue;
|
|
|
|
+
|
|
|
|
+byte prog = 0;
|
|
|
|
+byte data = 0;
|
|
|
|
+byte com = 0;
|
|
|
|
+
|
|
|
|
+void setup() {
|
|
|
|
+ pinMode(Dout_0, OUTPUT);
|
|
|
|
+ pinMode(Dout_1, OUTPUT);
|
|
|
|
+ pinMode(Dout_2, OUTPUT);
|
|
|
|
+ pinMode(Dout_3, OUTPUT);
|
|
|
|
+
|
|
|
|
+ pinMode(PWM_1, OUTPUT);
|
|
|
|
+ pinMode(PWM_2, OUTPUT);
|
|
|
|
+
|
|
|
|
+ pinMode(Din_0, INPUT_PULLUP);
|
|
|
|
+ pinMode(Din_1, INPUT_PULLUP);
|
|
|
|
+ pinMode(Din_2, INPUT_PULLUP);
|
|
|
|
+ pinMode(Din_3, INPUT_PULLUP);
|
|
|
|
+
|
|
|
|
+ pinMode(SW_PRG, INPUT_PULLUP);
|
|
|
|
+ pinMode(SW_SEL, INPUT_PULLUP);
|
|
|
|
+
|
|
|
|
+ digitalWrite(Dout_0, 1);
|
|
|
|
+ delay(1000);
|
|
|
|
+ digitalWrite(Dout_0, 0);
|
|
|
|
+
|
|
|
|
+ prgDemoPrg();
|
|
|
|
+ doReset();
|
|
|
|
+
|
|
|
|
+ if (digitalRead(SW_PRG) == 0) {
|
|
|
|
+ programMode();
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+void doReset() {
|
|
|
|
+
|
|
|
|
+ for (int i = 0; i < subCnt; i++) {
|
|
|
|
+ subs[i] = 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ readProgram();
|
|
|
|
+
|
|
|
|
+ addr = 0;
|
|
|
|
+ page = 0;
|
|
|
|
+ saveCnt = 0;
|
|
|
|
+ a = 0;
|
|
|
|
+ b = 0;
|
|
|
|
+ c = 0;
|
|
|
|
+ d = 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ getting all addresses of sub programms
|
|
|
|
+*/
|
|
|
|
+void readProgram() {
|
|
|
|
+ word addr = 0;
|
|
|
|
+ for ( addr = 0; addr <= E2END; addr++) {
|
|
|
|
+ byte value = EEPROM.read(addr);
|
|
|
|
+
|
|
|
|
+ if (value == 0xFF) {
|
|
|
|
+ // ende des Programms
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ byte cmd = (value & 0xF0);
|
|
|
|
+ byte data = (value & 0x0F);
|
|
|
|
+
|
|
|
|
+ if (cmd == CALL_SUB) {
|
|
|
|
+ if (data >= 8) {
|
|
|
|
+ data = data - 8;
|
|
|
|
+ subs[data] = addr + 1;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ main loop
|
|
|
|
+*/
|
|
|
|
+void loop() {
|
|
|
|
+ byte value = EEPROM.read(addr);
|
|
|
|
+ byte cmd = (value & 0xF0);
|
|
|
|
+ byte data = (value & 0x0F);
|
|
|
|
+
|
|
|
|
+ addr = addr + 1;
|
|
|
|
+ switch (cmd) {
|
|
|
|
+ case PORT:
|
|
|
|
+ doPort(data);
|
|
|
|
+ break;
|
|
|
|
+ case DELAY:
|
|
|
|
+ doDelay(data);
|
|
|
|
+ break;
|
|
|
|
+ case JUMP_BACK:
|
|
|
|
+ doJumpBack(data);
|
|
|
|
+ break;
|
|
|
|
+ case SET_A:
|
|
|
|
+ doSetA(data);
|
|
|
|
+ break;
|
|
|
|
+ case A_IS:
|
|
|
|
+ doAIs(data);
|
|
|
|
+ break;
|
|
|
|
+ case IS_A:
|
|
|
|
+ doIsA(data);
|
|
|
|
+ break;
|
|
|
|
+ case CALC:
|
|
|
|
+ doCalc(data);
|
|
|
|
+ break;
|
|
|
|
+ case PAGE:
|
|
|
|
+ doPage(data);
|
|
|
|
+ break;
|
|
|
|
+ case JUMP:
|
|
|
|
+ doJump(data);
|
|
|
|
+ break;
|
|
|
|
+ case C_COUNT:
|
|
|
|
+ doCCount(data);
|
|
|
|
+ break;
|
|
|
|
+ case D_COUNT:
|
|
|
|
+ doDCount(data);
|
|
|
|
+ break;
|
|
|
|
+ case SKIP_IF:
|
|
|
|
+ doSkipIf(data);
|
|
|
|
+ break;
|
|
|
|
+ case CALL:
|
|
|
|
+ doCall(data);
|
|
|
|
+ break;
|
|
|
|
+ case CALL_SUB:
|
|
|
|
+ doCallSub(data);
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ ;
|
|
|
|
+ }
|
|
|
|
+ if (addr > E2END) {
|
|
|
|
+ doReset();
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ output to port
|
|
|
|
+*/
|
|
|
|
+void doPort(byte data) {
|
|
|
|
+ digitalWrite(Dout_0, (data & 0x01) > 0);
|
|
|
|
+ digitalWrite(Dout_1, (data & 0x02) > 0);
|
|
|
|
+ digitalWrite(Dout_2, (data & 0x04) > 0);
|
|
|
|
+ digitalWrite(Dout_3, (data & 0x08) > 0);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ delay in ms
|
|
|
|
+*/
|
|
|
|
+void doDelay(byte data) {
|
|
|
|
+ switch (data) {
|
|
|
|
+ case 0:
|
|
|
|
+ delay(1);
|
|
|
|
+ break;
|
|
|
|
+ case 1:
|
|
|
|
+ delay(2);
|
|
|
|
+ break;
|
|
|
|
+ case 2:
|
|
|
|
+ delay(5);
|
|
|
|
+ break;
|
|
|
|
+ case 3:
|
|
|
|
+ delay(10);
|
|
|
|
+ break;
|
|
|
|
+ case 4:
|
|
|
|
+ delay(20);
|
|
|
|
+ break;
|
|
|
|
+ case 5:
|
|
|
|
+ delay(50);
|
|
|
|
+ break;
|
|
|
|
+ case 6:
|
|
|
|
+ delay(100);
|
|
|
|
+ break;
|
|
|
|
+ case 7:
|
|
|
|
+ delay(200);
|
|
|
|
+ break;
|
|
|
|
+ case 8:
|
|
|
|
+ delay(500);
|
|
|
|
+ break;
|
|
|
|
+ case 9:
|
|
|
|
+ delay(1000);
|
|
|
|
+ break;
|
|
|
|
+ case 10:
|
|
|
|
+ delay(2000);
|
|
|
|
+ break;
|
|
|
|
+ case 11:
|
|
|
|
+ delay(5000);
|
|
|
|
+ break;
|
|
|
|
+ case 12:
|
|
|
|
+ delay(10000);
|
|
|
|
+ break;
|
|
|
|
+ case 13:
|
|
|
|
+ delay(20000);
|
|
|
|
+ break;
|
|
|
|
+ case 14:
|
|
|
|
+ delay(30000);
|
|
|
|
+ break;
|
|
|
|
+ case 15:
|
|
|
|
+ delay(60000);
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ jump relative back
|
|
|
|
+*/
|
|
|
|
+void doJumpBack(byte data) {
|
|
|
|
+ addr = addr - data - 1;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ a = data
|
|
|
|
+*/
|
|
|
|
+void doSetA(byte data) {
|
|
|
|
+ a = data;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ a = somthing;
|
|
|
|
+*/
|
|
|
|
+void doAIs(byte data) {
|
|
|
|
+ switch (data) {
|
|
|
|
+ case 1:
|
|
|
|
+ a = b;
|
|
|
|
+ break;
|
|
|
|
+ case 2:
|
|
|
|
+ a = c;
|
|
|
|
+ break;
|
|
|
|
+ case 3:
|
|
|
|
+ a = d;
|
|
|
|
+ break;
|
|
|
|
+ case 4:
|
|
|
|
+ a = digitalRead(Din_0) + (digitalRead(Din_1) << 1) + (digitalRead(Din_2) << 2) + (digitalRead(Din_3) << 3);
|
|
|
|
+ break;
|
|
|
|
+ case 5:
|
|
|
|
+ a = digitalRead(Din_0);
|
|
|
|
+ break;
|
|
|
|
+ case 6:
|
|
|
|
+ a = digitalRead(Din_1);
|
|
|
|
+ break;
|
|
|
|
+ case 7:
|
|
|
|
+ a = digitalRead(Din_2);
|
|
|
|
+ break;
|
|
|
|
+ case 8:
|
|
|
|
+ a = digitalRead(Din_3);
|
|
|
|
+ break;
|
|
|
|
+ case 9:
|
|
|
|
+ tmpValue = analogRead(ADC_0);
|
|
|
|
+ a = tmpValue / 64; //(Umrechnen auf 4 bit)
|
|
|
|
+ break;
|
|
|
|
+ case 10:
|
|
|
|
+ tmpValue = analogRead(ADC_1);
|
|
|
|
+ a = tmpValue / 64; //(Umrechnen auf 4 bit)
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ somthing = a;
|
|
|
|
+*/
|
|
|
|
+void doIsA(byte data) {
|
|
|
|
+ switch (data) {
|
|
|
|
+ case 1:
|
|
|
|
+ b = a;
|
|
|
|
+ break;
|
|
|
|
+ case 2:
|
|
|
|
+ c = a;
|
|
|
|
+ break;
|
|
|
|
+ case 3:
|
|
|
|
+ d = a;
|
|
|
|
+ break;
|
|
|
|
+ case 4:
|
|
|
|
+ doPort(a);
|
|
|
|
+ break;
|
|
|
|
+ case 5:
|
|
|
|
+ digitalWrite(Dout_0, (a & 0x01) > 0);
|
|
|
|
+ break;
|
|
|
|
+ case 6:
|
|
|
|
+ digitalWrite(Dout_1, (a & 0x01) > 0);
|
|
|
|
+ break;
|
|
|
|
+ case 7:
|
|
|
|
+ digitalWrite(Dout_2, (a & 0x01) > 0);
|
|
|
|
+ break;
|
|
|
|
+ case 8:
|
|
|
|
+ digitalWrite(Dout_3, (a & 0x01) > 0);
|
|
|
|
+ break;
|
|
|
|
+ case 9:
|
|
|
|
+ tmpValue = a * 16;
|
|
|
|
+ analogWrite(PWM_1, tmpValue);
|
|
|
|
+ break;
|
|
|
|
+ case 10:
|
|
|
|
+ tmpValue = a * 16;
|
|
|
|
+ analogWrite(PWM_2, tmpValue);
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ calculations
|
|
|
|
+*/
|
|
|
|
+void doCalc(byte data) {
|
|
|
|
+ switch (data) {
|
|
|
|
+ case 1:
|
|
|
|
+ a = a + 1;
|
|
|
|
+ break;
|
|
|
|
+ case 2:
|
|
|
|
+ a = a - 1;
|
|
|
|
+ break;
|
|
|
|
+ case 3:
|
|
|
|
+ a = a + b;
|
|
|
|
+ break;
|
|
|
|
+ case 4:
|
|
|
|
+ a = a - b;
|
|
|
|
+ break;
|
|
|
|
+ case 5:
|
|
|
|
+ a = a * b;
|
|
|
|
+ break;
|
|
|
|
+ case 6:
|
|
|
|
+ a = a / b;
|
|
|
|
+ break;
|
|
|
|
+ case 7:
|
|
|
|
+ a = a & b;
|
|
|
|
+ break;
|
|
|
|
+ case 8:
|
|
|
|
+ a = a | b;
|
|
|
|
+ break;
|
|
|
|
+ case 9:
|
|
|
|
+ a = a ^ b;
|
|
|
|
+ break;
|
|
|
|
+ case 10:
|
|
|
|
+ a = !a;
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ a = a & 15;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ setting page
|
|
|
|
+*/
|
|
|
|
+void doPage(byte data) {
|
|
|
|
+ page = data * 16;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ jump absolute
|
|
|
|
+*/
|
|
|
|
+void doJump(byte data) {
|
|
|
|
+ addr = page + data;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ counting with c register
|
|
|
|
+*/
|
|
|
|
+void doCCount(byte data) {
|
|
|
|
+ if (c > 0) {
|
|
|
|
+ c -= 1;
|
|
|
|
+ c = c & 0x0F;
|
|
|
|
+ doJump(data);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ counting with d register
|
|
|
|
+*/
|
|
|
|
+void doDCount(byte data) {
|
|
|
|
+ if (d > 0) {
|
|
|
|
+ d -= 1;
|
|
|
|
+ d = d & 0x0F;
|
|
|
|
+ doJump(data);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ simple condition = true, skip next command
|
|
|
|
+*/
|
|
|
|
+void doSkipIf(byte data) {
|
|
|
|
+ bool skip = false;
|
|
|
|
+ switch (data) {
|
|
|
|
+ case 1:
|
|
|
|
+ skip = (a > b);
|
|
|
|
+ break;
|
|
|
|
+ case 2:
|
|
|
|
+ skip = (a < b);
|
|
|
|
+ break;
|
|
|
|
+ case 3:
|
|
|
|
+ skip = (a == b);
|
|
|
|
+ break;
|
|
|
|
+ case 4:
|
|
|
|
+ skip = digitalRead(Din_0);
|
|
|
|
+ break;
|
|
|
|
+ case 5:
|
|
|
|
+ skip = digitalRead(Din_1);
|
|
|
|
+ break;
|
|
|
|
+ case 6:
|
|
|
|
+ skip = digitalRead(Din_2);
|
|
|
|
+ break;
|
|
|
|
+ case 7:
|
|
|
|
+ skip = digitalRead(Din_3);
|
|
|
|
+ break;
|
|
|
|
+ case 8:
|
|
|
|
+ skip = !digitalRead(Din_0);
|
|
|
|
+ break;
|
|
|
|
+ case 9:
|
|
|
|
+ skip = !digitalRead(Din_1);
|
|
|
|
+ break;
|
|
|
|
+ case 10:
|
|
|
|
+ skip = !digitalRead(Din_2);
|
|
|
|
+ break;
|
|
|
|
+ case 11:
|
|
|
|
+ skip = !digitalRead(Din_3);
|
|
|
|
+ break;
|
|
|
|
+ case 12:
|
|
|
|
+ skip = !digitalRead(SW_PRG);
|
|
|
|
+ break;
|
|
|
|
+ case 13:
|
|
|
|
+ skip = !digitalRead(SW_SEL);
|
|
|
|
+ break;
|
|
|
|
+ case 14:
|
|
|
|
+ skip = digitalRead(SW_PRG);
|
|
|
|
+ break;
|
|
|
|
+ case 15:
|
|
|
|
+ skip = digitalRead(SW_SEL);
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ if (skip) {
|
|
|
|
+ addr += 1;
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ calling a subroutine
|
|
|
|
+*/
|
|
|
|
+void doCall(byte data) {
|
|
|
|
+ saveaddr[saveCnt] = addr;
|
|
|
|
+ saveCnt++;
|
|
|
|
+ addr = page + data;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ calling a subroutine, calling return and restart
|
|
|
|
+*/
|
|
|
|
+void doCallSub(byte data) {
|
|
|
|
+ if (data == 0) {
|
|
|
|
+ if (saveCnt < 0) {
|
|
|
|
+ doReset();
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+ saveCnt -= 1;
|
|
|
|
+ addr = saveaddr[saveCnt];
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+}
|