example2.h

00001 /*
00002     Copyright (c) 2011 Andy Kirkham
00003  
00004     Permission is hereby granted, free of charge, to any person obtaining a copy
00005     of this software and associated documentation files (the "Software"), to deal
00006     in the Software without restriction, including without limitation the rights
00007     to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
00008     copies of the Software, and to permit persons to whom the Software is
00009     furnished to do so, subject to the following conditions:
00010  
00011     The above copyright notice and this permission notice shall be included in
00012     all copies or substantial portions of the Software.
00013  
00014     THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
00015     IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
00016     FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
00017     AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
00018     LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
00019     OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
00020     THE SOFTWARE.
00021 */
00022 
00023 // Dervived from http://mbed.org/forum/helloworld/topic/2303
00024 
00025 #include "mbed.h"
00026 
00027 DigitalOut led1(LED1);
00028 DigitalOut led2(LED2);
00029 
00030 #include "SimpleRCservos.h"
00031 #include "SimpleServoControl.h"
00032 
00033 SimpleRCservos servos;
00034 
00035 SimpleServoControl motor_front_left(&servos, SimpleRCservos::Servo6); // p21
00036 SimpleServoControl motor_front_right(&servos, SimpleRCservos::Servo5); // p22
00037 SimpleServoControl motor_rear_left(&servos, SimpleRCservos::Servo4); // p23
00038 SimpleServoControl motor_rear_right(&servos, SimpleRCservos::Servo3); // p24
00039 
00040 int main() 
00041 {
00042     // Led1 on to show program start.
00043     led1 = 1;
00044     
00045     motor_front_left.position(90.0);
00046     motor_front_right.position(90.0);
00047     motor_rear_left.position(90.0);
00048     motor_rear_right.position(90.0);
00049     
00050     // Led2 on when rotate complete and program ended.
00051     led2 = 1;
00052     
00053     // End, loop forever.
00054     while(1);
00055 }