
Programa de MIP
Dependencies: bloques ball mbed WS2812 PixelArray tsi_sensor TSI bloque MMA8451Q
main.cpp@9:777b0535d3bb, 2021-05-22 (annotated)
- Committer:
- anna_dot
- Date:
- Sat May 22 18:02:43 2021 +0000
- Revision:
- 9:777b0535d3bb
- Parent:
- 8:9e69e576d1be
- Child:
- 10:dccb2be41fbd
random ball;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
anna_dot | 0:eb102efc70ff | 1 | #include "mbed.h" |
anna_dot | 0:eb102efc70ff | 2 | #include "WS2812.h" |
anna_dot | 0:eb102efc70ff | 3 | #include "PixelArray.h" |
anna_dot | 0:eb102efc70ff | 4 | #include "TSISensor.h" |
anna_dot | 0:eb102efc70ff | 5 | #include "MMA8451Q.h" |
anna_dot | 9:777b0535d3bb | 6 | #include "ball.h" |
anna_dot | 0:eb102efc70ff | 7 | |
anna_dot | 0:eb102efc70ff | 8 | |
anna_dot | 0:eb102efc70ff | 9 | #define WS2812_BUF 256 |
anna_dot | 0:eb102efc70ff | 10 | #define NUM_COLORS 6 |
anna_dot | 0:eb102efc70ff | 11 | #define NUM_LEDS_PER_COLOR 10 |
anna_dot | 0:eb102efc70ff | 12 | #define NUM_LEDS_BARRA 4 |
anna_dot | 0:eb102efc70ff | 13 | #define ACCEL_ADRESS_I2C (0X1D<<1) |
anna_dot | 8:9e69e576d1be | 14 | #define DIMENSION_TABLERO 16 |
anna_dot | 0:eb102efc70ff | 15 | |
anna_dot | 0:eb102efc70ff | 16 | PixelArray px(WS2812_BUF); |
anna_dot | 0:eb102efc70ff | 17 | |
anna_dot | 0:eb102efc70ff | 18 | // See the program page for information on the timing numbers |
anna_dot | 0:eb102efc70ff | 19 | // The given numbers are for the K64F |
anna_dot | 0:eb102efc70ff | 20 | WS2812 ws(D9, WS2812_BUF, 0, 5, 5, 0); |
anna_dot | 4:3f515bbfd20c | 21 | MMA8451Q acc(PTE25, PTE24, ACCEL_ADRESS_I2C ); |
anna_dot | 4:3f515bbfd20c | 22 | |
anna_dot | 4:3f515bbfd20c | 23 | /////// |
anna_dot | 4:3f515bbfd20c | 24 | Serial pc(USBTX, USBRX); |
anna_dot | 4:3f515bbfd20c | 25 | ////// |
anna_dot | 0:eb102efc70ff | 26 | |
anna_dot | 0:eb102efc70ff | 27 | TSISensor tsi; |
anna_dot | 0:eb102efc70ff | 28 | int barra[NUM_LEDS_BARRA]={6,7,8,9}; |
anna_dot | 0:eb102efc70ff | 29 | float tsi_oldRead=0; |
anna_dot | 0:eb102efc70ff | 30 | int counter_tsi=0; |
anna_dot | 4:3f515bbfd20c | 31 | int posAcelerometerTemp, posAcelerometer=0, posAcelerometerOLD=0, posAcelerometerOLD1=0, contadorReboteA=0; |
aarmdlr | 7:59efb2d370b3 | 32 | int posSliderTouchTemp, posSliderTouch=0, posSliderTouchOLD=0, posSliderTouchOLD1=0, contadorRebote=0; |
anna_dot | 8:9e69e576d1be | 33 | int matrix_tablero[DIMENSION_TABLERO][DIMENSION_TABLERO]={}; |
anna_dot | 9:777b0535d3bb | 34 | ball m_ball; |
anna_dot | 0:eb102efc70ff | 35 | |
anna_dot | 0:eb102efc70ff | 36 | |
anna_dot | 9:777b0535d3bb | 37 | |
anna_dot | 0:eb102efc70ff | 38 | void update_barra(int led_apagar, int led_encender, int act_barra ); |
anna_dot | 0:eb102efc70ff | 39 | void tsi_ctr_modeBtn(float tsi_newRead); |
aarmdlr | 7:59efb2d370b3 | 40 | void tsi_ctr_modeSlider(float tsi_newRead); |
anna_dot | 4:3f515bbfd20c | 41 | void accel_ctr(); |
anna_dot | 9:777b0535d3bb | 42 | void print_pixel(uint8_t valR, uint8_t valG, uint8_t valB, int numPixelMatrix_i, int numPixelMatrix_j, int numPixelMatrixOLD_i, int numPixelMatrixOLD_j); |
anna_dot | 9:777b0535d3bb | 43 | void setPixelColor(int numPixelMatrix, int r, int g, int b); |
anna_dot | 0:eb102efc70ff | 44 | |
anna_dot | 0:eb102efc70ff | 45 | int main() |
anna_dot | 8:9e69e576d1be | 46 | { int sel_opcio=7; |
anna_dot | 4:3f515bbfd20c | 47 | pc.baud(115200); |
anna_dot | 4:3f515bbfd20c | 48 | pc.printf("\r\n\r\nHola!\r\ncompilado el " __DATE__ ", " __TIME__ "\r\n"); |
anna_dot | 4:3f515bbfd20c | 49 | |
anna_dot | 0:eb102efc70ff | 50 | ws.useII(WS2812::PER_PIXEL); // use per-pixel intensity scaling |
anna_dot | 0:eb102efc70ff | 51 | |
anna_dot | 0:eb102efc70ff | 52 | // set up the colours we want to draw with |
anna_dot | 4:3f515bbfd20c | 53 | //int colorbuf[NUM_COLORS] = {0x2f0000,0x2f2f00,0x002f00,0x002f2f,0x00002f,0x2f002f}; |
anna_dot | 0:eb102efc70ff | 54 | |
anna_dot | 0:eb102efc70ff | 55 | // for each of the colours (j) write out 10 of them |
anna_dot | 0:eb102efc70ff | 56 | // the pixels are written at the colour*10, plus the colour position |
anna_dot | 0:eb102efc70ff | 57 | // all modulus 60 so it wraps around |
anna_dot | 0:eb102efc70ff | 58 | /*for (int i = 0; i < WS2812_BUF; i++) { |
anna_dot | 0:eb102efc70ff | 59 | px.Set(i, colorbuf[(i / NUM_LEDS_PER_COLOR) % NUM_COLORS]); |
anna_dot | 0:eb102efc70ff | 60 | }*/ |
anna_dot | 0:eb102efc70ff | 61 | for(int i=0; i<NUM_LEDS_BARRA; i++){ |
anna_dot | 0:eb102efc70ff | 62 | px.Set(barra[i], 0x2f0000); |
anna_dot | 0:eb102efc70ff | 63 | } |
anna_dot | 9:777b0535d3bb | 64 | |
anna_dot | 0:eb102efc70ff | 65 | for(int i=0; i<NUM_LEDS_BARRA; i++){ |
anna_dot | 8:9e69e576d1be | 66 | px.SetI(barra[i]%WS2812_BUF, 255); //0xff |
anna_dot | 8:9e69e576d1be | 67 | } |
anna_dot | 9:777b0535d3bb | 68 | |
anna_dot | 8:9e69e576d1be | 69 | |
anna_dot | 9:777b0535d3bb | 70 | /*for(int i=0; i<NUM_LEDS_BARRA; i++){ |
anna_dot | 8:9e69e576d1be | 71 | matrix_tablero[0][barra[i]]=1; |
anna_dot | 9:777b0535d3bb | 72 | }*/ |
anna_dot | 0:eb102efc70ff | 73 | |
anna_dot | 9:777b0535d3bb | 74 | print_pixel(255, 255, 255, m_ball.getCoordX(), m_ball.getCoordY(),-1,-1); |
anna_dot | 9:777b0535d3bb | 75 | |
anna_dot | 9:777b0535d3bb | 76 | |
anna_dot | 0:eb102efc70ff | 77 | // Now the buffer is written, rotate it |
anna_dot | 0:eb102efc70ff | 78 | // by writing it out with an increasing offset |
anna_dot | 0:eb102efc70ff | 79 | ws.write(px.getBuf()); |
anna_dot | 0:eb102efc70ff | 80 | while (1) { |
anna_dot | 0:eb102efc70ff | 81 | /*for (int z=WS2812_BUF; z >= 0 ; z--) { |
anna_dot | 0:eb102efc70ff | 82 | ws.write_offsets(px.getBuf(),z,z,z); |
anna_dot | 0:eb102efc70ff | 83 | wait(0.075); |
anna_dot | 0:eb102efc70ff | 84 | }*/ |
anna_dot | 6:0004357c1faa | 85 | if(sel_opcio==0){ |
anna_dot | 6:0004357c1faa | 86 | tsi_ctr_modeBtn(tsi.readPercentage()); |
anna_dot | 6:0004357c1faa | 87 | } |
anna_dot | 6:0004357c1faa | 88 | else{ |
anna_dot | 6:0004357c1faa | 89 | if(sel_opcio==1){ |
aarmdlr | 7:59efb2d370b3 | 90 | tsi_ctr_modeSlider(tsi.readPercentage()); |
anna_dot | 6:0004357c1faa | 91 | } |
anna_dot | 6:0004357c1faa | 92 | else if(sel_opcio==2){ |
anna_dot | 6:0004357c1faa | 93 | accel_ctr(); |
anna_dot | 6:0004357c1faa | 94 | } |
anna_dot | 6:0004357c1faa | 95 | } |
anna_dot | 0:eb102efc70ff | 96 | |
anna_dot | 9:777b0535d3bb | 97 | pc.printf("\r\n Touch %d", (rand()%(9-6 + 1) + 6)); |
anna_dot | 9:777b0535d3bb | 98 | |
anna_dot | 0:eb102efc70ff | 99 | } |
anna_dot | 0:eb102efc70ff | 100 | |
anna_dot | 0:eb102efc70ff | 101 | } |
anna_dot | 0:eb102efc70ff | 102 | |
anna_dot | 0:eb102efc70ff | 103 | void tsi_ctr_modeBtn(float tsi_newRead){ |
anna_dot | 0:eb102efc70ff | 104 | |
anna_dot | 0:eb102efc70ff | 105 | if(tsi_newRead!=0.0){ |
anna_dot | 0:eb102efc70ff | 106 | if(tsi_newRead>0.6 and tsi_oldRead>0.6){ |
anna_dot | 0:eb102efc70ff | 107 | counter_tsi++; |
anna_dot | 0:eb102efc70ff | 108 | } |
anna_dot | 0:eb102efc70ff | 109 | else { |
anna_dot | 0:eb102efc70ff | 110 | if(tsi_newRead<0.4 and tsi_oldRead<0.4){ |
anna_dot | 0:eb102efc70ff | 111 | counter_tsi++; |
anna_dot | 0:eb102efc70ff | 112 | } |
anna_dot | 0:eb102efc70ff | 113 | else{ |
anna_dot | 0:eb102efc70ff | 114 | counter_tsi=0; |
anna_dot | 0:eb102efc70ff | 115 | } |
anna_dot | 0:eb102efc70ff | 116 | } |
anna_dot | 0:eb102efc70ff | 117 | tsi_oldRead=tsi_newRead; |
anna_dot | 0:eb102efc70ff | 118 | |
anna_dot | 0:eb102efc70ff | 119 | |
anna_dot | 0:eb102efc70ff | 120 | if(counter_tsi == 250){ |
anna_dot | 0:eb102efc70ff | 121 | if( (tsi_newRead < 0.4) && tsi_newRead!=0 ){ //if left |
anna_dot | 0:eb102efc70ff | 122 | if(barra[0]>0){ |
anna_dot | 0:eb102efc70ff | 123 | update_barra((NUM_LEDS_BARRA-1),0, -1 ); |
anna_dot | 0:eb102efc70ff | 124 | } |
anna_dot | 0:eb102efc70ff | 125 | } |
anna_dot | 0:eb102efc70ff | 126 | else{ |
anna_dot | 0:eb102efc70ff | 127 | if(tsi_newRead > 0.6){ //if right |
anna_dot | 0:eb102efc70ff | 128 | if(barra[NUM_LEDS_BARRA-1]<15){ |
anna_dot | 0:eb102efc70ff | 129 | update_barra(0,(NUM_LEDS_BARRA-1), 1 ); |
anna_dot | 0:eb102efc70ff | 130 | } |
anna_dot | 0:eb102efc70ff | 131 | } |
anna_dot | 0:eb102efc70ff | 132 | } |
anna_dot | 0:eb102efc70ff | 133 | //control_tsi(tsi_newRead); |
anna_dot | 0:eb102efc70ff | 134 | ws.write(px.getBuf()); |
anna_dot | 0:eb102efc70ff | 135 | counter_tsi=0; |
anna_dot | 0:eb102efc70ff | 136 | } |
anna_dot | 0:eb102efc70ff | 137 | } |
anna_dot | 0:eb102efc70ff | 138 | else{ |
anna_dot | 0:eb102efc70ff | 139 | counter_tsi=0; |
anna_dot | 0:eb102efc70ff | 140 | } |
anna_dot | 0:eb102efc70ff | 141 | |
anna_dot | 0:eb102efc70ff | 142 | |
anna_dot | 0:eb102efc70ff | 143 | //tsi_oldRead=tsi_newRead; |
anna_dot | 0:eb102efc70ff | 144 | } |
anna_dot | 0:eb102efc70ff | 145 | |
aarmdlr | 7:59efb2d370b3 | 146 | void tsi_ctr_modeSlider(float tsi_newRead){ |
aarmdlr | 7:59efb2d370b3 | 147 | //Multiplicamos lo que lee el tsi.readPercentage() por 100 para tener un porcentaje del 0 al 100% en lugar del 0 al 1 que devuelve dicha función tsi.readPercentage(). |
aarmdlr | 7:59efb2d370b3 | 148 | //Lo multiplicamos por 1.4 para obtener un ranto de entre 0 y 140. |
aarmdlr | 7:59efb2d370b3 | 149 | //Le restamos 70 para que el 50% leido por el tsi represente el 0, de esta forma ahora el rango es de -70 a +70. |
aarmdlr | 7:59efb2d370b3 | 150 | //Dividimos entre 10 para obtener unos valores entre -7 y +7 que son las posiciones que puede tomar la barra inferior si se trata de una barra de 4 pixeles como es el caso. |
aarmdlr | 7:59efb2d370b3 | 151 | posSliderTouchTemp=(((tsi_newRead*100)*1.4)-70)/10; |
aarmdlr | 7:59efb2d370b3 | 152 | |
aarmdlr | 7:59efb2d370b3 | 153 | //Controlamos que no se salga de las posiciones posibles de la barra inferior. |
aarmdlr | 7:59efb2d370b3 | 154 | if(posSliderTouchTemp>-7 and posSliderTouchTemp<7){ |
aarmdlr | 7:59efb2d370b3 | 155 | //pc.printf("\r\n Porcentaje=%d",posSliderTouchTemp); |
aarmdlr | 7:59efb2d370b3 | 156 | |
aarmdlr | 7:59efb2d370b3 | 157 | //Se controla los rebotes del TSI ya que sino da saltos, por eso se incrementa un contador cuando detecta una misma posicion mas de una vez seguida. |
aarmdlr | 7:59efb2d370b3 | 158 | if(posSliderTouchTemp==posSliderTouchOLD1){ |
aarmdlr | 7:59efb2d370b3 | 159 | contadorRebote=contadorRebote+1; |
aarmdlr | 7:59efb2d370b3 | 160 | }else{ |
aarmdlr | 7:59efb2d370b3 | 161 | contadorRebote=0; |
aarmdlr | 7:59efb2d370b3 | 162 | } |
aarmdlr | 7:59efb2d370b3 | 163 | posSliderTouchOLD1=posSliderTouchTemp; |
aarmdlr | 7:59efb2d370b3 | 164 | |
aarmdlr | 7:59efb2d370b3 | 165 | |
anna_dot | 8:9e69e576d1be | 166 | if(contadorRebote>=70){ |
aarmdlr | 7:59efb2d370b3 | 167 | posSliderTouch=posSliderTouchTemp; |
aarmdlr | 7:59efb2d370b3 | 168 | } |
aarmdlr | 7:59efb2d370b3 | 169 | |
aarmdlr | 7:59efb2d370b3 | 170 | |
aarmdlr | 7:59efb2d370b3 | 171 | } |
aarmdlr | 7:59efb2d370b3 | 172 | |
aarmdlr | 7:59efb2d370b3 | 173 | if(posSliderTouch!=posSliderTouchOLD){ |
aarmdlr | 7:59efb2d370b3 | 174 | //Se suaviza el movimiento de la barra inferior para que de un efecto de scroll mas bonito y no tan brusco, |
aarmdlr | 7:59efb2d370b3 | 175 | //por eso se realiza un for para que pase por todas las posiciones hasta la posicoon de la barra objetivo. |
aarmdlr | 7:59efb2d370b3 | 176 | if(posSliderTouch>posSliderTouchOLD){ |
aarmdlr | 7:59efb2d370b3 | 177 | for(int p=posSliderTouchOLD; p<posSliderTouch; p++){ |
aarmdlr | 7:59efb2d370b3 | 178 | update_barra(0,(NUM_LEDS_BARRA-1), 1 ); //if rigth |
aarmdlr | 7:59efb2d370b3 | 179 | ws.write(px.getBuf()); |
aarmdlr | 7:59efb2d370b3 | 180 | //printBar( 249, 0, 0, p); |
aarmdlr | 7:59efb2d370b3 | 181 | } |
aarmdlr | 7:59efb2d370b3 | 182 | }else if(posSliderTouch<posSliderTouchOLD){ |
aarmdlr | 7:59efb2d370b3 | 183 | for(int p=posSliderTouchOLD; p>posSliderTouch; p--){ |
aarmdlr | 7:59efb2d370b3 | 184 | update_barra((NUM_LEDS_BARRA-1), 0, -1 ); //if left |
aarmdlr | 7:59efb2d370b3 | 185 | ws.write(px.getBuf()); |
aarmdlr | 7:59efb2d370b3 | 186 | //printBar( 249, 0, 0, p); |
aarmdlr | 7:59efb2d370b3 | 187 | } |
aarmdlr | 7:59efb2d370b3 | 188 | } |
aarmdlr | 7:59efb2d370b3 | 189 | posSliderTouchOLD=posSliderTouch; |
aarmdlr | 7:59efb2d370b3 | 190 | //pc.printf("\r\n Touch"); |
aarmdlr | 7:59efb2d370b3 | 191 | |
aarmdlr | 7:59efb2d370b3 | 192 | } |
aarmdlr | 7:59efb2d370b3 | 193 | |
aarmdlr | 7:59efb2d370b3 | 194 | } |
aarmdlr | 7:59efb2d370b3 | 195 | |
anna_dot | 9:777b0535d3bb | 196 | |
anna_dot | 0:eb102efc70ff | 197 | void update_barra(int led_apagar, int led_encender, int act_barra ){ |
anna_dot | 4:3f515bbfd20c | 198 | px.Set(barra[led_apagar], 0x0); //apagamos el led |
anna_dot | 0:eb102efc70ff | 199 | |
anna_dot | 0:eb102efc70ff | 200 | for(int i=0; i<NUM_LEDS_BARRA; i++){ //actualizamos valor del array |
anna_dot | 0:eb102efc70ff | 201 | barra[i]=barra[i]+act_barra; |
anna_dot | 4:3f515bbfd20c | 202 | pc.printf("\r\n UPDATEEE ------- =%d", barra[i]); |
anna_dot | 0:eb102efc70ff | 203 | } |
anna_dot | 0:eb102efc70ff | 204 | |
anna_dot | 4:3f515bbfd20c | 205 | px.Set(barra[led_encender], 0x2f0000); //encendemos el siguiente led |
anna_dot | 8:9e69e576d1be | 206 | px.SetI(barra[led_encender]%WS2812_BUF, 255); //0xff |
anna_dot | 0:eb102efc70ff | 207 | } |
anna_dot | 0:eb102efc70ff | 208 | |
anna_dot | 4:3f515bbfd20c | 209 | |
anna_dot | 4:3f515bbfd20c | 210 | void accel_ctr(){ |
anna_dot | 4:3f515bbfd20c | 211 | float nearest = floor(abs(((acc.getAccY()+1)*100)/2)); //para obtener un valor 0 y 100 |
anna_dot | 4:3f515bbfd20c | 212 | posAcelerometerTemp=(((nearest)*2.8)-140)/10; |
anna_dot | 4:3f515bbfd20c | 213 | //pc.printf("\r\n Porcentaje=%d",posAcelerometerTemp); |
anna_dot | 4:3f515bbfd20c | 214 | if(posAcelerometerTemp<=-7){ |
anna_dot | 4:3f515bbfd20c | 215 | posAcelerometerTemp=-6; |
anna_dot | 4:3f515bbfd20c | 216 | }else if(posAcelerometerTemp>=7){ |
anna_dot | 4:3f515bbfd20c | 217 | posAcelerometerTemp=6; |
anna_dot | 4:3f515bbfd20c | 218 | } |
anna_dot | 4:3f515bbfd20c | 219 | if(posAcelerometerTemp>-7 and posAcelerometerTemp<7){ |
anna_dot | 6:0004357c1faa | 220 | //pc.printf("\r\n Porcentaje=%d",posAcelerometerTemp); |
anna_dot | 4:3f515bbfd20c | 221 | //pc.printf("\r\n Ha entrat"); |
anna_dot | 4:3f515bbfd20c | 222 | if(posAcelerometerTemp==posAcelerometerOLD1){ |
anna_dot | 4:3f515bbfd20c | 223 | contadorReboteA=contadorReboteA+1; |
anna_dot | 4:3f515bbfd20c | 224 | }else{ |
anna_dot | 4:3f515bbfd20c | 225 | contadorReboteA=0; |
anna_dot | 4:3f515bbfd20c | 226 | } |
anna_dot | 4:3f515bbfd20c | 227 | posAcelerometerOLD1=posAcelerometerTemp; |
anna_dot | 6:0004357c1faa | 228 | if(contadorReboteA>=10){ |
anna_dot | 4:3f515bbfd20c | 229 | posAcelerometer=posAcelerometerTemp; |
anna_dot | 4:3f515bbfd20c | 230 | } |
anna_dot | 4:3f515bbfd20c | 231 | |
anna_dot | 4:3f515bbfd20c | 232 | } |
anna_dot | 4:3f515bbfd20c | 233 | if(posAcelerometer!=posAcelerometerOLD){ |
anna_dot | 4:3f515bbfd20c | 234 | if(posAcelerometer>posAcelerometerOLD){ |
anna_dot | 6:0004357c1faa | 235 | for(int p=posAcelerometerOLD; p<posAcelerometer; p++){ //movemos la barrita hasta la posición actual, mostrando la animación |
anna_dot | 6:0004357c1faa | 236 | update_barra(0,(NUM_LEDS_BARRA-1), 1 ); //if rigth |
anna_dot | 6:0004357c1faa | 237 | ws.write(px.getBuf()); |
anna_dot | 4:3f515bbfd20c | 238 | //pc.printf("\r\n HOLAAAA DRETA=%d",p); |
anna_dot | 4:3f515bbfd20c | 239 | |
anna_dot | 6:0004357c1faa | 240 | } |
anna_dot | 4:3f515bbfd20c | 241 | }else if(posAcelerometer<posAcelerometerOLD){ |
anna_dot | 6:0004357c1faa | 242 | //pc.printf("\r\n HOLAAAA ESQUERRA"); |
anna_dot | 6:0004357c1faa | 243 | for(int p=posAcelerometerOLD; p>posAcelerometer; p--){ |
anna_dot | 6:0004357c1faa | 244 | update_barra((NUM_LEDS_BARRA-1), 0, -1 ); //if left |
anna_dot | 6:0004357c1faa | 245 | ws.write(px.getBuf()); |
anna_dot | 6:0004357c1faa | 246 | //pc.printf("\r\n HOLAAAA ESQUERRA=%d",p); |
anna_dot | 4:3f515bbfd20c | 247 | |
anna_dot | 6:0004357c1faa | 248 | } |
anna_dot | 4:3f515bbfd20c | 249 | |
anna_dot | 4:3f515bbfd20c | 250 | } |
anna_dot | 4:3f515bbfd20c | 251 | |
anna_dot | 4:3f515bbfd20c | 252 | posAcelerometerOLD=posAcelerometer; |
anna_dot | 4:3f515bbfd20c | 253 | |
anna_dot | 4:3f515bbfd20c | 254 | //pc.printf("\r\n Acelerometer"); |
anna_dot | 4:3f515bbfd20c | 255 | } |
anna_dot | 0:eb102efc70ff | 256 | } |
anna_dot | 0:eb102efc70ff | 257 | |
anna_dot | 9:777b0535d3bb | 258 | void print_pixel(uint8_t valR, uint8_t valG, uint8_t valB, int numPixelMatrix_i, int numPixelMatrix_j, int numPixelMatrixOLD_i, int numPixelMatrixOLD_j) { |
anna_dot | 9:777b0535d3bb | 259 | |
anna_dot | 9:777b0535d3bb | 260 | //printf ("\r\nRGB=> %ld, %ld, %ld \r\n", valR, valG, valB); |
anna_dot | 9:777b0535d3bb | 261 | int numPixelMatrix; |
anna_dot | 9:777b0535d3bb | 262 | if(numPixelMatrix_i%2==0){ |
anna_dot | 9:777b0535d3bb | 263 | numPixelMatrix=((numPixelMatrix_i*16)+15)-numPixelMatrix_j; |
anna_dot | 9:777b0535d3bb | 264 | }else{ |
anna_dot | 9:777b0535d3bb | 265 | numPixelMatrix=(numPixelMatrix_i*16)+numPixelMatrix_j; |
anna_dot | 9:777b0535d3bb | 266 | } |
anna_dot | 9:777b0535d3bb | 267 | |
anna_dot | 9:777b0535d3bb | 268 | if(numPixelMatrixOLD_i!=-1 and numPixelMatrixOLD_j!=-1){ |
anna_dot | 9:777b0535d3bb | 269 | |
anna_dot | 9:777b0535d3bb | 270 | int numPixelMatrixOLD; |
anna_dot | 9:777b0535d3bb | 271 | if(numPixelMatrixOLD_i%2==0){ |
anna_dot | 9:777b0535d3bb | 272 | numPixelMatrixOLD=((numPixelMatrixOLD_i*16)+15)-numPixelMatrixOLD_j; |
anna_dot | 9:777b0535d3bb | 273 | }else{ |
anna_dot | 9:777b0535d3bb | 274 | numPixelMatrixOLD=(numPixelMatrixOLD_i*16)+numPixelMatrixOLD_j; |
anna_dot | 9:777b0535d3bb | 275 | } |
anna_dot | 9:777b0535d3bb | 276 | |
anna_dot | 9:777b0535d3bb | 277 | setPixelColor(numPixelMatrixOLD, 0, 0, 0); |
anna_dot | 9:777b0535d3bb | 278 | |
anna_dot | 9:777b0535d3bb | 279 | } |
anna_dot | 9:777b0535d3bb | 280 | |
anna_dot | 9:777b0535d3bb | 281 | |
anna_dot | 9:777b0535d3bb | 282 | setPixelColor(numPixelMatrix, valR, valG, valB); |
anna_dot | 9:777b0535d3bb | 283 | ws.write(px.getBuf()); |
anna_dot | 9:777b0535d3bb | 284 | |
anna_dot | 9:777b0535d3bb | 285 | } |
anna_dot | 0:eb102efc70ff | 286 | |
anna_dot | 9:777b0535d3bb | 287 | void setPixelColor(int numPixelMatrix, int r, int g, int b){ |
anna_dot | 9:777b0535d3bb | 288 | px.SetI(numPixelMatrix,255); |
anna_dot | 9:777b0535d3bb | 289 | px.SetR(numPixelMatrix,r); |
anna_dot | 9:777b0535d3bb | 290 | px.SetG(numPixelMatrix,g); |
anna_dot | 9:777b0535d3bb | 291 | px.SetB(numPixelMatrix,b); |
anna_dot | 9:777b0535d3bb | 292 | } |
anna_dot | 9:777b0535d3bb | 293 | |
anna_dot | 9:777b0535d3bb | 294 | |
anna_dot | 9:777b0535d3bb | 295 |