File content as of revision 0:0ae8cd6754d2:

/* Made by SF101 */
/* 29/10/2016 */
/* KRAI 2017 */
/* Control the Launcher... */

// Library
#include "Motor.h"
#include "mbed.h"
#include "Servo.h"
#include "rtos.h"

//Deklarasi Fungsi yang digunakan
// Motor :: Fungsi -- Nama fungsi -- (pwm, forward, reverse)
// Motor :: Fungsi -- Nama fungsi -- (pwm, vcc, gnd)

Motor motor1 (PA_8, PC_12, PB_7);
Motor motor2 (PA_9, PA_13, PC_13);
Motor motor3 (PA_10, PA_14, PC_14);
Motor motor4 (PA_11, PA_15, PC_15);

Servo servo1 (PB_8);
Servo servo2 (PC_8);
Servo servo3 (PB_9);
Servo servo4 (PC_9);
Servo servo5 (PB_6);
Servo servo6 (PC_6);



// Deklarasi Variabel Global & Konstanta
int i;
float sudut_awal = 80;
float sudut_min = 60;
float sudut_max = 90;


int main (void) {
    
    while (1) {
        for ( i = 0 ; i >= 6 ; i++) // untuk melempar 7 saucer
        { 
            servo1.position (sudut_ref);
            wait_ms(100);
            servo1.position (sudut_max);
            wait_ms(100);
            
            motor1.speed(0.75);
            motor2.speed(-0.75);
            motor3.speed(0.25);
            motor4.speed(-0.25);
            motor5.speed(0.80);
            motor6.speed(-0.80);
            wait_ms(200);
            motor1.brake(1);
            motor2.brake(1);
            motor3.brake(1);
            motor4.brake(1);
            motor5.brake(1);
            motor6.speed(1);
            wait_ms(100);
            
            servo1.position (sudut_min);
            wait_ms(100);
        }
    }
}