robocup メイン fumiya
Dependencies: AQM0802A HMC6352 L6470_lib PID mbed
Fork of CatPot_Main_ver1 by
wraparound.cpp
- Committer:
- ryuna
- Date:
- 2014-12-29
- Revision:
- 4:8444360f08e2
- Parent:
- 3:8d718ddb84c9
- Child:
- 6:c2c31bc971ad
File content as of revision 4:8444360f08e2:
//回り込みます /** ballの位置によりボールが正面に来るまで.を一連の処理動作とし,動作を考える. すなわち,逐一モーターを動かし,ボールとの位置をチェックしモーターを動かすのではなく,はじめの状態から移動を考えてその処理を終えるまでモーターは拘束される. この動作について信用を得るために超音波(後ろ,左右),irセンサ,地磁気センサの三つから現在状態およびボールとの距離を把握.計算により移動量,回転速度を決定,行動へ. 上位4ビットで一番目のボールの位置,下位4ビットで二番目のボールの位置 二つ目の8ビットで1個目のボールの値 三つ目の8ビットで2個目のボールの値 Ir1//irの一番値が大きいもの Ir2//irの二番目に値が大きいもの 思考1 フローチャートを用いる。 12/26~ 露骨にオートマトンのプログラムを参考にしている。 *****/ /*** irは+-30度まで読めるが,距離が遠い場所ほど減衰 *1 *0 *2 *11 *3 *10 *4 *9 *5 *8 *6 *7 **/