2022_gorobo_Ateam / 2022_Ateam_MOTORprogram

足回り用プログラム(修正版)

Dependencies:   SBDBT arrc_mbed BNO055

Diff: AutoMatic.cpp

Revision:
5:e189d55ef292
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/AutoMatic.cpp	Fri Jan 28 15:12:04 2022 +0000
@@ -0,0 +1,28 @@
+#include "AutoMatic.hpp"
+
+double AutoMatic::CalcDiffX(){ return  TargetPosX - PosX; }
+
+void AutoMatic::pass_TargetPosX(double X){
+    TargetPosX = X;
+}
+
+void AutoMatic::pass_PosX(double X){
+    PosX = X;
+}
+
+void AutoMatic::CalcPowerX(){
+    if(CalcDiffX()>0){
+        Xpower = 100;
+    }
+    else{
+        Xpower = 0;
+    }
+}
+
+double AutoMatic::obt_Xpower(){
+    CalcPowerX();
+    return Xpower; 
+}
+        
+    
+