Kodingan untuk sistem atas. Silahkan di edit dan dibuat seoptimal mungkin

Dependencies:   Motor Servo mbed-rtos mbed

lonch.cpp

Committer:
Sufa
Date:
2016-11-10
Revision:
1:9dbbdb321fce
Parent:
0:0ae8cd6754d2

File content as of revision 1:9dbbdb321fce:

///////////////////////////////// LAUNCHER CODE v1.4 //////////////////////////////////
///////////////////////////Made by Everyone in KRAI 2017///////////////////////////////
////////////////////////////////Bandung, 10 Nov 2016///////////////////////////////////////
///////////////////////////Feel free to edit and upgrade it///////////////////////////

//Supporting People
// 1. Gustav Aditya Permana
// 2. Fransiskus Hendri
// 3. Sulhan Fauzi
// 4. Joshua
// 5. Daniel Steven Doxazo
// 6. Muhammad Fathoni

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

//Deklarasi Fungsi yang digunakan
// Motor :: Fungsi -- Nama fungsi -- (pwm, forward, reverse)
// Servo :: 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 (PA_0); // (PWM2/1)
Servo servo2 (PA_1); // (PWM2/2)
Servo servo3 (PB_10); // (PWM2/3)
Servo servo4 (PC_9); // (PWM3/4)
Servo servo5 (PC_8); // (PWM3/3)
Servo servo6 (PC_6); // (PWM3/1)


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

// Main Function
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);
        }
    }
}