OSHW for SFM
Dependencies: BufferedSoftSerial WS2812 beep mbed-rtos mbed
Revision 0:f41c164416f0, committed 2017-02-07
- Comitter:
- hyeonchanglee
- Date:
- Tue Feb 07 23:34:01 2017 +0000
- Commit message:
- test version
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/BufferedSoftSerial.lib Tue Feb 07 23:34:01 2017 +0000 @@ -0,0 +1,1 @@ +http://developer.mbed.org/users/Sissors/code/BufferedSoftSerial/#671a6724ce79
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/WS2812.lib Tue Feb 07 23:34:01 2017 +0000 @@ -0,0 +1,1 @@ +http://developer.mbed.org/users/bridadan/code/WS2812/#6e647820f587
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/beep.lib Tue Feb 07 23:34:01 2017 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/dreschpe/code/beep/#d8e14429a95f
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Tue Feb 07 23:34:01 2017 +0000
@@ -0,0 +1,279 @@
+#include "mbed.h"
+#include "rtos.h"
+#include "stdio.h"
+#include "stdlib.h"
+#include "beep.h"
+#include "WS2812.h"
+#include "BufferedSoftSerial.h"
+#include "pitches.h"
+
+//PwmOut out(D9); //piezo buzzer
+DigitalIn btn_enroll(D6);
+DigitalIn btn_identify(D7);
+DigitalIn btn_delete(D8);
+
+Serial pc(USBTX, USBRX); //debug port
+BufferedSoftSerial device(D2, D3);
+Beep beep(D9);
+
+float melody[] = { NOTE_C7, NOTE_E7, NOTE_G7, NOTE_C8, NOTE_C8, NOTE_C8 };
+float noteDuration[] = { 8.0, 8.0, 8.0, 4.0, 4.0, 8.0 };
+
+
+void melodyStart();
+void melodySuccess();
+void melodyFail();
+WS2812 ws(D11, 1, 7,15,10,15);
+int colorbuf[4] = { 0x00000033, 0x0000FFFF, 0x0000FF00, 0x00001199}; //blue, orange, green, red
+
+int main()
+{
+
+ melodyStart();
+
+ //pc.baud(115200);
+ device.baud(19200);
+ unsigned char IS[] = { 0x40, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x51, 0x0A}; // Identify by Scan
+ unsigned char ES[] = { 0x40, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x79, 0xBE, 0x0A}; // Enroll by Scan
+ unsigned char DA[] = { 0x40, 0x17, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x57, 0x0A}; // Delete all
+
+
+ ws.useII(WS2812::GLOBAL);
+ ws.setII(0xAA);
+
+ melodyStart();
+
+ while(1) {
+ pc.printf("%d %d %d\n\r", btn_enroll, btn_identify, btn_delete);
+ if(btn_enroll) {
+ //ws.write(&colorbuf[3]);
+ device.write((unsigned char*)ES, sizeof(ES));
+
+ for(int i=0; i<2; i++) {
+ ws.write(&colorbuf[0]);
+ wait(0.2);
+
+ while(1) {
+ if(device.readable() > 0)
+ break;
+ }
+
+
+ unsigned char rxBuffer[256]= {0};
+ int count = 0;
+
+ wait(0.2);
+
+ while(device.readable()>0) {
+ rxBuffer[count] = (unsigned char)device.getc();
+ count++;
+ }
+ pc.printf("recv : ");
+ for(int i=0; i<13; i++)
+ pc.printf("%d ", rxBuffer[i]);
+ pc.printf(" count : %d \n\r", count);
+
+ if((unsigned char)rxBuffer[10] == 0x62) {
+ while(1) {
+ if(device.readable()>0)
+ break;
+ }
+
+ int count = 0;
+
+ wait(0.2);
+
+ while(device.readable()) {
+ rxBuffer[count] = (unsigned char)device.getc();
+ count++;
+ }
+
+ unsigned int userID;
+ userID = rxBuffer[5] << 24 | rxBuffer[4] << 16 | rxBuffer[3] << 8 | rxBuffer[2];
+
+ pc.printf("userID : %d\n\r", userID);
+ if((unsigned char)rxBuffer[10] == 0x61) {
+ melodySuccess();
+ } else {
+ melodyFail();
+ break;
+ }
+ } else {
+ melodyFail();
+ break;
+ }
+ }
+ }
+ if(btn_identify) {
+ //ws.write(&colorbuf[3]);
+ device.write((unsigned char*)IS, sizeof(IS));
+
+
+ wait(0.2);
+
+ while(1) {
+ if(device.readable() > 0)
+ break;
+ }
+
+
+ unsigned char rxBuffer[256]= {0};
+ int count = 0;
+
+ wait(0.2);
+
+ while(device.readable()>0) {
+ rxBuffer[count] = (unsigned char)device.getc();
+ count++;
+ }
+ pc.printf("recv : ");
+ for(int i=0; i<13; i++)
+ pc.printf("%d ", rxBuffer[i]);
+ pc.printf(" count : %d \n\r", count);
+
+ if((unsigned char)rxBuffer[10] == 0x62) {
+ while(1) {
+ if(device.readable()>0)
+ break;
+ }
+
+ int count = 0;
+
+ wait(0.2);
+
+ while(device.readable()) {
+ rxBuffer[count] = (unsigned char)device.getc();
+ count++;
+ }
+
+ unsigned int userID;
+ userID = rxBuffer[5] << 24 | rxBuffer[4] << 16 | rxBuffer[3] << 8 | rxBuffer[2];
+
+ pc.printf("userID : %d\n\r", userID);
+ if((unsigned char)rxBuffer[10] == 0x61) {
+ melodySuccess();
+ } else {
+ melodyFail();
+
+ }
+ } else {
+ melodyFail();
+
+ }
+
+ }
+ if(btn_delete) {
+ //ws.write(&colorbuf[3]);
+ device.write((unsigned char*)DA, sizeof(DA));
+
+
+ wait(0.2);
+
+ while(1) {
+ if(device.readable() > 0)
+ break;
+ }
+
+
+ unsigned char rxBuffer[256]= {0};
+ int count = 0;
+
+ wait(0.2);
+
+ while(device.readable()>0) {
+ rxBuffer[count] = (unsigned char)device.getc();
+ count++;
+ }
+ pc.printf("recv : ");
+ for(int i=0; i<13; i++)
+ pc.printf("%d ", rxBuffer[i]);
+ pc.printf(" count : %d \n\r", count);
+
+ if((unsigned char)rxBuffer[10] == 0x61) {
+ melodySuccess();
+ } else {
+ melodyFail();
+
+ }
+ }
+
+
+
+
+ /*
+ WS2812 ws(D11, 1, 7,15,10,15);
+ beep.beep(4186.0, 1.0);
+ wait(1.0);
+ ws.write(&colorbuf[0]);
+ wait(0.5);
+ ws.write(&colorbuf[1]);
+ wait(0.5);
+ ws.write(&colorbuf[2]);
+ wait(0.5);
+ ws.write(&colorbuf[3]);
+ wait(0.5);
+ ws.write(&colorbuf[4]);
+ wait(0.5);
+ ws.write(&colorbuf[5]);
+ wait(0.5);
+ // if(sfm.writeable())
+
+
+ device.write((unsigned char*)buff, 13);
+
+ wait(5);
+ */
+ //ws.write(&colorbuf[0]);
+ //wait(0.1);
+ }
+
+}
+
+void melodyStart()
+{
+ beep.beep(melody[0], 1.0 / (float)noteDuration[0]);
+ wait((1.0/(float)noteDuration[0])*1.30);
+ beep.nobeep();
+
+ beep.beep(melody[1], 1.0 / (float)noteDuration[1]);
+ wait((1.0/(float)noteDuration[0])*1.30);
+ beep.nobeep();
+
+ beep.beep(melody[2], 1.0 / (float)noteDuration[2]);
+ wait((1.0/(float)noteDuration[0])*1.30);
+ beep.nobeep();
+
+ beep.beep(melody[3], 1.0 / (float)noteDuration[3]);
+ wait((1.0/(float)noteDuration[0])*1.30);
+ beep.nobeep();
+}
+
+void melodySuccess()
+{
+ ws.write(&colorbuf[2]);
+
+ beep.beep(melody[0], 1.0 / noteDuration[0]);
+ wait((1.0/noteDuration[0])*1.30);
+ beep.nobeep();
+
+ beep.beep(melody[1], 1.0 / noteDuration[1]);
+ wait((1.0/noteDuration[0])*1.30);
+ beep.nobeep();
+
+ beep.beep(melody[2], 1.0 / noteDuration[2]);
+ wait((1.0/noteDuration[0])*1.30);
+ beep.nobeep();
+ ws.write(&colorbuf[0]);
+}
+void melodyFail()
+{
+ ws.write(&colorbuf[3]);
+ beep.beep(melody[4], 1.0 / noteDuration[4]);
+ wait((1.0/noteDuration[0])*1.30);
+ beep.nobeep();
+
+ beep.beep(melody[5], 1.0 / noteDuration[5]);
+ wait((1.0/noteDuration[0])*1.30);
+ beep.nobeep();
+ ws.write(&colorbuf[0]);
+}
\ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed-rtos.lib Tue Feb 07 23:34:01 2017 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed-rtos/#58563e6cba1e
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Tue Feb 07 23:34:01 2017 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/d75b3fe1f5cb \ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/pitches.h Tue Feb 07 23:34:01 2017 +0000 @@ -0,0 +1,93 @@ +/************************************************* + * Public Constants + *************************************************/ + +#define NOTE_B0 31 +#define NOTE_C1 33 +#define NOTE_CS1 35 +#define NOTE_D1 37 +#define NOTE_DS1 39 +#define NOTE_E1 41 +#define NOTE_F1 44 +#define NOTE_FS1 46 +#define NOTE_G1 49 +#define NOTE_GS1 52 +#define NOTE_A1 55 +#define NOTE_AS1 58 +#define NOTE_B1 62 +#define NOTE_C2 65 +#define NOTE_CS2 69 +#define NOTE_D2 73 +#define NOTE_DS2 78 +#define NOTE_E2 82 +#define NOTE_F2 87 +#define NOTE_FS2 93 +#define NOTE_G2 98 +#define NOTE_GS2 104 +#define NOTE_A2 110 +#define NOTE_AS2 117 +#define NOTE_B2 123 +#define NOTE_C3 131 +#define NOTE_CS3 139 +#define NOTE_D3 147 +#define NOTE_DS3 156 +#define NOTE_E3 165 +#define NOTE_F3 175 +#define NOTE_FS3 185 +#define NOTE_G3 196 +#define NOTE_GS3 208 +#define NOTE_A3 220 +#define NOTE_AS3 233 +#define NOTE_B3 247 +#define NOTE_C4 262 +#define NOTE_CS4 277 +#define NOTE_D4 294 +#define NOTE_DS4 311 +#define NOTE_E4 330 +#define NOTE_F4 349 +#define NOTE_FS4 370 +#define NOTE_G4 392 +#define NOTE_GS4 415 +#define NOTE_A4 440 +#define NOTE_AS4 466 +#define NOTE_B4 494 +#define NOTE_C5 523 +#define NOTE_CS5 554 +#define NOTE_D5 587 +#define NOTE_DS5 622 +#define NOTE_E5 659 +#define NOTE_F5 698 +#define NOTE_FS5 740 +#define NOTE_G5 784 +#define NOTE_GS5 831 +#define NOTE_A5 880 +#define NOTE_AS5 932 +#define NOTE_B5 988 +#define NOTE_C6 1047 +#define NOTE_CS6 1109 +#define NOTE_D6 1175 +#define NOTE_DS6 1245 +#define NOTE_E6 1319 +#define NOTE_F6 1397 +#define NOTE_FS6 1480 +#define NOTE_G6 1568 +#define NOTE_GS6 1661 +#define NOTE_A6 1760 +#define NOTE_AS6 1865 +#define NOTE_B6 1976 +#define NOTE_C7 2093 +#define NOTE_CS7 2217 +#define NOTE_D7 2349 +#define NOTE_DS7 2489 +#define NOTE_E7 2637 +#define NOTE_F7 2794 +#define NOTE_FS7 2960 +#define NOTE_G7 3136 +#define NOTE_GS7 3322 +#define NOTE_A7 3520 +#define NOTE_AS7 3729 +#define NOTE_B7 3951 +#define NOTE_C8 4186 +#define NOTE_CS8 4435 +#define NOTE_D8 4699 +#define NOTE_DS8 4978 \ No newline at end of file