2022_gorobo_Ateam / gourobo2022_undercarriage_new

2022_Ateam_MOTORprogramをscrp_slaveでメインマイコンからコントローラー状況を読み取れるように改良。 また、モータに0以外のpwmが送られている場合に基盤付属のledが点灯するようにした。

Dependencies:   SBDBT arrc_mbed BNO055

Diff: PIDco.cpp

Revision:
11:264f992664b0
Parent:
10:ad8fced7d6b6
Child:
12:894e5ac49810
--- a/PIDco.cpp	Fri Mar 11 04:24:27 2022 +0000
+++ b/PIDco.cpp	Tue Mar 22 00:35:37 2022 +0000
@@ -49,11 +49,11 @@
     Pwm = Pwm * Regulation;
     
         if(Pwm > 0){
-            v1p = Pwm > 0.5 ? 0.5 : Pwm;
+            v1p = Pwm > 0.6 ? 0.6 : Pwm;
             v1m = 0;
         }else if(Pwm < 0){
             v1p = 0;
-            v1m = -Pwm > 0.5 ? 0.5 : -Pwm;
+            v1m = -Pwm > 0.6 ? 0.6 : -Pwm;
         }else{
             v1p = 0;
             v1m = 0;