tetsuya Ogata / Mbed 2 deprecated Enpra_practice04

Servo Example

Dependencies:   Servo mbed

main.cpp@0:d4a595edb64d, 2013-05-29 (annotated)

Committer:
ogata_lab
Date:
Wed May 29 05:54:08 2013 +0000
Revision:
0:d4a595edb64d
Servo Example

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ogata_lab 0:d4a595edb64d 1 #include "mbed.h"
ogata_lab 0:d4a595edb64d 2 #include "Servo.h"
ogata_lab 0:d4a595edb64d 3
ogata_lab 0:d4a595edb64d 4 DigitalIn sw01(p20);
ogata_lab 0:d4a595edb64d 5 DigitalOut led01(LED1);
ogata_lab 0:d4a595edb64d 6 Servo servo01(p21);
ogata_lab 0:d4a595edb64d 7
ogata_lab 0:d4a595edb64d 8
ogata_lab 0:d4a595edb64d 9 bool pose = false;
ogata_lab 0:d4a595edb64d 10 bool old_sw = false;
ogata_lab 0:d4a595edb64d 11
ogata_lab 0:d4a595edb64d 12 int main() {
ogata_lab 0:d4a595edb64d 13 sw01.mode(PullUp);
ogata_lab 0:d4a595edb64d 14 while(1) {
ogata_lab 0:d4a595edb64d 15 bool now_sw = (sw01 == 0);
ogata_lab 0:d4a595edb64d 16 if (now_sw) {
ogata_lab 0:d4a595edb64d 17 led01 = 1;
ogata_lab 0:d4a595edb64d 18 } else {
ogata_lab 0:d4a595edb64d 19 led01 = 0;
ogata_lab 0:d4a595edb64d 20 }
ogata_lab 0:d4a595edb64d 21 if (!old_sw && now_sw) {
ogata_lab 0:d4a595edb64d 22 pose = ! pose;
ogata_lab 0:d4a595edb64d 23
ogata_lab 0:d4a595edb64d 24 }
ogata_lab 0:d4a595edb64d 25 old_sw = now_sw;
ogata_lab 0:d4a595edb64d 26 if (pose) {
ogata_lab 0:d4a595edb64d 27 servo01.write(0.5);
ogata_lab 0:d4a595edb64d 28 } else {
ogata_lab 0:d4a595edb64d 29 servo01.write(0.1);
ogata_lab 0:d4a595edb64d 30 }
ogata_lab 0:d4a595edb64d 31 }
ogata_lab 0:d4a595edb64d 32 }