This consists of code to display characters received from the transmitter and displays them on the shiftbrites. The color can be chosen dynamically.
main.cpp@0:26a9f2b8a0c7, 2012-12-07 (annotated)
- Committer:
- abarve9
- Date:
- Fri Dec 07 16:20:17 2012 +0000
- Revision:
- 0:26a9f2b8a0c7
This consists of code to display characters received from the transmitter on the shiftbrite LEDs. The color of display can be chosen dynamically.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
abarve9 | 0:26a9f2b8a0c7 | 1 | #include "ADXL345.h" |
abarve9 | 0:26a9f2b8a0c7 | 2 | #include "mbed.h" |
abarve9 | 0:26a9f2b8a0c7 | 3 | #include "iostream" |
abarve9 | 0:26a9f2b8a0c7 | 4 | #include "stdio.h" |
abarve9 | 0:26a9f2b8a0c7 | 5 | #include "stdlib.h" |
abarve9 | 0:26a9f2b8a0c7 | 6 | #include "string" |
abarve9 | 0:26a9f2b8a0c7 | 7 | |
abarve9 | 0:26a9f2b8a0c7 | 8 | using namespace std; |
abarve9 | 0:26a9f2b8a0c7 | 9 | |
abarve9 | 0:26a9f2b8a0c7 | 10 | PortOut ledport(Port1, 0xFFFFFFFF); |
abarve9 | 0:26a9f2b8a0c7 | 11 | ADXL345 accelerometer(p5, p6, p7, p8); |
abarve9 | 0:26a9f2b8a0c7 | 12 | //Serial pc(USBTX, USBRX); |
abarve9 | 0:26a9f2b8a0c7 | 13 | //---shiftbrite |
abarve9 | 0:26a9f2b8a0c7 | 14 | DigitalOut latch(p15); |
abarve9 | 0:26a9f2b8a0c7 | 15 | DigitalOut enable(p16); |
abarve9 | 0:26a9f2b8a0c7 | 16 | SPI spi(p11, p12, p13); |
abarve9 | 0:26a9f2b8a0c7 | 17 | |
abarve9 | 0:26a9f2b8a0c7 | 18 | DigitalOut led8(p28); |
abarve9 | 0:26a9f2b8a0c7 | 19 | DigitalOut led7(p27); |
abarve9 | 0:26a9f2b8a0c7 | 20 | DigitalOut led6(p26); |
abarve9 | 0:26a9f2b8a0c7 | 21 | DigitalOut led5(p25); |
abarve9 | 0:26a9f2b8a0c7 | 22 | DigitalOut led4(p24); |
abarve9 | 0:26a9f2b8a0c7 | 23 | DigitalOut led3(p23); |
abarve9 | 0:26a9f2b8a0c7 | 24 | DigitalOut led2(p22); |
abarve9 | 0:26a9f2b8a0c7 | 25 | DigitalOut led1(p21); |
abarve9 | 0:26a9f2b8a0c7 | 26 | |
abarve9 | 0:26a9f2b8a0c7 | 27 | // ------------------------- Zigbee ------------- |
abarve9 | 0:26a9f2b8a0c7 | 28 | |
abarve9 | 0:26a9f2b8a0c7 | 29 | Serial xbee2(p9, p10); |
abarve9 | 0:26a9f2b8a0c7 | 30 | DigitalOut rst1(p17); |
abarve9 | 0:26a9f2b8a0c7 | 31 | Serial pc1(USBTX, USBRX); |
abarve9 | 0:26a9f2b8a0c7 | 32 | DigitalOut myled(LED2); |
abarve9 | 0:26a9f2b8a0c7 | 33 | |
abarve9 | 0:26a9f2b8a0c7 | 34 | //----RGB Led function |
abarve9 | 0:26a9f2b8a0c7 | 35 | |
abarve9 | 0:26a9f2b8a0c7 | 36 | void RGB_LED(int red, int green, int blue) |
abarve9 | 0:26a9f2b8a0c7 | 37 | { |
abarve9 | 0:26a9f2b8a0c7 | 38 | unsigned int low_color=0; |
abarve9 | 0:26a9f2b8a0c7 | 39 | unsigned int high_color=0; |
abarve9 | 0:26a9f2b8a0c7 | 40 | high_color=(blue<<4)|((red&0x3C0)>>6); |
abarve9 | 0:26a9f2b8a0c7 | 41 | low_color=(((red&0x3F)<<10)|(green)); |
abarve9 | 0:26a9f2b8a0c7 | 42 | spi.write(high_color); |
abarve9 | 0:26a9f2b8a0c7 | 43 | spi.write(low_color); |
abarve9 | 0:26a9f2b8a0c7 | 44 | latch=1; |
abarve9 | 0:26a9f2b8a0c7 | 45 | latch=0; |
abarve9 | 0:26a9f2b8a0c7 | 46 | } |
abarve9 | 0:26a9f2b8a0c7 | 47 | |
abarve9 | 0:26a9f2b8a0c7 | 48 | int main() |
abarve9 | 0:26a9f2b8a0c7 | 49 | { |
abarve9 | 0:26a9f2b8a0c7 | 50 | int count=0; |
abarve9 | 0:26a9f2b8a0c7 | 51 | int readings[3] = {0, 0, 0}; |
abarve9 | 0:26a9f2b8a0c7 | 52 | //int del = 0; |
abarve9 | 0:26a9f2b8a0c7 | 53 | int16_t sum = 0; |
abarve9 | 0:26a9f2b8a0c7 | 54 | int16_t xval[50]; |
abarve9 | 0:26a9f2b8a0c7 | 55 | int i = 0; |
abarve9 | 0:26a9f2b8a0c7 | 56 | char text[30]; |
abarve9 | 0:26a9f2b8a0c7 | 57 | int len,len1; |
abarve9 | 0:26a9f2b8a0c7 | 58 | len1 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 59 | len = 0; |
abarve9 | 0:26a9f2b8a0c7 | 60 | |
abarve9 | 0:26a9f2b8a0c7 | 61 | //---------SHift brite |
abarve9 | 0:26a9f2b8a0c7 | 62 | |
abarve9 | 0:26a9f2b8a0c7 | 63 | int red=0; |
abarve9 | 0:26a9f2b8a0c7 | 64 | int green=0; |
abarve9 | 0:26a9f2b8a0c7 | 65 | int blue=0; |
abarve9 | 0:26a9f2b8a0c7 | 66 | spi.format(16,0); |
abarve9 | 0:26a9f2b8a0c7 | 67 | spi.frequency(500000); |
abarve9 | 0:26a9f2b8a0c7 | 68 | enable=0; |
abarve9 | 0:26a9f2b8a0c7 | 69 | latch=0; |
abarve9 | 0:26a9f2b8a0c7 | 70 | |
abarve9 | 0:26a9f2b8a0c7 | 71 | // --------- Zigbee |
abarve9 | 0:26a9f2b8a0c7 | 72 | |
abarve9 | 0:26a9f2b8a0c7 | 73 | char character; |
abarve9 | 0:26a9f2b8a0c7 | 74 | rst1 = 0; //Set reset pin to 0 |
abarve9 | 0:26a9f2b8a0c7 | 75 | myled = 0; |
abarve9 | 0:26a9f2b8a0c7 | 76 | wait_ms(1); |
abarve9 | 0:26a9f2b8a0c7 | 77 | rst1 = 1; //Set reset pin to 1 |
abarve9 | 0:26a9f2b8a0c7 | 78 | wait_ms(1); |
abarve9 | 0:26a9f2b8a0c7 | 79 | |
abarve9 | 0:26a9f2b8a0c7 | 80 | char buffer[20]; |
abarve9 | 0:26a9f2b8a0c7 | 81 | int global = 0; |
abarve9 | 0:26a9f2b8a0c7 | 82 | |
abarve9 | 0:26a9f2b8a0c7 | 83 | //--- Zigbeeee |
abarve9 | 0:26a9f2b8a0c7 | 84 | |
abarve9 | 0:26a9f2b8a0c7 | 85 | const char font[0x60][5] = { |
abarve9 | 0:26a9f2b8a0c7 | 86 | |
abarve9 | 0:26a9f2b8a0c7 | 87 | {0x00,0x00,0x00,0x00,0x00}, // ASCII - 32 space |
abarve9 | 0:26a9f2b8a0c7 | 88 | {0x00,0x00,0xF9,0x00,0x00}, // ASCII - 33 ! |
abarve9 | 0:26a9f2b8a0c7 | 89 | {0x00,0xE0,0x00,0xE0,0x00}, // ASCII - 34 " |
abarve9 | 0:26a9f2b8a0c7 | 90 | {0x24,0x7E,0x24,0x7E,0x24}, // ASCII - 35 # |
abarve9 | 0:26a9f2b8a0c7 | 91 | {0x34,0x4A,0xFF,0x49,0x26}, // ASCII - 36 $ |
abarve9 | 0:26a9f2b8a0c7 | 92 | {0x22,0x04,0x08,0x10,0x22}, // ASCII - 37 % |
abarve9 | 0:26a9f2b8a0c7 | 93 | {0x26,0x59,0x4D,0x52,0x25}, // ASCII - 38 & |
abarve9 | 0:26a9f2b8a0c7 | 94 | {0x00,0x00,0xE0,0x00,0x00}, // ASCII - 39 ' |
abarve9 | 0:26a9f2b8a0c7 | 95 | {0x00,0x3C,0x42,0x81,0x00}, // ASCII - 40 ( |
abarve9 | 0:26a9f2b8a0c7 | 96 | {0x00,0x81,0x42,0x3C,0x00}, // ASCII - 41 ) |
abarve9 | 0:26a9f2b8a0c7 | 97 | {0x28,0x30,0xE0,0x30,0x28}, // ASCII - 42 * |
abarve9 | 0:26a9f2b8a0c7 | 98 | {0x08,0x08,0x3E,0x08,0x08}, // ASCII - 43 + |
abarve9 | 0:26a9f2b8a0c7 | 99 | {0x00,0x01,0x02,0x00,0x00}, // ASCII - 44 , |
abarve9 | 0:26a9f2b8a0c7 | 100 | {0x08,0x08,0x08,0x08,0x08}, // ASCII - 45 - |
abarve9 | 0:26a9f2b8a0c7 | 101 | {0x00,0x00,0x01,0x00,0x00}, // ASCII - 46 . |
abarve9 | 0:26a9f2b8a0c7 | 102 | {0x02,0x04,0x08,0x10,0x20}, // ASCII - 47 / |
abarve9 | 0:26a9f2b8a0c7 | 103 | {0x7E,0x81,0x81,0x81,0x7E}, // ASCII - 48 0 |
abarve9 | 0:26a9f2b8a0c7 | 104 | {0x00,0x21,0xFF,0x01,0x00}, // ASCII - 49 1 |
abarve9 | 0:26a9f2b8a0c7 | 105 | {0x41,0x83,0x85,0x89,0x71}, // ASCII - 50 2 |
abarve9 | 0:26a9f2b8a0c7 | 106 | {0x42,0x91,0x91,0x91,0x6E}, // ASCII - 51 3 |
abarve9 | 0:26a9f2b8a0c7 | 107 | {0xF0,0x10,0x10,0x10,0xFF}, // ASCII - 52 4 |
abarve9 | 0:26a9f2b8a0c7 | 108 | {0xF2,0x91,0x91,0x91,0x8E}, // ASCII - 53 5 |
abarve9 | 0:26a9f2b8a0c7 | 109 | {0x3E,0x51,0x91,0x91,0x8E}, // ASCII - 54 6 |
abarve9 | 0:26a9f2b8a0c7 | 110 | {0x87,0x88,0x90,0xA0,0xC0}, // ASCII - 55 7 |
abarve9 | 0:26a9f2b8a0c7 | 111 | {0x76,0x89,0x89,0x89,0x76}, // ASCII - 56 8 |
abarve9 | 0:26a9f2b8a0c7 | 112 | {0x62,0x91,0x91,0x91,0x7e}, // ASCII - 57 9 |
abarve9 | 0:26a9f2b8a0c7 | 113 | {0x00,0x00,0x24,0x00,0x00}, // ASCII - 58 : |
abarve9 | 0:26a9f2b8a0c7 | 114 | {0x00,0x01,0x12,0x00,0x00}, // ASCII - 59 ; |
abarve9 | 0:26a9f2b8a0c7 | 115 | {0x00,0x08,0x14,0x22,0x41}, // ASCII - 60 < |
abarve9 | 0:26a9f2b8a0c7 | 116 | {0x14,0x14,0x14,0x14,0x14}, // ASCII - 61 = |
abarve9 | 0:26a9f2b8a0c7 | 117 | {0x00,0x41,0x22,0x14,0x08}, // ASCII - 62 > |
abarve9 | 0:26a9f2b8a0c7 | 118 | {0x40,0x80,0x8D,0x90,0x60}, // ASCII - 63 ? |
abarve9 | 0:26a9f2b8a0c7 | 119 | {0x7E,0x81,0xBD,0xA5,0x78}, // ASCII - 64 @ |
abarve9 | 0:26a9f2b8a0c7 | 120 | {0x3F,0x48,0x88,0x48,0x3F}, // ASCII - 65 A |
abarve9 | 0:26a9f2b8a0c7 | 121 | {0xFF,0x91,0x91,0x99,0x66}, // ASCII - 66 B |
abarve9 | 0:26a9f2b8a0c7 | 122 | {0x3C,0x42,0x81,0x81,0x42}, // ASCII - 67 C |
abarve9 | 0:26a9f2b8a0c7 | 123 | {0xFF,0x81,0x81,0x42,0x3C}, // ASCII - 68 D |
abarve9 | 0:26a9f2b8a0c7 | 124 | {0xFF,0x91,0x91,0x91,0x81}, // ASCII - 69 E |
abarve9 | 0:26a9f2b8a0c7 | 125 | {0xFF,0x90,0x90,0x90,0x80}, // ASCII - 70 F |
abarve9 | 0:26a9f2b8a0c7 | 126 | {0x3E,0x41,0x8F,0x88,0x4F}, // ASCII - 71 G |
abarve9 | 0:26a9f2b8a0c7 | 127 | {0xFF,0x10,0x10,0x10,0xFF}, // ASCII - 72 H |
abarve9 | 0:26a9f2b8a0c7 | 128 | {0x00,0x81,0xFF,0x81,0x00}, // ASCII - 73 I |
abarve9 | 0:26a9f2b8a0c7 | 129 | {0x06,0x01,0x81,0xFE,0x80}, // ASCII - 74 J |
abarve9 | 0:26a9f2b8a0c7 | 130 | {0xFF,0x18,0x24,0x42,0x81}, // ASCII - 75 K |
abarve9 | 0:26a9f2b8a0c7 | 131 | {0xFF,0x01,0x01,0x01,0x01}, // ASCII - 76 L |
abarve9 | 0:26a9f2b8a0c7 | 132 | {0xFF,0x40,0x30,0x40,0xFF}, // ASCII - 77 M |
abarve9 | 0:26a9f2b8a0c7 | 133 | {0xFF,0x40,0x20,0x10,0xFF}, // ASCII - 78 N |
abarve9 | 0:26a9f2b8a0c7 | 134 | {0x7E,0x81,0x81,0x81,0x7E}, // ASCII - 79 O |
abarve9 | 0:26a9f2b8a0c7 | 135 | {0xFF,0x90,0x90,0x90,0x60}, // ASCII - 80 P |
abarve9 | 0:26a9f2b8a0c7 | 136 | {0x7E,0x81,0x85,0x82,0x7D}, // ASCII - 81 Q |
abarve9 | 0:26a9f2b8a0c7 | 137 | {0xFF,0x98,0x94,0x92,0x61}, // ASCII - 82 R |
abarve9 | 0:26a9f2b8a0c7 | 138 | {0x72,0x89,0x89,0x89,0x46}, // ASCII - 83 S |
abarve9 | 0:26a9f2b8a0c7 | 139 | {0x80,0x80,0xFF,0x80,0x80}, // ASCII - 84 T |
abarve9 | 0:26a9f2b8a0c7 | 140 | {0xFE,0x01,0x01,0x01,0xFE}, // ASCII - 85 U |
abarve9 | 0:26a9f2b8a0c7 | 141 | {0xFC,0x02,0x01,0x02,0xFC}, // ASCII - 86 V |
abarve9 | 0:26a9f2b8a0c7 | 142 | {0xFF,0x02,0x1C,0x02,0xFF}, // ASCII - 87 W |
abarve9 | 0:26a9f2b8a0c7 | 143 | {0xC3,0x24,0x18,0x24,0xC3}, // ASCII - 88 X |
abarve9 | 0:26a9f2b8a0c7 | 144 | {0xC0,0x20,0x1F,0x20,0xC0}, // ASCII - 89 Y |
abarve9 | 0:26a9f2b8a0c7 | 145 | {0x87,0x89,0x91,0xA1,0xC1}, // ASCII - 90 Z |
abarve9 | 0:26a9f2b8a0c7 | 146 | {0x00,0xFF,0x81,0x81,0x00}, // ASCII - 91 [ |
abarve9 | 0:26a9f2b8a0c7 | 147 | {0x20,0x10,0x08,0x04,0x02}, // ASCII - 92 '\' |
abarve9 | 0:26a9f2b8a0c7 | 148 | {0x00,0x81,0x81,0xFF,0x00}, // ASCII - 93 ] |
abarve9 | 0:26a9f2b8a0c7 | 149 | {0x20,0x40,0x80,0x40,0x20}, // ASCII - 94 ^ |
abarve9 | 0:26a9f2b8a0c7 | 150 | {0x01,0x01,0x01,0x01,0x01}, // ASCII - 95 _ |
abarve9 | 0:26a9f2b8a0c7 | 151 | {0x00,0x80,0x40,0x20,0x00}, // ASCII - 96 ` |
abarve9 | 0:26a9f2b8a0c7 | 152 | {0x26,0x29,0x29,0x1F,0x01}, // ASCII - 97 a |
abarve9 | 0:26a9f2b8a0c7 | 153 | {0xFF,0x11,0x11,0x11,0x0E}, // ASCII - 98 b |
abarve9 | 0:26a9f2b8a0c7 | 154 | {0x0E,0x11,0x11,0x11,0x11}, // ASCII - 99 c |
abarve9 | 0:26a9f2b8a0c7 | 155 | {0x0E,0x11,0x11,0x11,0xFF}, // ASCII - 500 d |
abarve9 | 0:26a9f2b8a0c7 | 156 | {0x0E,0x15,0x15,0x15,0x0D}, // ASCII - 101 e |
abarve9 | 0:26a9f2b8a0c7 | 157 | {0x10,0x10,0x7F,0x90,0x90}, // ASCII - 102 f |
abarve9 | 0:26a9f2b8a0c7 | 158 | {0x08,0x15,0x15,0x15,0x0E}, // ASCII - 103 g |
abarve9 | 0:26a9f2b8a0c7 | 159 | {0xFF,0x08,0x08,0x08,0x07}, // ASCII - 104 h |
abarve9 | 0:26a9f2b8a0c7 | 160 | {0x00,0x00,0x9F,0x00,0x00}, // ASCII - 105 i |
abarve9 | 0:26a9f2b8a0c7 | 161 | {0x02,0x01,0x01,0x9F,0x00}, // ASCII - 106 j |
abarve9 | 0:26a9f2b8a0c7 | 162 | {0xFF,0x04,0x0A,0x11,0x00}, // ASCII - 107 k |
abarve9 | 0:26a9f2b8a0c7 | 163 | {0x00,0x01,0xFF,0x01,0x00}, // ASCII - 108 l |
abarve9 | 0:26a9f2b8a0c7 | 164 | {0x1F,0x10,0x0F,0x10,0x0F}, // ASCII - 109 m |
abarve9 | 0:26a9f2b8a0c7 | 165 | {0x10,0x0F,0x10,0x10,0x0F}, // ASCII - 110 n |
abarve9 | 0:26a9f2b8a0c7 | 166 | {0x0E,0x11,0x11,0x11,0x0E}, // ASCII - 111 o |
abarve9 | 0:26a9f2b8a0c7 | 167 | {0x1F,0x14,0x14,0x14,0x08}, // ASCII - 112 p |
abarve9 | 0:26a9f2b8a0c7 | 168 | {0x08,0x14,0x14,0x14,0x1F}, // ASCII - 113 q |
abarve9 | 0:26a9f2b8a0c7 | 169 | {0x1F,0x08,0x10,0x10,0x08}, // ASCII - 114 r |
abarve9 | 0:26a9f2b8a0c7 | 170 | {0x09,0x15,0x15,0x15,0x12}, // ASCII - 115 s |
abarve9 | 0:26a9f2b8a0c7 | 171 | {0x10,0x10,0x7F,0x11,0x12}, // ASCII - 116 t |
abarve9 | 0:26a9f2b8a0c7 | 172 | {0x1F,0x01,0x01,0x1F,0x01}, // ASCII - 117 u |
abarve9 | 0:26a9f2b8a0c7 | 173 | {0x1C,0x02,0x01,0x02,0x1C}, // ASCII - 118 v |
abarve9 | 0:26a9f2b8a0c7 | 174 | {0x1E,0x01,0x0F,0x01,0x1E}, // ASCII - 119 w |
abarve9 | 0:26a9f2b8a0c7 | 175 | {0x11,0x0A,0x04,0x0A,0x11}, // ASCII - 120 x |
abarve9 | 0:26a9f2b8a0c7 | 176 | {0x11,0x0A,0x04,0x08,0x10}, // ASCII - 121 y |
abarve9 | 0:26a9f2b8a0c7 | 177 | {0x11,0x13,0x15,0x19,0x11}, // ASCII - 122 z |
abarve9 | 0:26a9f2b8a0c7 | 178 | {0x18,0x66,0x81,0x81,0x00}, // ASCII - 123 { |
abarve9 | 0:26a9f2b8a0c7 | 179 | {0x00,0x00,0xFF,0x00,0x00}, // ASCII - 124 | |
abarve9 | 0:26a9f2b8a0c7 | 180 | {0x00,0x81,0x81,0x66,0x18}, // ASCII - 125 } |
abarve9 | 0:26a9f2b8a0c7 | 181 | {0x0C,0x10,0x08,0x04,0x18}, // ASCII - 126 ~ |
abarve9 | 0:26a9f2b8a0c7 | 182 | }; |
abarve9 | 0:26a9f2b8a0c7 | 183 | |
abarve9 | 0:26a9f2b8a0c7 | 184 | char currentchar = 0; |
abarve9 | 0:26a9f2b8a0c7 | 185 | int LED_MASK = 0xFFFFFFFF; |
abarve9 | 0:26a9f2b8a0c7 | 186 | |
abarve9 | 0:26a9f2b8a0c7 | 187 | |
abarve9 | 0:26a9f2b8a0c7 | 188 | //pc.printf("Starting ADXL345 test...\r\n"); |
abarve9 | 0:26a9f2b8a0c7 | 189 | // pc.printf("Device ID is: 0x%02x\r\n", accelerometer.getDevId()); |
abarve9 | 0:26a9f2b8a0c7 | 190 | wait(3); |
abarve9 | 0:26a9f2b8a0c7 | 191 | |
abarve9 | 0:26a9f2b8a0c7 | 192 | //Go into standby mode to configure the device. |
abarve9 | 0:26a9f2b8a0c7 | 193 | accelerometer.setPowerControl(0x00); |
abarve9 | 0:26a9f2b8a0c7 | 194 | |
abarve9 | 0:26a9f2b8a0c7 | 195 | //Full resolution, +/-16g, 4mg/LSB. |
abarve9 | 0:26a9f2b8a0c7 | 196 | accelerometer.setDataFormatControl(0x0B); |
abarve9 | 0:26a9f2b8a0c7 | 197 | |
abarve9 | 0:26a9f2b8a0c7 | 198 | //3.2kHz data rate. |
abarve9 | 0:26a9f2b8a0c7 | 199 | accelerometer.setDataRate(ADXL345_3200HZ); |
abarve9 | 0:26a9f2b8a0c7 | 200 | |
abarve9 | 0:26a9f2b8a0c7 | 201 | //Measurement mode. |
abarve9 | 0:26a9f2b8a0c7 | 202 | accelerometer.setPowerControl(0x08); |
abarve9 | 0:26a9f2b8a0c7 | 203 | |
abarve9 | 0:26a9f2b8a0c7 | 204 | while (1) { |
abarve9 | 0:26a9f2b8a0c7 | 205 | global=0; |
abarve9 | 0:26a9f2b8a0c7 | 206 | |
abarve9 | 0:26a9f2b8a0c7 | 207 | while(1) { |
abarve9 | 0:26a9f2b8a0c7 | 208 | // test = xbee2.readable(); |
abarve9 | 0:26a9f2b8a0c7 | 209 | |
abarve9 | 0:26a9f2b8a0c7 | 210 | if(xbee2.readable()) { |
abarve9 | 0:26a9f2b8a0c7 | 211 | character = xbee2.getc(); |
abarve9 | 0:26a9f2b8a0c7 | 212 | |
abarve9 | 0:26a9f2b8a0c7 | 213 | if(character == 13) { |
abarve9 | 0:26a9f2b8a0c7 | 214 | |
abarve9 | 0:26a9f2b8a0c7 | 215 | buffer[global] = '\0'; |
abarve9 | 0:26a9f2b8a0c7 | 216 | break; |
abarve9 | 0:26a9f2b8a0c7 | 217 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 218 | buffer[global]= character; |
abarve9 | 0:26a9f2b8a0c7 | 219 | global++; |
abarve9 | 0:26a9f2b8a0c7 | 220 | |
abarve9 | 0:26a9f2b8a0c7 | 221 | } |
abarve9 | 0:26a9f2b8a0c7 | 222 | } |
abarve9 | 0:26a9f2b8a0c7 | 223 | |
abarve9 | 0:26a9f2b8a0c7 | 224 | } |
abarve9 | 0:26a9f2b8a0c7 | 225 | |
abarve9 | 0:26a9f2b8a0c7 | 226 | pc1.printf("\n\rbuffer = %s\n\r" ,buffer); |
abarve9 | 0:26a9f2b8a0c7 | 227 | //pc1.printf(" \n\rBuffer = %s", buffer); |
abarve9 | 0:26a9f2b8a0c7 | 228 | len1 = strlen(buffer); |
abarve9 | 0:26a9f2b8a0c7 | 229 | |
abarve9 | 0:26a9f2b8a0c7 | 230 | for( int m =0; m < (len1 + 2); m++) { |
abarve9 | 0:26a9f2b8a0c7 | 231 | |
abarve9 | 0:26a9f2b8a0c7 | 232 | text[m] = 0x20; |
abarve9 | 0:26a9f2b8a0c7 | 233 | } |
abarve9 | 0:26a9f2b8a0c7 | 234 | |
abarve9 | 0:26a9f2b8a0c7 | 235 | for( int m =(len1 + 2); m <( 2*len1 + 2); m++) { |
abarve9 | 0:26a9f2b8a0c7 | 236 | |
abarve9 | 0:26a9f2b8a0c7 | 237 | text[m] = buffer[m - (len1 +2)]; |
abarve9 | 0:26a9f2b8a0c7 | 238 | } |
abarve9 | 0:26a9f2b8a0c7 | 239 | |
abarve9 | 0:26a9f2b8a0c7 | 240 | text[2*len1 + 2] = '\0'; |
abarve9 | 0:26a9f2b8a0c7 | 241 | len = strlen(text); |
abarve9 | 0:26a9f2b8a0c7 | 242 | for(int p =0; p <len; p++) { |
abarve9 | 0:26a9f2b8a0c7 | 243 | pc1.printf("%c", text[p]); |
abarve9 | 0:26a9f2b8a0c7 | 244 | } |
abarve9 | 0:26a9f2b8a0c7 | 245 | pc1.printf("\n\rstrlen(text) = %d", len); |
abarve9 | 0:26a9f2b8a0c7 | 246 | float waitvalue = 0.08 / ((6*len)); |
abarve9 | 0:26a9f2b8a0c7 | 247 | |
abarve9 | 0:26a9f2b8a0c7 | 248 | |
abarve9 | 0:26a9f2b8a0c7 | 249 | |
abarve9 | 0:26a9f2b8a0c7 | 250 | while(!(xbee2.readable())) { |
abarve9 | 0:26a9f2b8a0c7 | 251 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 252 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 253 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 254 | |
abarve9 | 0:26a9f2b8a0c7 | 255 | |
abarve9 | 0:26a9f2b8a0c7 | 256 | do { |
abarve9 | 0:26a9f2b8a0c7 | 257 | accelerometer.getOutput(readings); |
abarve9 | 0:26a9f2b8a0c7 | 258 | if(xbee2.readable()) |
abarve9 | 0:26a9f2b8a0c7 | 259 | break; |
abarve9 | 0:26a9f2b8a0c7 | 260 | } while((int16_t)readings[1] < 50); |
abarve9 | 0:26a9f2b8a0c7 | 261 | i = 0; |
abarve9 | 0:26a9f2b8a0c7 | 262 | |
abarve9 | 0:26a9f2b8a0c7 | 263 | while(text[i] != '\0') { |
abarve9 | 0:26a9f2b8a0c7 | 264 | |
abarve9 | 0:26a9f2b8a0c7 | 265 | /* |
abarve9 | 0:26a9f2b8a0c7 | 266 | led8 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 267 | led7 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 268 | led6 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 269 | led5 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 270 | led4 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 271 | led3 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 272 | led2 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 273 | led1 = 0; */ |
abarve9 | 0:26a9f2b8a0c7 | 274 | for( int m=0; m < 8; m++) { |
abarve9 | 0:26a9f2b8a0c7 | 275 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 276 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 277 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 278 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 279 | } |
abarve9 | 0:26a9f2b8a0c7 | 280 | wait(waitvalue); |
abarve9 | 0:26a9f2b8a0c7 | 281 | currentchar = text[i]; |
abarve9 | 0:26a9f2b8a0c7 | 282 | |
abarve9 | 0:26a9f2b8a0c7 | 283 | for( int m =0; m <5; m++) { |
abarve9 | 0:26a9f2b8a0c7 | 284 | char mal = font[currentchar - 0x20][m]; |
abarve9 | 0:26a9f2b8a0c7 | 285 | led8 = mal & 0x80; |
abarve9 | 0:26a9f2b8a0c7 | 286 | led7 = mal & 0x40; |
abarve9 | 0:26a9f2b8a0c7 | 287 | led6 = mal & 0x20; |
abarve9 | 0:26a9f2b8a0c7 | 288 | led5 = mal & 0x10; |
abarve9 | 0:26a9f2b8a0c7 | 289 | led4 = mal & 0x08; |
abarve9 | 0:26a9f2b8a0c7 | 290 | led3 = mal & 0x04; |
abarve9 | 0:26a9f2b8a0c7 | 291 | led2 = mal & 0x02; |
abarve9 | 0:26a9f2b8a0c7 | 292 | led1 = mal & 0x01; |
abarve9 | 0:26a9f2b8a0c7 | 293 | if(led8 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 294 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 295 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 296 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 297 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 298 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 299 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 300 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 301 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 302 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 303 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 304 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 305 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 306 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 307 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 308 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 309 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 310 | } |
abarve9 | 0:26a9f2b8a0c7 | 311 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 312 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 313 | |
abarve9 | 0:26a9f2b8a0c7 | 314 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 315 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 316 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 317 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 318 | |
abarve9 | 0:26a9f2b8a0c7 | 319 | } |
abarve9 | 0:26a9f2b8a0c7 | 320 | |
abarve9 | 0:26a9f2b8a0c7 | 321 | if(led7 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 322 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 323 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 324 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 325 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 326 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 327 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 328 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 329 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 330 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 331 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 332 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 333 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 334 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 335 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 336 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 337 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 338 | } |
abarve9 | 0:26a9f2b8a0c7 | 339 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 340 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 341 | |
abarve9 | 0:26a9f2b8a0c7 | 342 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 343 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 344 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 345 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 346 | |
abarve9 | 0:26a9f2b8a0c7 | 347 | } |
abarve9 | 0:26a9f2b8a0c7 | 348 | |
abarve9 | 0:26a9f2b8a0c7 | 349 | if(led6 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 350 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 351 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 352 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 353 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 354 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 355 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 356 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 357 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 358 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 359 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 360 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 361 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 362 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 363 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 364 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 365 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 366 | } |
abarve9 | 0:26a9f2b8a0c7 | 367 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 368 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 369 | |
abarve9 | 0:26a9f2b8a0c7 | 370 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 371 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 372 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 373 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 374 | |
abarve9 | 0:26a9f2b8a0c7 | 375 | } |
abarve9 | 0:26a9f2b8a0c7 | 376 | |
abarve9 | 0:26a9f2b8a0c7 | 377 | if(led5 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 378 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 379 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 380 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 381 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 382 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 383 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 384 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 385 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 386 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 387 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 388 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 389 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 390 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 391 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 392 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 393 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 394 | } |
abarve9 | 0:26a9f2b8a0c7 | 395 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 396 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 397 | |
abarve9 | 0:26a9f2b8a0c7 | 398 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 399 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 400 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 401 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 402 | |
abarve9 | 0:26a9f2b8a0c7 | 403 | } |
abarve9 | 0:26a9f2b8a0c7 | 404 | |
abarve9 | 0:26a9f2b8a0c7 | 405 | if(led4 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 406 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 407 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 408 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 409 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 410 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 411 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 412 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 413 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 414 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 415 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 416 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 417 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 418 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 419 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 420 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 421 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 422 | } |
abarve9 | 0:26a9f2b8a0c7 | 423 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 424 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 425 | |
abarve9 | 0:26a9f2b8a0c7 | 426 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 427 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 428 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 429 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 430 | |
abarve9 | 0:26a9f2b8a0c7 | 431 | } |
abarve9 | 0:26a9f2b8a0c7 | 432 | |
abarve9 | 0:26a9f2b8a0c7 | 433 | if(led3 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 434 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 435 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 436 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 437 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 438 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 439 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 440 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 441 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 442 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 443 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 444 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 445 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 446 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 447 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 448 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 449 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 450 | } |
abarve9 | 0:26a9f2b8a0c7 | 451 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 452 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 453 | |
abarve9 | 0:26a9f2b8a0c7 | 454 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 455 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 456 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 457 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 458 | |
abarve9 | 0:26a9f2b8a0c7 | 459 | } |
abarve9 | 0:26a9f2b8a0c7 | 460 | |
abarve9 | 0:26a9f2b8a0c7 | 461 | if(led2 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 462 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 463 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 464 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 465 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 466 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 467 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 468 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 469 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 470 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 471 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 472 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 473 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 474 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 475 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 476 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 477 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 478 | } |
abarve9 | 0:26a9f2b8a0c7 | 479 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 480 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 481 | |
abarve9 | 0:26a9f2b8a0c7 | 482 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 483 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 484 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 485 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 486 | |
abarve9 | 0:26a9f2b8a0c7 | 487 | } |
abarve9 | 0:26a9f2b8a0c7 | 488 | |
abarve9 | 0:26a9f2b8a0c7 | 489 | if(led1 == 1) { |
abarve9 | 0:26a9f2b8a0c7 | 490 | if( i == (len1+2)) { |
abarve9 | 0:26a9f2b8a0c7 | 491 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 492 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 493 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 494 | } else if ( i == (len1+3)) { |
abarve9 | 0:26a9f2b8a0c7 | 495 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 496 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 497 | blue = 200; |
abarve9 | 0:26a9f2b8a0c7 | 498 | } else if ( i == (len1 + 4)) { |
abarve9 | 0:26a9f2b8a0c7 | 499 | green = 200; |
abarve9 | 0:26a9f2b8a0c7 | 500 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 501 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 502 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 503 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 504 | red = 200; |
abarve9 | 0:26a9f2b8a0c7 | 505 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 506 | } |
abarve9 | 0:26a9f2b8a0c7 | 507 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 508 | } else { |
abarve9 | 0:26a9f2b8a0c7 | 509 | |
abarve9 | 0:26a9f2b8a0c7 | 510 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 511 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 512 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 513 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 514 | |
abarve9 | 0:26a9f2b8a0c7 | 515 | } |
abarve9 | 0:26a9f2b8a0c7 | 516 | wait(waitvalue); |
abarve9 | 0:26a9f2b8a0c7 | 517 | |
abarve9 | 0:26a9f2b8a0c7 | 518 | } |
abarve9 | 0:26a9f2b8a0c7 | 519 | /*led8 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 520 | led7 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 521 | led6 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 522 | led5 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 523 | led4 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 524 | led3 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 525 | led2 = 0; |
abarve9 | 0:26a9f2b8a0c7 | 526 | led1 = 0;*/ |
abarve9 | 0:26a9f2b8a0c7 | 527 | for( int j=0; j< 8; j++) { |
abarve9 | 0:26a9f2b8a0c7 | 528 | red = 0; |
abarve9 | 0:26a9f2b8a0c7 | 529 | green = 0; |
abarve9 | 0:26a9f2b8a0c7 | 530 | blue = 0; |
abarve9 | 0:26a9f2b8a0c7 | 531 | RGB_LED(red,green,blue); |
abarve9 | 0:26a9f2b8a0c7 | 532 | } |
abarve9 | 0:26a9f2b8a0c7 | 533 | wait(waitvalue); |
abarve9 | 0:26a9f2b8a0c7 | 534 | i++; |
abarve9 | 0:26a9f2b8a0c7 | 535 | } |
abarve9 | 0:26a9f2b8a0c7 | 536 | do { |
abarve9 | 0:26a9f2b8a0c7 | 537 | accelerometer.getOutput(readings); |
abarve9 | 0:26a9f2b8a0c7 | 538 | if(xbee2.readable()) |
abarve9 | 0:26a9f2b8a0c7 | 539 | break; |
abarve9 | 0:26a9f2b8a0c7 | 540 | } while((int16_t)readings[1] > -50); |
abarve9 | 0:26a9f2b8a0c7 | 541 | } |
abarve9 | 0:26a9f2b8a0c7 | 542 | } |
abarve9 | 0:26a9f2b8a0c7 | 543 | } |