メインプログラム最新版です

Dependencies:   mbed SBDBT 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);
    }
}