File content as of revision 1:d5adf9f6ca32:

// Continuously sweep the servo through it's full range
#include "mbed.h"
#include "Servo.h"
#include "Motor.h"

Servo servoFlap(PB_15);
Servo servoDorong(PC_8);
Motor myMotor (PA_8, PC_12, PB_7);
Motor myMotor2 (PA_11, PC_15, PA_15);

DigitalIn turunFlap(PC_4,PullUp);
DigitalIn naikFlap(PB_13,PullUp);
DigitalIn dorong(PB_14,PullUp);

float sudutMin = 90;
float sudutMax = 60;
float sudut = 20;

int main() 
{
    wait_ms(100);
    servoDorong.position(3);
    wait_ms(2000);
    servoFlap.position(20);
    wait_ms(2000);
    while(1)
    {
        int flagTurun = 1;
        int flagNaik = 1;
        int flagDorong = 1;
        
        myMotor.speed(1);
        myMotor2.speed(-1);
        
        if (!naikFlap && flagNaik)
        {
            flagNaik = 0;
            sudut++;
            if (sudut > sudutMin)
            {
                sudut = sudutMin;    
            }
            servoFlap.position(sudut);
            wait_ms(100);    
        }
        if (!turunFlap && flagTurun)
        {
            flagNaik = 0;
            sudut--;
            if (sudut < sudutMax)
            {
                sudut = sudutMax;    
            }
            servoFlap.position(sudut);
            wait_ms(100);    
        }
        if (!dorong && flagDorong)
        {
            flagDorong = 0;
            servoDorong.position(30);
            wait_ms(2000);
            servoDorong.position(3);
            wait_ms(2000);    
        }    
    }
   
}