/*
 * msp_PID.h
 *
 *  Created on: 2024年1月22日
 *      Author: Administrator
 */

#ifndef INC_MSP_MSP_PID_H_
#define INC_MSP_MSP_PID_H_

#include "../../BASE/Inc/BSP/bsp_include.h"

extern void GF_MSP_Auto_Motion_adj(double Current_Angle, double Auto_Speed, double Auto_Speed_Max, double System_time ,double *W_Speed_1);
extern void GF_MSP_Auto_adj_Unicycle(double Current_Angle_11,double Desire_Angle_11, double Auto_Speed, double Auto_Speed_Max, double System_time ,double *W_Speed_1);
extern void GF_MSP_Auto_Motion_adj_Com(double Current_Angle, double Horizontal_Compen_Angle ,double Auto_Speed, double Auto_Speed_Max, double System_time ,double *W_Speed_1);

extern void GF_MSP_PID_Now_Der_adj_Com(double Current_Angle,double Desire_Angle_Input, double Auto_Speed, double Auto_Speed_Max, double System_time ,double *W_Speed_1);






int Angle_Tune_PID(float CurrentAngle, float TargetAngle, int Position_KP,
        int Position_KI, int Position_KD, int MaxValue);

#endif /* INC_MSP_MSP_PID_H_ */