HAPSRG / Mbed 2 deprecated optical_test

Test Code for VL53L0x/PMW3901 Sensor

Dependencies:   mbed CrazyflieSensors

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 #include "PMW3901.h"
00003 #include "VL53L0X.h"
00004  
00005 Serial pc(USBTX, USBRX); // tx, rx
00006 //SPI spi(PB_5, PB_4, PB_3); // mosi, miso, sclk
00007 //DigitalOut cs(PA_4); 
00008  
00009 int main()
00010 {
00011     pc.baud(38400);
00012     
00013     PMW3901 pmw(PB_5, PB_4, PB_3, PA_4);
00014     VL53L0X vl(PB_9, PB_8);
00015     
00016     int init_pmw =  pmw.init();
00017     int init_vl = vl.init();
00018     
00019     pc.printf("initialize pmw: %d\r\n", init_pmw);
00020     pc.printf("initialize vl: %d\r\n", init_vl);
00021     
00022     while (true)
00023     {
00024         pmw.read();
00025         vl.read();
00026         
00027         pc.printf("%f %f %f\r\n", pmw.px, pmw.py, vl.d);
00028         
00029         wait(0.01);
00030     }
00031 }
Generated on Mon Jul 25 2022 07:41:50 by  doxygen 1.7.2