KRAI 2017 / Mbed 2 deprecated Servo_Motor_Button

Kurang Servo Flap

Dependencies:   Motor Servo_Test mbed

Fork of Servo_test by KRAI 2017

main.cpp@1:d5adf9f6ca32, 2016-10-29 (annotated)

Committer:
gustavaditya
Date:
Sat Oct 29 16:06:40 2016 +0000
Revision:
1:d5adf9f6ca32
Parent:
0:ac3026899cce 
Sudah pakai servo pendorong dan Motor, servo Flap sedang dicoba.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Joshua23 0:ac3026899cce 1 // Continuously sweep the servo through it's full range
Joshua23 0:ac3026899cce 2 #include "mbed.h"
Joshua23 0:ac3026899cce 3 #include "Servo.h"
gustavaditya 1:d5adf9f6ca32 4 #include "Motor.h"
Joshua23 0:ac3026899cce 5
gustavaditya 1:d5adf9f6ca32 6 Servo servoFlap(PB_15);
gustavaditya 1:d5adf9f6ca32 7 Servo servoDorong(PC_8);
gustavaditya 1:d5adf9f6ca32 8 Motor myMotor (PA_8, PC_12, PB_7);
gustavaditya 1:d5adf9f6ca32 9 Motor myMotor2 (PA_11, PC_15, PA_15);
gustavaditya 1:d5adf9f6ca32 10
gustavaditya 1:d5adf9f6ca32 11 DigitalIn turunFlap(PC_4,PullUp);
gustavaditya 1:d5adf9f6ca32 12 DigitalIn naikFlap(PB_13,PullUp);
gustavaditya 1:d5adf9f6ca32 13 DigitalIn dorong(PB_14,PullUp);
Joshua23 0:ac3026899cce 14
gustavaditya 1:d5adf9f6ca32 15 float sudutMin = 90;
gustavaditya 1:d5adf9f6ca32 16 float sudutMax = 60;
gustavaditya 1:d5adf9f6ca32 17 float sudut = 20;
gustavaditya 1:d5adf9f6ca32 18
gustavaditya 1:d5adf9f6ca32 19 int main()
gustavaditya 1:d5adf9f6ca32 20 {
Joshua23 0:ac3026899cce 21 wait_ms(100);
gustavaditya 1:d5adf9f6ca32 22 servoDorong.position(3);
gustavaditya 1:d5adf9f6ca32 23 wait_ms(2000);
gustavaditya 1:d5adf9f6ca32 24 servoFlap.position(20);
Joshua23 0:ac3026899cce 25 wait_ms(2000);
gustavaditya 1:d5adf9f6ca32 26 while(1)
gustavaditya 1:d5adf9f6ca32 27 {
gustavaditya 1:d5adf9f6ca32 28 int flagTurun = 1;
gustavaditya 1:d5adf9f6ca32 29 int flagNaik = 1;
gustavaditya 1:d5adf9f6ca32 30 int flagDorong = 1;
gustavaditya 1:d5adf9f6ca32 31
gustavaditya 1:d5adf9f6ca32 32 myMotor.speed(1);
gustavaditya 1:d5adf9f6ca32 33 myMotor2.speed(-1);
gustavaditya 1:d5adf9f6ca32 34
gustavaditya 1:d5adf9f6ca32 35 if (!naikFlap && flagNaik)
gustavaditya 1:d5adf9f6ca32 36 {
gustavaditya 1:d5adf9f6ca32 37 flagNaik = 0;
gustavaditya 1:d5adf9f6ca32 38 sudut++;
gustavaditya 1:d5adf9f6ca32 39 if (sudut > sudutMin)
gustavaditya 1:d5adf9f6ca32 40 {
gustavaditya 1:d5adf9f6ca32 41 sudut = sudutMin;
gustavaditya 1:d5adf9f6ca32 42 }
gustavaditya 1:d5adf9f6ca32 43 servoFlap.position(sudut);
gustavaditya 1:d5adf9f6ca32 44 wait_ms(100);
Joshua23 0:ac3026899cce 45 }
gustavaditya 1:d5adf9f6ca32 46 if (!turunFlap && flagTurun)
gustavaditya 1:d5adf9f6ca32 47 {
gustavaditya 1:d5adf9f6ca32 48 flagNaik = 0;
gustavaditya 1:d5adf9f6ca32 49 sudut--;
gustavaditya 1:d5adf9f6ca32 50 if (sudut < sudutMax)
gustavaditya 1:d5adf9f6ca32 51 {
gustavaditya 1:d5adf9f6ca32 52 sudut = sudutMax;
gustavaditya 1:d5adf9f6ca32 53 }
gustavaditya 1:d5adf9f6ca32 54 servoFlap.position(sudut);
gustavaditya 1:d5adf9f6ca32 55 wait_ms(100);
Joshua23 0:ac3026899cce 56 }
gustavaditya 1:d5adf9f6ca32 57 if (!dorong && flagDorong)
gustavaditya 1:d5adf9f6ca32 58 {
gustavaditya 1:d5adf9f6ca32 59 flagDorong = 0;
gustavaditya 1:d5adf9f6ca32 60 servoDorong.position(30);
gustavaditya 1:d5adf9f6ca32 61 wait_ms(2000);
gustavaditya 1:d5adf9f6ca32 62 servoDorong.position(3);
gustavaditya 1:d5adf9f6ca32 63 wait_ms(2000);
gustavaditya 1:d5adf9f6ca32 64 }
Joshua23 0:ac3026899cce 65 }
Joshua23 0:ac3026899cce 66
Joshua23 0:ac3026899cce 67 }