jaozhcontrol.c

来自「基于TMS320LF2407的一个倒立控制程序」· C语言 代码 · 共 6 行

#include "math.h"  
#include "JaoZHControl.h"  
float JaoZHControl(float a,float T,float Ts,float Yl,float Xl,float Xn)
{
	return ((2*a*T/Ts-1)*Yl+(1+2*T/Ts)*Xn+(1-2*T/Ts)*Xl)/(1+2*a*T/Ts);	
}