ian rau / Mbed 2 deprecated ProjectVLC

demo versie 16/05

Dependencies:   EthernetInterface mbed-rto mbed

Fork of ProjectVLC by Klaas Govaerts

LEDDriver.cpp@26:29948b116e82, 2018-04-25 (annotated)

Committer:
albireo987
Date:
Wed Apr 25 14:13:22 2018 +0000
Revision:
26:29948b116e82
Parent:
25:4c673da1a3ae
Child:
32:537005b4a065
thread+queue driver;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
albireo987 2:36158325f7b0 1 #include "LEDDriver.h"
albireo987 25:4c673da1a3ae 2 Serial pc(USBTX,USBRX);
albireo987 25:4c673da1a3ae 3 LEDDriver::LEDDriver( Queue<int,8>* queue)
albireo987 2:36158325f7b0 4 {
albireo987 25:4c673da1a3ae 5 static int messageList[8]={4,4,4,4,4,4,4,4};
albireo987 10:7871aeacea08 6 static DigitalOut leds[]={DigitalOut(p23),DigitalOut(p11),DigitalOut(p12),DigitalOut(p13),DigitalOut(p14),DigitalOut(p15),DigitalOut(p16),DigitalOut(p17)};
albireo987 2:36158325f7b0 7 this->messageList=messageList;
albireo987 2:36158325f7b0 8 this->leds=leds;
albireo987 25:4c673da1a3ae 9 this->queue=queue;// prep for multithreaded
albireo987 25:4c673da1a3ae 10
albireo987 2:36158325f7b0 11 }
albireo987 2:36158325f7b0 12
albireo987 2:36158325f7b0 13 void LEDDriver::drive(int numberOfLeds)
albireo987 2:36158325f7b0 14 {
albireo987 25:4c673da1a3ae 15 // 1 1 1 1 0 0 0 0 0 1
albireo987 10:7871aeacea08 16 static int codedMessage0[]={1,0,1,0,1,0,1,0,1,0,1,0,1,0,1,0,1,0,1,0};//{1,0,1,0,1,0,1,0,0,1,0,1,0,1,0,1,0,1,1,0}; currently frequency measure message(standard square wave)
albireo987 9:c800045806f0 17 // 1 1 1 1 0 1 0 0 0 1
albireo987 9:c800045806f0 18 static int codedMessage1[]={1,0,1,0,1,0,1,0,0,1,1,0,0,1,0,1,0,1,1,0};
albireo987 9:c800045806f0 19 // 1 1 1 1 1 0 1 0 0 1
albireo987 9:c800045806f0 20 static int codedMessage2[]={1,0,1,0,1,0,1,0,1,0,0,1,0,1,0,1,0,1,1,0};
albireo987 9:c800045806f0 21 // 1 1 1 1 1 1 0 0 0 1
albireo987 9:c800045806f0 22 static int codedMessage3[]={1,0,1,0,1,0,1,0,1,0,1,0,0,1,0,1,0,1,1,0};
albireo987 25:4c673da1a3ae 23 static int codedMessage4[]={1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1};//default message for multithreading
albireo987 10:7871aeacea08 24 while(true)
albireo987 25:4c673da1a3ae 25 {
albireo987 26:29948b116e82 26 poll(numberOfLeds,1) ;//prep multi
albireo987 26:29948b116e82 27 for(int j=0;j<20;j++)
albireo987 26:29948b116e82 28 {
albireo987 26:29948b116e82 29 for(int i =0;i<numberOfLeds;i++)
albireo987 26:29948b116e82 30 {
albireo987 9:c800045806f0 31 if(messageList[i]==0)
albireo987 9:c800045806f0 32 {
albireo987 9:c800045806f0 33 leds[i].write(codedMessage0[j]);
albireo987 26:29948b116e82 34 // ownWait(1);//7.511kHZ
albireo987 26:29948b116e82 35 }
albireo987 9:c800045806f0 36 else if(messageList[i]==1)
albireo987 9:c800045806f0 37 {
albireo987 9:c800045806f0 38 leds[i].write(codedMessage1[j]);
albireo987 26:29948b116e82 39 // ownWait(1);
albireo987 9:c800045806f0 40 }
albireo987 9:c800045806f0 41 else if(messageList[i]==2)
albireo987 9:c800045806f0 42 {
albireo987 9:c800045806f0 43 leds[i].write(codedMessage2[j]);
albireo987 26:29948b116e82 44 // ownWait(1);
albireo987 9:c800045806f0 45 }
albireo987 9:c800045806f0 46 else if(messageList[i]==3)
albireo987 9:c800045806f0 47 {
albireo987 9:c800045806f0 48 leds[i].write(codedMessage3[j]);
albireo987 26:29948b116e82 49 // ownWait(1);
albireo987 25:4c673da1a3ae 50 }
albireo987 25:4c673da1a3ae 51 else if(messageList[i]==4)
albireo987 25:4c673da1a3ae 52 {
albireo987 25:4c673da1a3ae 53 leds[i].write(codedMessage4[j]);
albireo987 26:29948b116e82 54 // ownWait(1);
albireo987 9:c800045806f0 55 }
albireo987 26:29948b116e82 56 }
albireo987 26:29948b116e82 57 }
albireo987 26:29948b116e82 58 }
albireo987 9:c800045806f0 59 }
albireo987 2:36158325f7b0 60 }
albireo987 2:36158325f7b0 61
albireo987 2:36158325f7b0 62 void LEDDriver::run(int numberOfLeds)
albireo987 2:36158325f7b0 63 {
albireo987 2:36158325f7b0 64 drive(numberOfLeds);
albireo987 2:36158325f7b0 65 }
albireo987 2:36158325f7b0 66
albireo987 10:7871aeacea08 67 void LEDDriver::ownWait(uint32_t us)
albireo987 10:7871aeacea08 68 {
albireo987 10:7871aeacea08 69 for(uint32_t i=0;i<us;i++)
albireo987 10:7871aeacea08 70 {
albireo987 10:7871aeacea08 71 for(volatile uint32_t j =0; j <96;j++)
albireo987 10:7871aeacea08 72 {
albireo987 10:7871aeacea08 73
albireo987 10:7871aeacea08 74 }
albireo987 10:7871aeacea08 75 }
albireo987 25:4c673da1a3ae 76 }
albireo987 25:4c673da1a3ae 77
albireo987 26:29948b116e82 78 void LEDDriver::poll(int numberOfLeds,int first)
albireo987 25:4c673da1a3ae 79 {
albireo987 26:29948b116e82 80 if(first==1)
albireo987 26:29948b116e82 81 {
albireo987 26:29948b116e82 82 for(int i =0;i<(numberOfLeds/2);i++)
albireo987 26:29948b116e82 83 {
albireo987 26:29948b116e82 84 osEvent event = queue->get();
albireo987 26:29948b116e82 85 int temp = *((int*)event.value.p);
albireo987 26:29948b116e82 86 if(temp==1||temp==1||temp==2||temp==3)
albireo987 26:29948b116e82 87 {
albireo987 26:29948b116e82 88 messageList[i]=temp;
albireo987 26:29948b116e82 89 }
albireo987 26:29948b116e82 90 }
albireo987 26:29948b116e82 91 }
albireo987 26:29948b116e82 92 else if(first==2)
albireo987 26:29948b116e82 93 {
albireo987 26:29948b116e82 94 for(int i =(numberOfLeds/2);i<(numberOfLeds);i++)
albireo987 26:29948b116e82 95 {
albireo987 26:29948b116e82 96 osEvent event = queue->get();
albireo987 26:29948b116e82 97 int temp = *((int*)event.value.p);
albireo987 26:29948b116e82 98 if(temp==1||temp==1||temp==2||temp==3)
albireo987 26:29948b116e82 99 {
albireo987 26:29948b116e82 100 messageList[i]=temp;
albireo987 26:29948b116e82 101 }
albireo987 26:29948b116e82 102 }
albireo987 26:29948b116e82 103 }
albireo987 2:36158325f7b0 104 }