servocontrol.c

基于TMS320LF2407的一个倒立控制程序

#include "ServoControl.h"
                                           
#define ATurn_Rad  0.00322f     /*计数器的计数值转变成弧度值*/ 

/****************/

float ServoControl(float k,float h,long int SV,long int FbackValue,int Zero)
{
	float fCtrl;     
    fCtrl = k* (SV - h*(FbackValue-Zero))*ATurn_Rad;
	
	ClearDog();
	return fCtrl;	
}