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){
        };
}