// ControlFunc1.cpp : 定義控制臺應用程序的入口點。
//
#include "stdafx.h"
#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include <iostream>
using namespace std;
void ControlFunc(double d, double& U, double &dt)
{
//d為輸入的位移
//U為輸出的電壓
//dt為輸出的時間間隔
dt = 0.02;//輸出結果：時間間隔
double dy = 0.03;//控制參數：屈服變形
double du = 0.06;//控制參數：極限變形
double d0 = 0.0; //前一步位移，初始時為零
double Umax = 5.0;//最大電壓
double Umin = 0.0;//最小電壓
double vel; // 中間變量，速度
vel = (d - d0) / dt;
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;
}
cin >> d;
return 0;
}
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
