if (d <= -du) //状态1:禁止区域(-)
{
U = Umin;
if (vel < 0)
U = Umax;
}
else if (d > -du && d <= -dy) //状态2:控制区域(-)
{
U = Umin;
if (vel < 0)
U = (-d - dy) / (du - dy)*Umax + (du + d) / (du - dy)*Umin;
}
else if (d > -dy && d < dy) //状态3:自由区域(-)状态4:自由区域(+)
{
U = Umin;
}
else if (d >= dy && d < du) //状态5:控制区域(+)
{
U = Umin;
if (vel >= 0)
U = (d - dy) / (du - dy)*Umax + (du - d) / (du - dy)*Umin;
}
else if (d >= du) //状态6:禁止区域(+)
{
U = Umin;
if (vel >= 0)
U = Umax;
}
d0 = d;
}
int _tmain(int argc, _TCHAR* argv[])
{
double d=0.0,U=0.0,dt=0.0;
for (int i = 0; i < 10; i++)
{
d = 0.01*i;
ControlFunc(d, U, dt);
cout << "第" << i << "步计算结果: 控制电压U= " << U << " 时间间隔dt=" << dt << endl;