OpenEdv-开源电子网

 找回密码
 立即注册
正点原子全套STM32/Linux/FPGA开发资料,上千讲STM32视频教程免费下载...
查看: 5577|回复: 7

我想用STM32做一个平衡杆小车,求各位大神指点~~~

[复制链接]

2

主题

4

帖子

0

精华

新手入门

积分
32
金钱
32
注册时间
2014-10-29
在线时间
0 小时
发表于 2014-12-3 21:49:26 | 显示全部楼层 |阅读模式
5金钱
本人刚开始学STM32想拿一道省赛的题试试手,设计一辆小车,在上面安装一个倒立摆,控制小车使摆杆保持垂直倒立状态,求各位大神出出意见,谢谢。(新手实在没办法才来论坛求救,我不知道PID到底要怎么具体的运用到程序当中,能不能聚一点具体的之类的)

正点原子逻辑分析仪DL16劲爆上市
回复

使用道具 举报

530

主题

11万

帖子

34

精华

管理员

Rank: 12Rank: 12Rank: 12

积分
165540
金钱
165540
注册时间
2010-12-1
在线时间
2117 小时
发表于 2014-12-3 23:00:51 | 显示全部楼层
这个题目挑的有点难啊,呵呵
楼主有思路没有?
我是开源电子网www.openedv.com站长,有关站务问题请与我联系。
正点原子STM32开发板购买店铺http://openedv.taobao.com
正点原子官方微信公众平台,点击这里关注“正点原子”
回复

使用道具 举报

20

主题

232

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
335
金钱
335
注册时间
2013-6-1
在线时间
0 小时
发表于 2014-12-4 09:24:25 | 显示全部楼层
先把STM32的资源全部学完了,再来做题吧,不然你会痛不欲生
回复

使用道具 举报

5

主题

103

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
235
金钱
235
注册时间
2014-11-26
在线时间
25 小时
发表于 2014-12-4 10:59:37 | 显示全部楼层
PID属于矫正环节,你这个感觉原理跟平衡车一样,你应该会画传递函数图吧,传递函数会有一个反馈环节,这样会组成一个环,其实这个环就是C语言中的一个循环,而PID的计算属于这个环里面的一个组成部分:例如下面的程序:
typedef struct ID
{
double SetPoint; //设定目标
double roportion; //比例常数
double Integral;   //积分常数
double Derivative; //微分常数
double LastError;    //ERROR[-1]
double revError;     //Error [-2]
double SumError;    // Sum2 of Errors
}PID;

/*======================================
 位置式PID 计算
=======================================*/
double IDCalc(PID *pp, double ActualPoint)
{
double dError, Error;
Error = pp->SetPoint - ActualPoint;   //偏差
pp->SumError += Error;   //积分
dError = Error - pp->LastError;   //当前微分

pp->revError = pp->LastError;
pp->LastError = Error;

return (pp->roportion * Error    //比例项
+ pp->Integral * pp->SumError     //积分项
+ pp->Derivative * dError         //微分项
);
}

void IDInit(PID *pp)
{
memset(pp, 0, sizeof(PID));
}


void main(void)
{
PID sPID;
double rOut;
double rIn;
PIDInit(&sPID);
sPID.Proportion = 0.5;
sPID.Integral = 0.5;
sPID.Derivative = 0.0;
sPID.SetPoint = 100.0;

for(;;)
{
rIn = sensor();
rOut = IDCalc(&sPID, rIn);
actuator(rOut);
}
}


这个是一个大概,不过你最好先熟悉一下stm32的资源,加油!!!
回复

使用道具 举报

2

主题

4

帖子

0

精华

新手入门

积分
32
金钱
32
注册时间
2014-10-29
在线时间
0 小时
 楼主| 发表于 2014-12-4 11:05:55 | 显示全部楼层
回复【4楼】1376115749:
---------------------------------
谢谢
回复

使用道具 举报

2

主题

4

帖子

0

精华

新手入门

积分
32
金钱
32
注册时间
2014-10-29
在线时间
0 小时
 楼主| 发表于 2014-12-4 11:06:24 | 显示全部楼层
回复【2楼】正点原子:
---------------------------------
大致有点思路,因为有同学做出来过,所以想试试。
回复

使用道具 举报

530

主题

11万

帖子

34

精华

管理员

Rank: 12Rank: 12Rank: 12

积分
165540
金钱
165540
注册时间
2010-12-1
在线时间
2117 小时
发表于 2014-12-4 18:59:44 | 显示全部楼层
回复【6楼】恐高的天行者:
---------------------------------
试试吧
我是开源电子网www.openedv.com站长,有关站务问题请与我联系。
正点原子STM32开发板购买店铺http://openedv.taobao.com
正点原子官方微信公众平台,点击这里关注“正点原子”
回复

使用道具 举报

8

主题

40

帖子

0

精华

初级会员

Rank: 2

积分
94
金钱
94
注册时间
2014-9-18
在线时间
2 小时
发表于 2014-12-4 19:47:24 | 显示全部楼层
不是这么搞得吧,直接用电机控制比较容易
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则



关闭

原子哥极力推荐上一条 /2 下一条

正点原子公众号

QQ|手机版|OpenEdv-开源电子网 ( 粤ICP备12000418号-1 )

GMT+8, 2025-6-28 06:12

Powered by OpenEdv-开源电子网

© 2001-2030 OpenEdv-开源电子网

快速回复 返回顶部 返回列表