HAPSRG / Mbed 2 deprecated optical_test

Test Code for VL53L0x/PMW3901 Sensor

Dependencies:   mbed CrazyflieSensors

main.cpp@0:32868d4b0196, 2022-02-14 (annotated)

Committer:
osaka
Date:
Mon Feb 14 08:53:49 2022 +0000
Revision:
0:32868d4b0196
test code

Who changed what in which revision?

UserRevisionLine numberNew contents of line
osaka 0:32868d4b0196 1 #include "mbed.h"
osaka 0:32868d4b0196 2 #include "PMW3901.h"
osaka 0:32868d4b0196 3 #include "VL53L0X.h"
osaka 0:32868d4b0196 4
osaka 0:32868d4b0196 5 Serial pc(USBTX, USBRX); // tx, rx
osaka 0:32868d4b0196 6 //SPI spi(PB_5, PB_4, PB_3); // mosi, miso, sclk
osaka 0:32868d4b0196 7 //DigitalOut cs(PA_4);
osaka 0:32868d4b0196 8
osaka 0:32868d4b0196 9 int main()
osaka 0:32868d4b0196 10 {
osaka 0:32868d4b0196 11 pc.baud(38400);
osaka 0:32868d4b0196 12
osaka 0:32868d4b0196 13 PMW3901 pmw(PB_5, PB_4, PB_3, PA_4);
osaka 0:32868d4b0196 14 VL53L0X vl(PB_9, PB_8);
osaka 0:32868d4b0196 15
osaka 0:32868d4b0196 16 int init_pmw = pmw.init();
osaka 0:32868d4b0196 17 int init_vl = vl.init();
osaka 0:32868d4b0196 18
osaka 0:32868d4b0196 19 pc.printf("initialize pmw: %d\r\n", init_pmw);
osaka 0:32868d4b0196 20 pc.printf("initialize vl: %d\r\n", init_vl);
osaka 0:32868d4b0196 21
osaka 0:32868d4b0196 22 while (true)
osaka 0:32868d4b0196 23 {
osaka 0:32868d4b0196 24 pmw.read();
osaka 0:32868d4b0196 25 vl.read();
osaka 0:32868d4b0196 26
osaka 0:32868d4b0196 27 pc.printf("%f %f %f\r\n", pmw.px, pmw.py, vl.d);
osaka 0:32868d4b0196 28
osaka 0:32868d4b0196 29 wait(0.01);
osaka 0:32868d4b0196 30 }
osaka 0:32868d4b0196 31 }