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
diff -r 000000000000 -r f41c164416f0 BufferedSoftSerial.lib --- /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
diff -r 000000000000 -r f41c164416f0 WS2812.lib --- /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
diff -r 000000000000 -r f41c164416f0 beep.lib --- /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
diff -r 000000000000 -r f41c164416f0 main.cpp --- /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
diff -r 000000000000 -r f41c164416f0 mbed-rtos.lib --- /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
diff -r 000000000000 -r f41c164416f0 mbed.bld --- /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
diff -r 000000000000 -r f41c164416f0 pitches.h --- /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