servo
Dependencies: Servo mbed tsi_sensor SLCD
main.cpp
- Committer:
- sim2egor
- Date:
- 2016-03-22
- Revision:
- 1:854f2f39affd
- Parent:
- 0:f5fd64350b21
File content as of revision 1:854f2f39affd:
#include "mbed.h" #include "tsi_sensor.h" #include "Servo.h" #include "SLCD.h" //для FRDM-46Z slider #define ELEC0 9 #define ELEC1 10 //DigitalOut gpo(D0); //DigitalOut gpo(D1); //Servo myservo(D0); SLCD slcd; InterruptIn sw2(SW1); Servo myservo(D0); PwmOut led(D1); int Flag=0; void sw2_release(void) { Flag=1; } int main() { int angle =30; // TSIAnalogSlider tsi(ELEC0, ELEC1, 40); float delay1= 0.02f; sw2.rise(&sw2_release); while (true) { for(int i=0; i<100;i++) { if(Flag) goto a1; led = 1.0 - i/100; for( int j=0; j<=angle; j++) { myservo.position((float)j); wait(delay1); } for( int j=angle; j>=-angle; j--) { myservo.position((float)j); slcd.Home(); slcd.printf("%d",j); wait(delay1); } for( int j=-angle; j<=0; j++) { myservo.position((float)j); wait(delay1); } } } a1: myservo.position(0.0f); while (1){ }; }