static inline void TRAJ_run(TRAJ_Handle handle)
{
_iq targetValue = TRAJ_getTargetValue(handle);
_iq intValue = TRAJ_getIntValue(handle);
_iq error = targetValue – intValue;
_iq maxDelta = TRAJ_getMaxDelta(handle);
_iq minValue = TRAJ_getMinValue(handle);
_iq maxValue = TRAJ_getMaxValue(handle);
// increment the value
intValue += _IQsat(error,maxDelta,-maxDelta);
// bound the value
intValue = _IQsat(intValue,maxValue,minValue);
// store the value
TRAJ_setIntValue(handle,intValue);
return;
} // end of TRAJ_run() function
速度模式 这个函数应该用了,怎么找不到在哪里调用?