motor move
Dependencies: mbed-os DSHOT150
main.cpp
- Committer:
- takeru0x5569
- Date:
- 2021-09-27
- Revision:
- 1:6b1ac9244278
- Parent:
- 0:5c715c5e304e
File content as of revision 1:6b1ac9244278:
#include "mbed.h" #include "DSHOT150.h" #include <stdio.h> DSHOT150 motor( p21 ); AnalogIn ain(p20); DigitalOut led1(LED1); DigitalOut led2(LED2); DigitalOut led3(LED3); DigitalOut led4(LED4); InterruptIn mot_pls(p5); Timer tim; bool is_running = false; bool print_exe = false; float t; void flip() { led1 = !led1; if(is_running == false){ tim.start(); is_running = true; }else{ t = tim.read(); tim.reset(); print_exe = true; led2 = !led2; } } int main() { float val = 0; led2 = 0; led3 = 1; led4 = 1; // pc.set_baud(115200); motor.arm(); motor.get_tel( false ); mot_pls.rise(&flip); while (1){ val = ain; motor.throttle( val ); if(print_exe == true){ print_exe = false; printf("%f\n", t); } } }