Alexis Lacasse / Mbed 2 deprecated Lab1_Alexis_Lacasse

Lab11_Alexis_Lacasse

Dependencies:   VL6180x mbed

main.cpp@0:722f18d46c1e, 2017-09-11 (annotated)

Committer:
1536082
Date:
Mon Sep 11 12:22:56 2017 +0000
Revision:
0:722f18d46c1e
lab de ive ki fai marcer 1 nezcran taktil pi 1 tim of lite

Who changed what in which revision?

UserRevisionLine numberNew contents of line
1536082 0:722f18d46c1e 1 #include "mbed.h"
1536082 0:722f18d46c1e 2 #include "VL6180x.h"
1536082 0:722f18d46c1e 3 #define TFTWIDTH 240
1536082 0:722f18d46c1e 4 #define TFTHEIGHT 320
1536082 0:722f18d46c1e 5 #define TFT_NORTH {SPFD5408_MADCTL_MY | SPFD5408_MADCTL_BGR}
1536082 0:722f18d46c1e 6 #define TFT_EAST {SPFD5408_MADCTL_MX | SPFD5408_MADCTL_MY | SPFD5408_MADCTL_MV | SPFD5408_MADCTL_BGR}
1536082 0:722f18d46c1e 7 #define TFT_SOUTH {SPFD5408_MADCTL_MX | SPFD5408_MADCTL_BGR}
1536082 0:722f18d46c1e 8 #define TFT_WEST {SPFD5408_MADCTL_MV | SPFD5408_MADCTL_BGR}
1536082 0:722f18d46c1e 9 #define BLACK 0x0000
1536082 0:722f18d46c1e 10 #define BLUE 0x001F
1536082 0:722f18d46c1e 11 #define RED 0xF800
1536082 0:722f18d46c1e 12 #define GREEN 0x07E0
1536082 0:722f18d46c1e 13 #define CYAN 0x07FF
1536082 0:722f18d46c1e 14 #define MAGENTA 0xF81F
1536082 0:722f18d46c1e 15 #define YELLOW 0xFFE0
1536082 0:722f18d46c1e 16 #define WHITE 0xFFFF
1536082 0:722f18d46c1e 17 #define SPFD5408_SOFTRESET 0x01
1536082 0:722f18d46c1e 18 #define SPFD5408_SLEEPIN 0x10
1536082 0:722f18d46c1e 19 #define SPFD5408_SLEEPOUT 0x11
1536082 0:722f18d46c1e 20 #define SPFD5408_NORMALDISP 0x13
1536082 0:722f18d46c1e 21 #define SPFD5408_INVERTOFF 0x20
1536082 0:722f18d46c1e 22 #define SPFD5408_INVERTON 0x21
1536082 0:722f18d46c1e 23 #define SPFD5408_GAMMASET 0x26
1536082 0:722f18d46c1e 24 #define SPFD5408_DISPLAYOFF 0x28
1536082 0:722f18d46c1e 25 #define SPFD5408_DISPLAYON 0x29
1536082 0:722f18d46c1e 26 #define SPFD5408_COLADDRSET 0x2A
1536082 0:722f18d46c1e 27 #define SPFD5408_PAGEADDRSET 0x2B
1536082 0:722f18d46c1e 28 #define SPFD5408_MEMORYWRITE 0x2C
1536082 0:722f18d46c1e 29 #define SPFD5408_PIXELFORMAT 0x3A
1536082 0:722f18d46c1e 30 #define SPFD5408_FRAMECONTROL 0xB1
1536082 0:722f18d46c1e 31 #define SPFD5408_DISPLAYFUNC 0xB6
1536082 0:722f18d46c1e 32 #define SPFD5408_ENTRYMODE 0xB7
1536082 0:722f18d46c1e 33 #define SPFD5408_POWERCONTROL1 0xC0
1536082 0:722f18d46c1e 34 #define SPFD5408_POWERCONTROL2 0xC1
1536082 0:722f18d46c1e 35 #define SPFD5408_VCOMCONTROL1 0xC5
1536082 0:722f18d46c1e 36 #define SPFD5408_VCOMCONTROL2 0xC7
1536082 0:722f18d46c1e 37 #define SPFD5408_MEMCONTROL 0x36
1536082 0:722f18d46c1e 38 #define SPFD5408_MADCTL 0x36
1536082 0:722f18d46c1e 39 #define SPFD5408_MADCTL_MY 0x80
1536082 0:722f18d46c1e 40 #define SPFD5408_MADCTL_MX 0x40
1536082 0:722f18d46c1e 41 #define SPFD5408_MADCTL_MV 0x20
1536082 0:722f18d46c1e 42 #define SPFD5408_MADCTL_ML 0x10
1536082 0:722f18d46c1e 43 #define SPFD5408_MADCTL_RGB 0x00
1536082 0:722f18d46c1e 44 #define SPFD5408_MADCTL_BGR 0x08
1536082 0:722f18d46c1e 45 #define SPFD5408_MADCTL_MH 0x04
1536082 0:722f18d46c1e 46 #define IDLE 1
1536082 0:722f18d46c1e 47 #define ACTIVE 0
1536082 0:722f18d46c1e 48 #define COMMAND 0
1536082 0:722f18d46c1e 49 #define DATA 1
1536082 0:722f18d46c1e 50 #define TEMPS 40
1536082 0:722f18d46c1e 51 #define YP A3
1536082 0:722f18d46c1e 52 #define XM A2
1536082 0:722f18d46c1e 53 #define YM D9
1536082 0:722f18d46c1e 54 #define XP D8
1536082 0:722f18d46c1e 55 #define LCD_CS A3
1536082 0:722f18d46c1e 56 #define LCD_CD A2
1536082 0:722f18d46c1e 57 #define LCD_WR A1
1536082 0:722f18d46c1e 58 #define LCD_RD A0
1536082 0:722f18d46c1e 59 #define LCD_RESET A4
1536082 0:722f18d46c1e 60 void restoreXY(void);
1536082 0:722f18d46c1e 61 uint16_t detectTouch(void);
1536082 0:722f18d46c1e 62 DigitalOut pinRD(A0); //PA_0;
1536082 0:722f18d46c1e 63 DigitalOut pinWR(A1); //PA_1;
1536082 0:722f18d46c1e 64 DigitalOut pinCD(A2); //PA_4;
1536082 0:722f18d46c1e 65 DigitalOut pinCS(A3); //PB_0;
1536082 0:722f18d46c1e 66 DigitalOut pinReset(A4);//PC_1;
1536082 0:722f18d46c1e 67 BusInOut portTFT(D8, D9, D2, D3, D4, D5, D6, D7);
1536082 0:722f18d46c1e 68 void WriteCommand(uint8_t c)
1536082 0:722f18d46c1e 69 {
1536082 0:722f18d46c1e 70 pinCD = COMMAND;
1536082 0:722f18d46c1e 71 pinWR = ACTIVE;
1536082 0:722f18d46c1e 72 portTFT = c;
1536082 0:722f18d46c1e 73 pinWR = IDLE;
1536082 0:722f18d46c1e 74 }
1536082 0:722f18d46c1e 75 void WriteData(uint8_t d)
1536082 0:722f18d46c1e 76 {
1536082 0:722f18d46c1e 77 pinCD = DATA;
1536082 0:722f18d46c1e 78 pinWR = ACTIVE;
1536082 0:722f18d46c1e 79 portTFT = d;
1536082 0:722f18d46c1e 80 pinWR = IDLE;
1536082 0:722f18d46c1e 81 }
1536082 0:722f18d46c1e 82 Serial pc(SERIAL_TX, SERIAL_RX);
1536082 0:722f18d46c1e 83 DigitalOut myled(LED1);
1536082 0:722f18d46c1e 84
1536082 0:722f18d46c1e 85 void begin(void) {
1536082 0:722f18d46c1e 86 pinCS = IDLE;
1536082 0:722f18d46c1e 87 pinCD = DATA;
1536082 0:722f18d46c1e 88 pinWR = IDLE;
1536082 0:722f18d46c1e 89 pinRD = IDLE;
1536082 0:722f18d46c1e 90 portTFT.output();
1536082 0:722f18d46c1e 91 pinReset = ACTIVE;
1536082 0:722f18d46c1e 92 pinReset = IDLE;
1536082 0:722f18d46c1e 93 pinCS = ACTIVE;
1536082 0:722f18d46c1e 94
1536082 0:722f18d46c1e 95 WriteCommand(SPFD5408_SOFTRESET);
1536082 0:722f18d46c1e 96 WriteData(0);
1536082 0:722f18d46c1e 97 wait_ms(50);
1536082 0:722f18d46c1e 98
1536082 0:722f18d46c1e 99 WriteCommand(SPFD5408_MEMCONTROL);
1536082 0:722f18d46c1e 100 WriteData(SPFD5408_MADCTL_MY | SPFD5408_MADCTL_BGR);
1536082 0:722f18d46c1e 101
1536082 0:722f18d46c1e 102 WriteCommand(SPFD5408_PIXELFORMAT);
1536082 0:722f18d46c1e 103 WriteData(0x55);
1536082 0:722f18d46c1e 104
1536082 0:722f18d46c1e 105 WriteCommand(SPFD5408_FRAMECONTROL);
1536082 0:722f18d46c1e 106 WriteData(0x00);
1536082 0:722f18d46c1e 107 WriteData(0x1B);
1536082 0:722f18d46c1e 108
1536082 0:722f18d46c1e 109 WriteCommand(SPFD5408_SLEEPOUT);
1536082 0:722f18d46c1e 110 WriteData(0);
1536082 0:722f18d46c1e 111
1536082 0:722f18d46c1e 112 WriteCommand(SPFD5408_DISPLAYON);
1536082 0:722f18d46c1e 113 WriteData(0);
1536082 0:722f18d46c1e 114 }
1536082 0:722f18d46c1e 115 void setAddrWindow(int x1, int y1, int x2, int y2) {
1536082 0:722f18d46c1e 116 pinCS = ACTIVE;
1536082 0:722f18d46c1e 117 wait_us(TEMPS);
1536082 0:722f18d46c1e 118 WriteCommand(SPFD5408_COLADDRSET);
1536082 0:722f18d46c1e 119 WriteData(x1 >> 8);
1536082 0:722f18d46c1e 120 WriteData(x1);
1536082 0:722f18d46c1e 121 WriteData(x2 >> 8);
1536082 0:722f18d46c1e 122 WriteData(x2);
1536082 0:722f18d46c1e 123 wait_us(TEMPS);
1536082 0:722f18d46c1e 124 pinCS = IDLE;
1536082 0:722f18d46c1e 125 pinCS = ACTIVE;
1536082 0:722f18d46c1e 126 wait_us(TEMPS);
1536082 0:722f18d46c1e 127 WriteCommand(SPFD5408_PAGEADDRSET);
1536082 0:722f18d46c1e 128 WriteData(y1 >> 8);
1536082 0:722f18d46c1e 129 WriteData(y1);
1536082 0:722f18d46c1e 130 WriteData(y2 >> 8);
1536082 0:722f18d46c1e 131 WriteData(y2);
1536082 0:722f18d46c1e 132 wait_us(TEMPS);
1536082 0:722f18d46c1e 133 pinCS = IDLE;
1536082 0:722f18d46c1e 134 }
1536082 0:722f18d46c1e 135 void fillRect(uint16_t x1, uint16_t y1, uint16_t w, uint16_t h, uint16_t fillcolor) {
1536082 0:722f18d46c1e 136 uint8_t hi, lo;
1536082 0:722f18d46c1e 137 uint16_t x2, y2;
1536082 0:722f18d46c1e 138 uint16_t i, j;
1536082 0:722f18d46c1e 139 x2 = x1 + w - 1;
1536082 0:722f18d46c1e 140 y2 = y1 + h - 1;
1536082 0:722f18d46c1e 141 setAddrWindow(x1, y1, x2, y2);
1536082 0:722f18d46c1e 142 hi = fillcolor >> 8;
1536082 0:722f18d46c1e 143 lo = fillcolor;
1536082 0:722f18d46c1e 144 pinCS = ACTIVE;
1536082 0:722f18d46c1e 145 WriteCommand(SPFD5408_MEMORYWRITE);
1536082 0:722f18d46c1e 146 pinCD = DATA;
1536082 0:722f18d46c1e 147 for (i = h; i > 0; i--)
1536082 0:722f18d46c1e 148 {
1536082 0:722f18d46c1e 149 for (j = w; j > 0; j--)
1536082 0:722f18d46c1e 150 {
1536082 0:722f18d46c1e 151 pinWR = ACTIVE;
1536082 0:722f18d46c1e 152 portTFT = hi;
1536082 0:722f18d46c1e 153 pinWR = IDLE;
1536082 0:722f18d46c1e 154 pinWR = ACTIVE;
1536082 0:722f18d46c1e 155 portTFT = lo;
1536082 0:722f18d46c1e 156 pinWR = IDLE;
1536082 0:722f18d46c1e 157 }
1536082 0:722f18d46c1e 158 }
1536082 0:722f18d46c1e 159 pinCS = IDLE;
1536082 0:722f18d46c1e 160 }
1536082 0:722f18d46c1e 161 unsigned int min(unsigned int val1, unsigned int val2)
1536082 0:722f18d46c1e 162 {
1536082 0:722f18d46c1e 163 unsigned int val = val1;
1536082 0:722f18d46c1e 164 if(val2 < val)
1536082 0:722f18d46c1e 165 {
1536082 0:722f18d46c1e 166 val = val2;
1536082 0:722f18d46c1e 167 }
1536082 0:722f18d46c1e 168 return(val);
1536082 0:722f18d46c1e 169 }
1536082 0:722f18d46c1e 170 unsigned int max(unsigned int val1, unsigned int val2)
1536082 0:722f18d46c1e 171 {
1536082 0:722f18d46c1e 172 unsigned int val = val1;
1536082 0:722f18d46c1e 173 if(val2 > val)
1536082 0:722f18d46c1e 174 {
1536082 0:722f18d46c1e 175 val = val2;
1536082 0:722f18d46c1e 176 }
1536082 0:722f18d46c1e 177 return(val);
1536082 0:722f18d46c1e 178 }
1536082 0:722f18d46c1e 179 uint16_t detectTouch(void)
1536082 0:722f18d46c1e 180 {
1536082 0:722f18d46c1e 181 uint16_t firstValue;
1536082 0:722f18d46c1e 182 //uint16_t secondValue;
1536082 0:722f18d46c1e 183 AnalogIn pinXM(XM);
1536082 0:722f18d46c1e 184 DigitalOut pinYP(YP);
1536082 0:722f18d46c1e 185 DigitalOut pinYM(YM);
1536082 0:722f18d46c1e 186
1536082 0:722f18d46c1e 187 pinYP = 1;
1536082 0:722f18d46c1e 188 pinYM = 0;
1536082 0:722f18d46c1e 189 firstValue = pinXM.read_u16() >> 4;
1536082 0:722f18d46c1e 190
1536082 0:722f18d46c1e 191 //pinYP = 0;
1536082 0:722f18d46c1e 192 //pinYM = 1;
1536082 0:722f18d46c1e 193 //secondValue = pinXM.read_u16() >> 4;
1536082 0:722f18d46c1e 194
1536082 0:722f18d46c1e 195 restoreXY();
1536082 0:722f18d46c1e 196
1536082 0:722f18d46c1e 197 //if (secondValue < firstValue)
1536082 0:722f18d46c1e 198 //{
1536082 0:722f18d46c1e 199 return firstValue;
1536082 0:722f18d46c1e 200 //}
1536082 0:722f18d46c1e 201 //return secondValue;
1536082 0:722f18d46c1e 202 }
1536082 0:722f18d46c1e 203 void restoreXY(void)
1536082 0:722f18d46c1e 204 {
1536082 0:722f18d46c1e 205 DigitalOut pinXP(XP);
1536082 0:722f18d46c1e 206 DigitalOut pinXM(XM);
1536082 0:722f18d46c1e 207 DigitalOut pinYP(YP);
1536082 0:722f18d46c1e 208 DigitalOut pinYM(YM);
1536082 0:722f18d46c1e 209
1536082 0:722f18d46c1e 210 pinXP = 1;
1536082 0:722f18d46c1e 211 pinXM = 1;
1536082 0:722f18d46c1e 212 pinYP = 1;
1536082 0:722f18d46c1e 213 pinYM = 1;
1536082 0:722f18d46c1e 214 }
1536082 0:722f18d46c1e 215 int main()
1536082 0:722f18d46c1e 216 {
1536082 0:722f18d46c1e 217 unsigned int uiTest;
1536082 0:722f18d46c1e 218 VL6180x Capteur(D14, D15, 0x29 << 1);
1536082 0:722f18d46c1e 219 Capteur.VL6180xInit();
1536082 0:722f18d46c1e 220 Capteur.VL6180xDefautSettings();
1536082 0:722f18d46c1e 221 begin();
1536082 0:722f18d46c1e 222
1536082 0:722f18d46c1e 223 unsigned int uiDist = Capteur.getDistance();
1536082 0:722f18d46c1e 224 unsigned int uiLastDist = uiDist;
1536082 0:722f18d46c1e 225
1536082 0:722f18d46c1e 226 while(1)
1536082 0:722f18d46c1e 227 {
1536082 0:722f18d46c1e 228 fillRect(0, 0, 240, 320, WHITE);
1536082 0:722f18d46c1e 229 for(unsigned int x = 0; x < 320; x++)
1536082 0:722f18d46c1e 230 {
1536082 0:722f18d46c1e 231 wait_ms(5);
1536082 0:722f18d46c1e 232 for(unsigned int y = min(uiDist, uiLastDist); y <= max(uiDist, uiLastDist); y++)
1536082 0:722f18d46c1e 233 {
1536082 0:722f18d46c1e 234 fillRect((y * 240) / 255, x, 1, 1, BLACK);
1536082 0:722f18d46c1e 235 }
1536082 0:722f18d46c1e 236 pc.printf("Distance : %umm\r\n", uiDist);
1536082 0:722f18d46c1e 237 uiLastDist = uiDist;
1536082 0:722f18d46c1e 238 uiDist = Capteur.getDistance();
1536082 0:722f18d46c1e 239 uiTest = detectTouch();
1536082 0:722f18d46c1e 240 pc.printf("Z : %u\r\n", uiTest);
1536082 0:722f18d46c1e 241 if(uiTest)
1536082 0:722f18d46c1e 242 {
1536082 0:722f18d46c1e 243 pc.printf("Reset\r\n");
1536082 0:722f18d46c1e 244 x = 320;
1536082 0:722f18d46c1e 245 }
1536082 0:722f18d46c1e 246 }
1536082 0:722f18d46c1e 247 }
1536082 0:722f18d46c1e 248 }