
Projet APP5 comm Zumo avec mbed
Dependencies: mbed PowerControl
main.cpp
- Committer:
- bouaziz
- Date:
- 2022-01-10
- Revision:
- 2:d5dd5e731d4a
- Parent:
- 1:e8c4e314d8f8
- Child:
- 3:f12fee4182d3
File content as of revision 2:d5dd5e731d4a:
#include "zumo.h" #include "PowerControl/PowerControl.h" DigitalOut myled(LED1); zumo myzumo; Timer t1; long v1,v2; int main() { char v[3]; Peripheral_PowerDown(LPC1768_PCONP_PCENET|LPC1768_PCONP_PCSPI|LPC1768_PCONP_PCRTC|LPC1768_PCONP_PCI2C2| LPC1768_PCONP_PCI2S|LPC1768_PCONP_PCQEI|LPC1768_PCONP_PCI2C1|LPC1768_PCONP_PCCAN1|LPC1768_PCONP_PCCAN2); //and turn off the PHY OSC LPC_GPIO1->FIODIR |= 0x8000000; LPC_GPIO1->FIOCLR = 0x8000000; wait(1.0); t1.reset(); t1.start(); t1.stop(); printf("INIT= %u\r\n",t1.read_us()); t1.reset(); while(1) { t1.start(); myzumo.speed(140,140); t1.stop(); v1=t1.read_us(); wait(0.030); t1.reset(); t1.start(); myzumo.stop(); t1.stop(); v2=t1.read_us(); printf("%u %u\r\n",v1,v2); wait(.025); } }