2022_gorobo_Ateam / 2022_Ateam_MOTORprogram

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

Dependencies:   SBDBT arrc_mbed BNO055

AutoMatic.cpp

Committer:
kazumayamanaka
Date:
2022-01-28
Revision:
5:e189d55ef292

File content as of revision 5:e189d55ef292:

#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; 
}