2022_Ateam_MOTORprogramをscrp_slaveでメインマイコンからコントローラー状況を読み取れるように改良。 また、モータに0以外のpwmが送られている場合に基盤付属のledが点灯するようにした。
Dependencies: SBDBT arrc_mbed BNO055
DUALSHOCKco.cpp
- Committer:
- guesta
- Date:
- 2022-01-27
- Revision:
- 7:a0375e6dc8ca
- Parent:
- 0:a1238c4cd105
- Child:
- 11:264f992664b0
File content as of revision 7:a0375e6dc8ca:
#include "DUALSHOCKco.hpp" void DUALSHOCKco::pass_val(double RSX,double RSY,double R2AN,double L2AN){ rsx = RSX; rsy = RSY; r2an = R2AN; l2an = L2AN; } bool DUALSHOCKco::cal_input(){ if(r2an == 0&&l2an == 0){ Xval = (rsx - RS_normal) * 450 / RS_normal; Yval = ((RS_MAX - rsy) - RS_normal + 1) * 450 / RS_normal; return true; }else{ if(r2an != 0){ Xval = r2an * 400 / RL_MAX; } else{ Xval = -l2an * 400 / RL_MAX; } return false; } } double DUALSHOCKco::obt_X(){ return Xval; } double DUALSHOCKco::obt_Y(){ return Yval; }