robot

Dependencies:   ADXL345 AigamozuControlPackets HMC5843 ITG3200 MBed_Adafruit-GPS-Library XBee agzIDLIST mbed agz_common

Revision:
7:bfc65eac624e
Parent:
6:21e2792e66c7
Child:
8:760cb743e4fc
--- a/main.cpp	Sun Jun 08 15:09:17 2014 +0000
+++ b/main.cpp	Mon Jun 09 00:16:45 2014 +0000
@@ -4,8 +4,8 @@
 //
 //  Program name: Aigamozu Robot Control
 //  author: Atsunori Maruyama
-//  ver ->  1.1
-//  day ->  2014/06/01
+//  ver ->  1.3
+//  day ->  2014/06/09
 //  
 //
 /**********************************************/
@@ -39,35 +39,10 @@
 //Pin Setting
 //
 /////////////////////////////////////////
-Ticker hogehoge;
 VNH5019 agz_motorShield(p21,p22,p23,p24,p25,p26);
 
 /////////////////////////////////////////
 //
-//Each Value Setting
-//
-/////////////////////////////////////////
-int count = 0;
-
-//my status 
-//0: StndbyMode
-//1: ManualMode
-//2: AuthmaticMode(Random)
-unsigned char my_status = 0;
-
-//0 bit: Motor Satatus
-//1 bit: GPS Status
-//2 bit: Sensor Status 
-//3 bit: Battery Status
-unsigned char my_mode = 0;
-     
-//ManualValue
-int manual_count = 0;
-int manual_flag = 0;
-
-
-/////////////////////////////////////////
-//
 //Main Processing
 //
 /////////////////////////////////////////
@@ -110,6 +85,7 @@
                  
                  //Check Command Type 
                  switch(agz.checkCommnadType(buf)){
+                    
                     //CommandType -> ChanegeMode
                     case CHANGE_MODE :{
                         agz.changeMode(buf);