NHK2017Ateamかにろぼ

Dependencies:   2017NHKpin_config mbed FEP HMC6352 MotorDriverController PID QEI omni

classDiagram

    \ ̄\                   / ̄/ 
/l     \  \             /  / lヽ  
| ヽ  ヽ   |           |  /  / | 
\ ` ‐ヽ  ヽ  ●        ●         /  / ‐  / 
  \ __ l  |  ||___|| /  l __ / 
     \  \ /      \/ 
      /\|   人__人  |/\       
    //\|             |/\\     
    //\|             |/\\     
    /     . \_____/         \ 

                               ┏┓        ┏━┓┏┓              
     ┏┓         ┏┓┏┓   ┏┓    ┏┓┗┛     ┏┓ ┗┓┃┗┛              
┏┛┗━┓  ┃┃┃┃    ┃┃┏━┛┗┓┏┓┏┛┗━┓┃┃┏┓┏┓┏━━━┓ 
┗┓┏━┛  ┃┃┗┛    ┃┃┗━┓┏┛┗┛┗┓┏┓┃┗┛┗┛┃┃┗━━━┛    
┏┛┃┏━┓┃┗━━┓┃┃┏━┛┗┓      ┏┛┃┃┃        ┃┃              
┃┏┛┗━┛┗━━┓┃┃┃┃┏┓┏┛      ┗━┛┃┃        ┃┃┏┓          
┃┃┏━━┓┏━━┛┃┃┃┃┗┛┃         ┏┛┃        ┃┃┃┗━━┓    
┗┛┗━━┛┗━━━┛┗┛┗━━┛         ┗━┛        ┗┛┗━━━┛  
Revision:
2:ea151e05033a
Parent:
1:269914e0aa07
Child:
5:bc5ba4f070ad
diff -r 269914e0aa07 -r ea151e05033a bot/bot.cpp
--- a/bot/bot.cpp	Tue Aug 22 05:07:57 2017 +0000
+++ b/bot/bot.cpp	Tue Aug 22 11:56:47 2017 +0000
@@ -1,18 +1,18 @@
 #include "bot.h"
 
-Bot::Bot() : Controller(), MotorDriver()
+Bot::Bot() : Controller(), MotorDriver(), PIDC()
 {
 }
 
 void Bot::confirmAll()
 {
     receiveState();
-
+    if(vector2[1] > 0.5)setSetPoint(vector2[0]);
 }
 
 void Bot::controllDrive()
 {
-    goPolar(vector, stick[2]);
+    goPolar(vector, co);
 }
 
 void Bot::controllMech()