20190109基于贝加莱PLC 用C语言构建PID控制器 与应用一

void _CYCLIC PIDRegulation(void)
{

//

// typedef struct
//
// {
//
// float setpoint; //设定值
//
// float proportiongain; //比例系数
//
// float integralgain; //积分系数
//
// float derivativegain; //微分系数
//
// float lasterror; //前一拍偏差
//
// float preerror; //前两拍偏差
//
// float deadband; //死区
//
// float result; //输出值
//
// }PID;

//接下来实现PID控制器:

//void PIDRegulation(PID,processValue)

//{

//	float thisError;
//
//	float increment;
//
//	float pError,dError,iError;

thisError=PID.setpoint-processValue; //得到偏差值

pError=thisError-PID.lasterror;

iError=thisError;

dError=thisError-2*(PID.lasterror)+PID.preerror;

increment=PID.proportiongain*pError+PID.integralgain*iError+PID.derivativegain*dError;   //增量计算


PID.preerror=PID.lasterror; //存放偏差用于下次运算

PID.lasterror=thisError;

PID.result+=increment;

//}

}

  • 0
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
贝加莱PLC(Beckhoff PLC)是一种常见的工控系统,可以通过其编程环境TwinCAT来实现电机的PID控制。下面是一个简单的示例代码,演示如何在贝加莱PLC上实现电机的PID控制: ```csharp PROGRAM Main VAR Setpoint: REAL := 0.0; // 设定值 Feedback: REAL := 0.0; // 反馈值 Error: REAL := 0.0; // 误差 Integral: REAL := 0.0; // 积分项 PreError: REAL := 0.0; // 上一次的误差 Output: REAL := 0.0; // 控制输出 Kp: REAL := 1.0; // 比例系数 Ki: REAL := 0.5; // 积分系数 Kd: REAL := 0.2; // 微分系数 END_VAR METHOD PIDControl : REAL VAR P: REAL := 0.0; // 比例项 I: REAL := 0.0; // 积分项 D: REAL := 0.0; // 微分项 BEGIN Error := Setpoint - Feedback; Integral := Integral + Error; P := Kp * Error; I := Ki * Integral; D := Kd * (Error - PreError); Output := P + I + D; PreError := Error; RETURN Output; END_METHOD METHOD MainProgram : BOOL VAR MotorRunning: BOOL := FALSE; // 电机运行状态 MotorStopped: BOOL := TRUE; // 电机停止状态 Start: BOOL := FALSE; // 启动信号 Stop: BOOL := FALSE; // 停止信号 ControlOutput: REAL := 0.0; // 控制输出 END_VAR BEGIN // 主循环 WHILE TRUE DO // 获取反馈值(根据实际情况读取电机的位置或速度反馈) Feedback := GetFeedback(); // 如果启动信号为真且电机当前为停止状态,则启动电机 IF Start AND MotorStopped THEN MotorRunning := TRUE; MotorStopped := FALSE; // 执行启动电机的操作代码 // ... END_IF // 如果停止信号为真且电机当前为运行状态,则停止电机 IF Stop AND MotorRunning THEN MotorRunning := FALSE; MotorStopped := TRUE; // 执行停止电机的操作代码 // ... END_IF // 如果电机运行中,则进行PID控制计算并输出控制信号 IF MotorRunning THEN ControlOutput := PIDControl(); // 将ControlOutput应用到电机控制(根据实际情况发送控制信号) ApplyControlOutput(ControlOutput); END_IF // 其他逻辑代码... // 延时一段时间,避免过于频繁的循环 WAIT 10ms; END_WHILE; RETURN TRUE; END_METHOD ``` 请注意,上述代码仅为示例,具体的PID控制实现可能会根据具体的电机类型和控制要求进行调整。此外,代码中的GetFeedback()函数和ApplyControlOutput()函数需要根据实际情况进行实现,用于获取电机的反馈值和将控制输出应用到电机控制中。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值