22

Dependencies:   DISCO_L475VG_IOT01A_wifi

Committer:
ascension2
Date:
Tue Aug 20 10:45:16 2019 +0000
Revision:
1:98939393d0db
Parent:
0:dc1150daf908
33

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ascension2 0:dc1150daf908 1 #include "mbed.h"
ascension2 0:dc1150daf908 2 #include "Motorcontrol.h"
ascension2 0:dc1150daf908 3 #include "LEDcontrol.h"
ascension2 0:dc1150daf908 4
ascension2 0:dc1150daf908 5 /*
ascension2 0:dc1150daf908 6 data[0] mode 0 send 1 receive
ascension2 0:dc1150daf908 7 data[1] window motor 0 close 1 open
ascension2 0:dc1150daf908 8 data[2] blind motor 0 close 1 open
ascension2 0:dc1150daf908 9 date[3] dust 0
ascension2 0:dc1150daf908 10 date[4] illuminate 0 dark 1 bright
ascension2 0:dc1150daf908 11 date[5] LED 0 off 1 on 2 auto
ascension2 0:dc1150daf908 12 date[6] R100 value of R
ascension2 0:dc1150daf908 13 date[7] R10
ascension2 0:dc1150daf908 14 date[8] R1
ascension2 0:dc1150daf908 15 date[9] G100 value of G
ascension2 0:dc1150daf908 16 date[10] G10
ascension2 0:dc1150daf908 17 date[11] G1
ascension2 0:dc1150daf908 18 date[12] B100 value of B
ascension2 0:dc1150daf908 19 date[13] B10
ascension2 0:dc1150daf908 20 date[14] B1
ascension2 0:dc1150daf908 21 */
ascension2 0:dc1150daf908 22
ascension2 0:dc1150daf908 23
ascension2 0:dc1150daf908 24 float R,B,G;
ascension2 0:dc1150daf908 25 void Data_Receive(uint8_t S[])
ascension2 0:dc1150daf908 26 {
ascension2 0:dc1150daf908 27
ascension2 0:dc1150daf908 28 printf("data checking\n");
ascension2 0:dc1150daf908 29
ascension2 0:dc1150daf908 30 if(S[1]=='0')
ascension2 0:dc1150daf908 31 {
ascension2 1:98939393d0db 32 motor1CCW(100);
ascension2 0:dc1150daf908 33 }
ascension2 0:dc1150daf908 34 else if(S[1]=='1')
ascension2 0:dc1150daf908 35 {
ascension2 1:98939393d0db 36 motor1CW(100);
ascension2 0:dc1150daf908 37 }
ascension2 0:dc1150daf908 38
ascension2 0:dc1150daf908 39 if(S[2]=='0')
ascension2 0:dc1150daf908 40 {
ascension2 1:98939393d0db 41 motor2CCW(100);
ascension2 0:dc1150daf908 42 }
ascension2 0:dc1150daf908 43 else if(S[2]=='1')
ascension2 0:dc1150daf908 44 {
ascension2 1:98939393d0db 45 motor2CW(100);
ascension2 0:dc1150daf908 46 }
ascension2 0:dc1150daf908 47
ascension2 0:dc1150daf908 48 if(S[5]=='0')
ascension2 0:dc1150daf908 49 {
ascension2 0:dc1150daf908 50 int j=6;
ascension2 0:dc1150daf908 51 R= ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 ); j=j+3;
ascension2 0:dc1150daf908 52 G = ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 );j=j+3;
ascension2 0:dc1150daf908 53 B = ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 );
ascension2 0:dc1150daf908 54 setRGB(R,G,B,0);
ascension2 0:dc1150daf908 55 }
ascension2 0:dc1150daf908 56 else if(S[5]=='1')
ascension2 0:dc1150daf908 57 {
ascension2 0:dc1150daf908 58 int j=6;
ascension2 0:dc1150daf908 59 R= ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 ); j=j+3;
ascension2 0:dc1150daf908 60 G = ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 );j=j+3;
ascension2 0:dc1150daf908 61 B = ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 );
ascension2 0:dc1150daf908 62 setRGB(R,G,B,1);
ascension2 0:dc1150daf908 63 }
ascension2 0:dc1150daf908 64 else if(S[5]=='2')
ascension2 0:dc1150daf908 65 {
ascension2 0:dc1150daf908 66 int j=6;
ascension2 0:dc1150daf908 67 R= ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 ); j=j+3;
ascension2 0:dc1150daf908 68 G = ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 );j=j+3;
ascension2 0:dc1150daf908 69 B = ((S[j]-48)*100 )+((S[j+1]-48)*10 )+((S[j+2]-48)*1 );
ascension2 0:dc1150daf908 70 setRGB(R,G,B,2);
ascension2 0:dc1150daf908 71 }
ascension2 0:dc1150daf908 72
ascension2 0:dc1150daf908 73
ascension2 0:dc1150daf908 74 }