stilldk
Dependencies: vl53l0x_api SRF05
Simplifier/Shape.cpp
- Committer:
- dnikolz
- Date:
- 2022-03-10
- Revision:
- 0:041c1089b6e5
File content as of revision 0:041c1089b6e5:
#define Pin1 PB_0 #define Pin2 PB_0 #define Pin_GPIO PB_0 //DigitalOut myled(LED1); #include "mbed.h" #include "Shape.h" PwmOut Drive_pin_A2(PA_8); //steering servo PWM output pin D7 PwmOut Drive_pin_B2(PA_9); //Not Used PwmOut Drive_pin_C2(PB_10); //Motor drive PWM output pin D6 PwmOut Drive_pin_D2(PB_4); //Motor drive PWM output pin D5 int Turn_right3=2; int Turn_left3=0; int Speed13=10; //Half power int Speed23=20; //Full power int PW_Period3=20; void Shape::oval(){ Turn_left3 = 1775; // half turn left - end point Turn_left3 = 1770; wait_us(1); Drive_pin_A2.pulsewidth_us(Turn_left3); Turn_left3 = 1775; wait_us(1); Turn_left3 = 1625; Drive_pin_A2.pulsewidth_us(Turn_left3); Turn_left3 = 1770; wait_us(1); Drive_pin_A2.pulsewidth_us(Turn_left3); Turn_left3 = 1775; wait_us(1); Turn_left3 = 1625; Drive_pin_A2.pulsewidth_us(Turn_left3); Turn_left3 = 1770; wait_us(1); Drive_pin_A2.pulsewidth_us(Turn_left3); }