![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
ALPHA_A
Dependencies: DataPool MD_PID mbed
Diff: 2017_4/2017_4.cpp
- Revision:
- 4:169a7b6c0138
- Parent:
- 3:42fdfd41f96a
--- a/2017_4/2017_4.cpp Thu Sep 07 00:37:39 2017 +0000 +++ b/2017_4/2017_4.cpp Thu Sep 14 00:36:55 2017 +0000 @@ -2,7 +2,7 @@ #include "mbed.h" #include <math.h> -Mekanamu_4::Mekanamu_4(PinName pin_pwm_FR, PinName pin_dere_FR, PinName pin_channelA_FR, PinName pin_channelB_FR, +Mecanamu_4::Mecanamu_4(PinName pin_pwm_FR, PinName pin_dere_FR, PinName pin_channelA_FR, PinName pin_channelB_FR, PinName pin_pwm_FL, PinName pin_dere_FL, PinName pin_channelA_FL, PinName pin_channelB_FL, PinName pin_pwm_BL, PinName pin_dere_BL, PinName pin_channelA_BL, PinName pin_channelB_BL, PinName pin_pwm_BR, PinName pin_dere_BR, PinName pin_channelA_BR, PinName pin_channelB_BR, @@ -27,7 +27,7 @@ rev = arg_rev; } -void Mekanamu_4::Drive( double arg_x, double arg_y, double arg_rota, +void Mecanamu_4::Drive( double arg_x, double arg_y, double arg_rota, double F_Gain, double B_Gain, double R_Gain, double L_Gain) { double dere, sp; @@ -56,7 +56,7 @@ md_br->Drive(duty[3] * L_Gain, 100); } -void Mekanamu_4::Matrix(double speed[3], double duty[4]) +void Mecanamu_4::Matrix(double speed[3], double duty[4]) { double keisu[4][3]; keisu[0][0] = sqrt(2.0) / 2.0;