2022_gorobo_Ateam / 2022_Ateam_MOTORprogram

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

Dependencies:   SBDBT arrc_mbed BNO055

AutoMatic.cpp@5:e189d55ef292, 2022-01-28 (annotated)

Committer:
kazumayamanaka
Date:
Fri Jan 28 15:12:04 2022 +0000
Revision:
5:e189d55ef292
program  of wheel;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kazumayamanaka 5:e189d55ef292 1 #include "AutoMatic.hpp"
kazumayamanaka 5:e189d55ef292 2
kazumayamanaka 5:e189d55ef292 3 double AutoMatic::CalcDiffX(){ return TargetPosX - PosX; }
kazumayamanaka 5:e189d55ef292 4
kazumayamanaka 5:e189d55ef292 5 void AutoMatic::pass_TargetPosX(double X){
kazumayamanaka 5:e189d55ef292 6 TargetPosX = X;
kazumayamanaka 5:e189d55ef292 7 }
kazumayamanaka 5:e189d55ef292 8
kazumayamanaka 5:e189d55ef292 9 void AutoMatic::pass_PosX(double X){
kazumayamanaka 5:e189d55ef292 10 PosX = X;
kazumayamanaka 5:e189d55ef292 11 }
kazumayamanaka 5:e189d55ef292 12
kazumayamanaka 5:e189d55ef292 13 void AutoMatic::CalcPowerX(){
kazumayamanaka 5:e189d55ef292 14 if(CalcDiffX()>0){
kazumayamanaka 5:e189d55ef292 15 Xpower = 100;
kazumayamanaka 5:e189d55ef292 16 }
kazumayamanaka 5:e189d55ef292 17 else{
kazumayamanaka 5:e189d55ef292 18 Xpower = 0;
kazumayamanaka 5:e189d55ef292 19 }
kazumayamanaka 5:e189d55ef292 20 }
kazumayamanaka 5:e189d55ef292 21
kazumayamanaka 5:e189d55ef292 22 double AutoMatic::obt_Xpower(){
kazumayamanaka 5:e189d55ef292 23 CalcPowerX();
kazumayamanaka 5:e189d55ef292 24 return Xpower;
kazumayamanaka 5:e189d55ef292 25 }
kazumayamanaka 5:e189d55ef292 26
kazumayamanaka 5:e189d55ef292 27
kazumayamanaka 5:e189d55ef292 28