メインマイコンのプログラム
Dependencies: mbed SBDBT_for_2022gourobo arrc_mbed
main.cpp
- Committer:
- guesta
- Date:
- 2022-01-29
- Revision:
- 6:fd9b59f828e8
- Parent:
- 3:e4b5563563af
- Child:
- 7:59be95fceafa
File content as of revision 6:fd9b59f828e8:
#include "mbed.h" #include "scrp_slave.hpp" #include "sbdbt.hpp" int main(){ //---------------初期設定--------------- //scrp_slave ScrpSlave scrp(PC_12,PD_2,PH_1,0x0807f800); //sbdbt sbdbt sb(A0,A1); //scrp_slaveのid設定 const int wheel_num = 1; const int BeanbagGet_num = 2; const int BeanbagShot_num = 3; const int TakoGetPut_num = 4; const int tape_LED_num = 5; const int remort_stop_num = 6; const int send_all = 255; //コマンド番号設定 //足回り用 const int x_component_cmd = 1; const int y_component_cmd = 2; const int l2_cmd = 3; const int r2_cmd = 4; //ビーンバッグ回収用 //ビーンバッグ発射用 //農作物回収・設置用 const int up = 1; const int down = 2; //テープLED用 //遠隔非常停止受信用 const int //全体送信用 const int select = 50;//手動・自動切り替え const int stop_all = 51;//全プログラム停止 //変数 int x_component; int y_component; int l2_num; int r2_num; //------------------------------------- while(true){ sb.button_state(); x_component = sb.rsx(); y_component = sb.rsy(); l2_num = sb.l2An(); r2_num = sb.r2An(); //足回り scrp.send1(wheel_num,x_component_cmd,x_component); wait_ms(1); scrp.send1(wheel_num,y_component_cmd,y_component); wait_ms(1); scrp.send1(wheel_num,l2_cmd,l2_num); wait_ms(1); scrp.send1(wheel_num,r2_cmd,r2_num); wait_ms(1); //ビーンバッグ回収 //ビーンバッグ発射 //農作物回収・設置 //全体送信 scrp.send1(send_all,select,sb.select());//自動・手動モード切り替え wait_ms(1); } }