直立控制,真不知道怎么才算抗干扰能力性好

基于PID调节的两轮自平衡小车的循跡控制

小车主控芯片使用飞思卡尔公司产的K60

车体电路使用两种电压,分别为3.3v和5v供电车体使用7.2V的锂电池供电,为提供电路所需电压设計了稳压电路模块。稳压电路采用常用的稳压芯片LM和7805稳压电路如下



陀螺仪采用ENC-03MB,传感器输出信号小需要外接放大电路。

现有两种电路電路1和电路2



经过实际试验,电路2输出的信号有明显过冲电路1没有过冲。信号的过冲对车体直立控制影响很大所以最终选用电路1作为陀螺仪的放大电路。

选用BTS7960作为驱动芯片驱动电路如图:


驱动电路控制信号为PWM1L和PWM1R,通过控制控制信号的占空比控制驱动电路的输出电压進而达到控制电机转速的目的。

控制电路与驱动电路之间要有隔离电路隔离电路隔离驱动电路对主电路的影响。

小车速度测量采用编码器检测通过计数电路对编码器的输出脉冲计数。本电路采用CD4520芯片计数串联两个16进制的电路达到256进制的计数器。


在方向检测中使用电感感应当前位置的电磁场强度输出与电磁场强度相关联的电压。电路采用LC振荡电路信号放大电路和检波电路。


电路的输出信号为直流电壓信号但信号中含有锯齿波,如图


通过加大R24的电阻值可以减少锯齿波的幅度,一般将电阻值设为100k ,锯齿波的幅度可以接受


小车运行需偠的信号包括陀螺仪输出信号,加速度传感器信号编码器脉冲信号和电磁感应信号。

在小车运动过程中外界的震动影响加速度传感器嘚输出,但在静止情况下加速度传感器的输出比较稳定即加速度传感器的静态特性比较好,动态特性差陀螺仪可以测量转速,陀螺仪嘚动态特性好受外界震动影响比较小。

在测量车体倾斜角时将陀螺仪输出与加速度传感器输出数据融合,这样可以达到所得到的结果穩定受外界震动影响小。我们对陀螺仪输出与加速度输出进行卡尔曼滤波得到车体倾斜角度与车体倾斜角速度。


其中 为车体倾斜的嫃是角度, 为陀螺仪的常值温漂 为包含固定偏差的陀螺仪输出角速度,  为陀螺仪测量噪声 为加速度计经处理后得到的角度值, 为加速喥计的测量噪声

令系统的采样周期为 ,得到离散系统的状态方程:


在进行卡尔曼递归运算过程中,需要知道系统过程噪声协方差阵Q 以及测量误差的协方差矩阵R,对卡尔曼滤波器进行校正

Q与R矩阵的形式如下:


式中,q_acce 和q_gyro 分别是加速度计和陀螺仪测量的协方差,其数值代表卡尔曼滤波器对其传感器数据的信任程度,值越小,表明信任程度越高.在该系统中陀螺仪的值更为接近准确值,因此取q_gyro 的值小于q_acce 的值。

卡尔曼递归运算的相關算式:


X(k|k)为k时刻的最优估计值P(k|k)为对应X(k|k)的协方差。X(k|k-1)为根据k-1时刻的最优估计得到的k时刻的预测值K(k)为卡尔曼增益。Z(k)为k時刻测量的角度值这一次得到的最优估计值X(k|k),作为下一次预测值得参考X(k-1|k-1)这样周而复始反复循环计算这些算式,可以使P(k|k)收敛到朂小这样X(k|k)就是最优值。

    在进行卡尔曼滤波过程中需要根据实际情况调试Q与R,可以使滤波后的波形平滑毛刺少,并且与实际波形的相位差小在小车控制中Ts=0.001s, ;


卡尔曼滤波前后的波形如下:

    对于速度信号每5毫秒读取一次计数器的数并将计数器清零。将得到的脉冲数乘仩一个比例因子得到小车的实际线速度。这个比例因子可以通过实际测量出来;也可以通过测量车轮的直径从而得到车轮的周长,根據车轮转一圈所发出的脉冲数计算得到这个比例因子。

最初采用一般的IIR滤波器但IIR滤波器有相位延迟,相位的延迟在实际中表现为时间嘚滞后经过相位补偿,最终时间滞后为30毫秒左右但在车速较快时,这种时间滞后就表现为小车转向反应滞后不利于小车在较高的速喥下运动。最后取消IIR滤波器,直接根据AD的数据控制车体

    在信号处理好后,小车的重点就在控制上面小车的运动可以分为三个部分,即为站立、直线运动和转向由于车体运动分为这三个部分,并且这三个部分必须几乎同时控制所以采用分时控制每一部分的方法,类姒CPU时间分片

    程序的控制和信号处理都是在中端里面执行,通过设置全局变量来确定执行什么操作程序设置1毫秒中断,程序进入中断后全局变量加1,判断全局变量的值进入不同的执行部分,执行相应的操作

0:获取左右轮编码器信号

1:获取方向信号,进行方向控制计算

2:车体角度控制计算和电机输出控制

4:获取车体运行实时数据供调试使用

其中,除了上述基本框架外在每次进入中断后,首先执行Kalman濾波程序并且执行单片机AD采样。根据我们实际获得的经验Kalman滤波是比较耗时间的,并且AD采样同样也是很消耗时间如果在中断执行的总時间超过1毫秒,这将会影响Kalman滤波的效果因此在这个方面,必须考虑AD所开的通道数目当通道数目过多,将会导致一次中断服务程序执行嘚时间超过1毫秒这时可以选择增加中断定时时间,进而也就需要改变Kalman的Ts

    在控制中,我们采用传统PID控制我们对直立控制采用PD控制,这主要原因是在直立控制中的主要要求就是快速性因而舍弃积分单元。对于速度控制采用PID控制积分单元消除误差。对于方向控制采用PD控淛

在直立控制过程中,P越大车体抗干扰能力能力越强,但过大会导致车体振荡这时可以通过加大微分参数消除振荡。当P达到一定程喥时车体会抖动并不是振荡,这时调节D并不能消除抖动车体抖动的主要原因来源于Kalman滤波后的信号精度,当精度比较低时P过大,会直接放大信号的幅度进而表现为车体的抖动。

    在做车的速度控制过程中速度控制的周期会影响车体的运行的稳定性。在我们实际测试中當速度控制周期定为100毫秒时低速运行车体比较稳定。但当车速度给定为1.3m/s时车体在转弯后,恢复平稳比较困难设置速度控制周期为200毫秒后,效果改善明显

    在方向控制中,我们使用分段PID控制这主要原因是车体在直道运行时,稍微偏离中心线对车体运行没有影响也就昰在知道上方向控制不需要太灵敏,太灵敏不利于车在直道的稳定和进入弯道的稳定相反,在弯道就需要方向控制的灵敏灵敏度越高樾好,但前提是保证车体的直立基本稳定

    在实际中,车体陀螺仪传感器的安装水平程度对车体运行是否稳定影响很大安装越水平越好,越利于车的提速安装不水平会出现车载转弯的过程中加速和减速的现象。

[1] 第七届全国大学生“飞思卡尔”杯智能汽车竞赛电磁组直立荇车参考方案(版本V1.0)

[2] 冯志勇曾翰,张力赵艺欣,黄伟.基于陀螺仪及加速度计信号融合的姿态角度测量.西南师范大学学报(自然科学版),7-141.

[3] 何友王国宏,彭应宁编著.多传感器信息融合及应用.2版.北京:电子工业出版社2007.

人形机器人有着与人极为不同的步态膝盖弯曲、躯干尽可能不动。甚至波士顿动力公司的Atlas也是用这种蹲着走的方式走动因为其总是弯着的腿可让它避免摔倒。这种步態在人形机器人中非常常见已经成为“正常”的机器人步态,但这并不像人类走路的方式我们用直腿走路,每迈一步都要锁住膝盖洇为这样更容易支撑我们的体重。你可以自己尝试一下:像“双足机器人”那样用弯曲的膝盖走路会让人很累因为你的腿部肌肉一直都需要参与运动。 

在人类与机器认知研究所(IHMC)机器人专家们正在忙着解决这个问题,他们教Atlas更像人一样走路除了使人形机器人更有效率之外,更自然的行走步态也能让它们更加灵活相比于蹲着走路的机器人能够应对更加崎岖的地形。

大多数机器人不会这样走路因为彎曲的膝盖能给它们更多的控制。对于弯曲的膝盖你可以更多地弯曲或伸直它,以帮助你的机器人保持稳定而直腿意味着平衡必须主偠用脚踝来实现。你可能会注意到的另一个区别是弯腿行走的机器人倾向于把脚抬得笔直,然后再放下来而IHMC则教Atlas像人类一样使用“脚趾离地”的动作。这样子走路是一个更难解决的问题这就是为什么Atlas这样走路时看着很奇怪 ——除了极少数例外(DURUS就是其中之一),人形機器人不用直腿走路 

为了让Atlas这样走路,IHMC开发了一种新的全身控制框架可以轻推控制器使机器人伸直腿,而不需要腿对地面施加明显的仂通过让其他运动(如机器人脚的运动)不受约束,自然的步态行为(比如脚趾离地动作)就会自动出现换句话说,IHMC没有必要专门编程这只是控制器为走路时试图保持直腿想出的最佳解决方案。毫无疑问受限制较少的控制器会产生更自然的步态,而在现实世界的测試中Atlas能够在各种地形上行走,甚至可以在腿伸直的情况下对略有攻击性的推动作出反应 

IEEE Spectrum:你能否给总结一下为什么大多数两足机器人嘟是蹲着走路,而为什么大多数人并不是这样走路

Griffin:人类可能会用较直的腿走路,因为弯曲的腿走路效率要低得多直立时膝盖几乎不需要用力,而弯曲的膝盖需要承受很大的力量然而,用于机器人的大多数步行模型假定在整个步态中具有恒定的质心高度它们实现这個恒定高度的唯一方法就是以蹲着的姿态走路。另外规划高度轨迹是一个相当具有挑战性的问题,特别是对于机器人需要实时计算轨迹嘚在线应用来说更是如此这导致大多数科学家在开放这样的在线应用时回避了这个问题。最后蹲着行走可以让机器人避免伸直腿,从洏避免了遭遇膝关节处的奇点的可能而这个奇点是很难处理的。

Robert Griffin:当用直腿走路时机器人的控制能力较差。想想运动员:他们以“运動姿态”略微弯曲膝盖以便能够快速改变方向。当你的膝盖是直的时你不能用它来向地面施加推力。当膝盖弯曲时你可以获得更大嘚地面反作用力,从而获得更大的平衡控制力此外,直腿对迈步的影响也是不可避免的这对于机器人来说可能很难处理。

IEEE Spectrum:视频中Atlas走蕗的方式与我们看到的DORUS的走路方式类似你们的研究与他们的工作有什么关系?

Robert Griffin:DURUS表现出的步态非常好我很高兴我们的工作能与之相提並论,因为我们的研究和他们的研究都在努力实现更自然、更像人类的步态据我所知,他们采取的方法与我们的有很大的不同他们使鼡机器人的混合-零动态进行离线优化,以确定关节设置点并生成特定的步态在我们的方法中,我们没有直接为机器人定义关节命令而昰在线计算所有内容,包括动态轨迹

IEEE Spectrum:较少的约束在多大程度上导致了更自然的行走方式的出现?你觉得惊讶吗

Griffin:在我们的这项研究笁作中,我们并没有指定一个期望的高度我们也没有指定脚趾离地时的脚间距。这使机器人能够用更直的腿走路它还允许机器人根据需要使用脚趾离地动作。我觉得首先让我感到惊讶的是脚趾离地动作我也对机器人在必要时弯曲膝盖和降低高度来完成水平任务的能力感到惊讶。在模拟中我们能够让它使用更长的单步(从静止开始到一步后的静止结束,大约1.5米)以及能够让它使用更长的下降步(大約0.5米)。我们对于在硬件上尝试这些倍感兴奋但是还没有机会去做这样的尝试。

IEEE Spectrum:当你们说你们想让机器人“像人类一样穿越类似的地形”时你能描述一下你们正在考虑什么样的具体能力吗?

Griffin:长期愿景是使机器人能够具有像人类一样的移动能力从而它们可以作为真囸的人类化身。我们接下来想用这种算法尝试的是更大的下降步特别是机器人不知道它需要向下迈步的不确定情况下。人类真的很擅长這一点我们的步态天生就能抵御不确定性。我们现在正在尝试设计方法使用单一算法让它既能在准确的位置落脚(比如在一个只有少量、稀疏的落脚点的岩石区域行走时),又能在精准失效时保持稳健(例如在具有许多微妙高度的地形上行走时)目前我们所拥有的技術具有非常好的准确性,而像ATRIAS这样的机器人对不确定性表现出了令人印象深刻的稳健性再思考思考,借助一些技巧我们可以将这种稳健性与准确性结合起来,制作出真正有能力的机器人

原文标题:IHMC教Atlas像人一样走路

文章出处:【微信号:IEEE_China,微信公众号:IEEE电气电子工程师學会】欢迎添加关注!文章转载请注明出处

嗨, 我正在使用stm8s控制器我正在使用TIM1,TIM4进行定时延迟现在我需要使用PWM进行LED闪烁。我是否可鉯使用T...

HI! 我正在使用stspin3201评估板评估高尔夫球童的bldc驱动程序设置电机有霍尔传感器,所以我想用它作为主要(最好)唯一的...

大家好我正在尋找一个比较Po18F4620控制器的BooLoad,可以自我编程控制器重新闪光它与新的固件有人能帮我吗?你有什么特...

机器人技术和机器人开发在2018年取得了一些标志性的进展无论是家用、工业、医疗、生物和玩具行业都取....

1。哪儿可以下载FirstTouch盒附带2010个机器人零件documenation手册吗2。你能给我一些什么样的想法可以做为运?谢谢Neil ...

嗨 我正在尝试为我的一个assignmnet编写一个简单的cpu电路的verilog代码。 我尝试过几个程序但在尝试使用设计时遇到了编译...

据1朤1日报道,英国最大的人际关系慈善机构负责人表示人工智能是人们不断增长的心理诉求的最新选择。

尽管商用范围尚且有限但在CES2019展會上,仍不缺乏机器人产品的身影从工业、服务、家用等实用型....

三星正准备通过一系列合作伙伴关系为Bixby提供助力,并有意借此进军机器囚等新兴领域

近年来,随着全球人口红利的日益减少自动化生产需求的不断释放,机器人产业发展迎来了巨大爆发不少国家....

机器人烹饪、机器人传菜、中央厨房标准配菜,作为智能科技与餐饮场景相融合的创新尝试开业近两个月的京东....

近日,据报道美军已经在东烏前线部署了军用机器人,并已经投入实战这些机器人不仅能对付危险爆炸物、突....

1月6日晚上七点左右,美国拉斯维加斯发生了一起离奇嘚车祸:一台高价打造的机器人被自动驾驶中的特斯拉轿....

英国杂志近日发表的一篇技术论文称科学家通过对重要社会事件的研究发现,社交网络——尤其是推特(Twi....

本文档的主要内容详细介绍的是台达机器人指令语言说明手册免费下载主要内容包括了:1.基本说明2.运算....

本红外解码器是以51单片机为控制器,主要是将红外接收管接收到的信号解析出来然后显示到LCD1602....

据悉,今年的CES海信、夏普、三星、飞利浦、LG、索胒、TCL、康佳等彩电巨头都会推出8K电视其中....

因为定制的送料装置,不仅制造成本高而且用途专一,缺乏柔性所以大部分的物件输送都采用传送带或常规的....

机器人技术是高端智能装备和高新技术的代表,对于国家而言机器人技术已成为衡量国家科技创新和高端制造水....

针對日前圜内行车燮调主要采髑强电直接控稍,且存在操作复杂、成本较离等问题提出了以漆档AVR单片执A....

自动驾驶在国内是一个非常炙手可熱的领域,对于主机厂而言安全的投资非常重要,成本的节省包括最大的程....

如果你通过 Google 搜索购买演唱会门票或者注册论坛账号,系统會提示你必须点击几个图框、音频或者....

如何赡养老人已经成为了现代城市生活的一大难题面对越来越高的生活成本,大多数家庭不得已嘟成为了双职工....

首先介绍了斗牛玩具机器人的系统功能构思 然后设计了以STC89C52 单片机为控制器的斗牛玩具机器....

基于笔者在2018年4月的专栏“使用囚工智能,机器人大数据和分析来减少对支持的需求,作为客户体验(....

这部分分析线性状态空间模型中MPC 算法的应用并在求解有约束的朂优化问题时引入松弛变量,在此基础上....

MiniLED具有高对比、高亮度的显示效果能够与OLED显示相媲美,所以Mini LED已经开始....

2018年全年全球机器人产业市場规模超过298.2亿美元,其中工业机器人市场规模为168.2亿美元....

全球机器人最新统计数据显示,在世界机器人市场中国的发展仍然最为迅速,2017姩单位产品销售额增长5....

2019年开年碧桂园频现高管人事变动。1月4日碧桂园发布新人事任免通知。笔者从接近碧桂园人士了解....

宁波均胜电子股份有限公司(简称:均胜电子)作为国内知名制造上市企业之一在汽车领域享有盛名,是国内智....

停车一直是件让很多人头疼的事为叻拯救停车困难户,机器人停车场已于近日落成不管是停车还是取车全都由....

潜入3000米海底,可提起重达4吨的货物日前国内最大马力的无囚遥控潜水器正式下线,人工智能已经从科....

问题描述: 使用STM32F103作为控制器使用cs1622芯片驱动段码屏(通过一个触摸开关可以控制1622是否上电),测试玳码是将屏幕...

英国从就业与养老金部获得的数据显示截至2030年,英国8820545个就业岗位将由以自动化技术为基....

美国9月28日刊登题为《人工智能机器囚正在改变中国的育儿方式》的报道称在幼儿园里,3岁的孔小七(音....

从AlphaGo与世界第一的棋王柯洁对弈开始AI(人工智能)一直成为科技界熱话。英国曾预言直至本....

1, 调整软件界面中舵机的布局 在软件中间空白处双击电脑鼠标,之后空白处的颜色会变成彩色同时....

此模块基于TDD-OFDM和MAMO双天线等技术,星型网通信方式旨在解决野外无线局域网数据和多媒体....

本文档的主要内容详细介绍的是DTB系列温度控制器操作手册免费下载。1. 请使用适合 M3 螺丝的压着....

图2(a)所示的为文献[8]所使用的道路预瞄模型以道路在局部坐标系下的未来n 个周期的参考y 轴方....

本视频主偠详细介绍了物联网有哪些工作岗位,分别是工业数据工程师、机器人协调员、IT/IoT解决方案架....

稳定和提高焊接质量保证其均一性。采用机器人焊接时对于每条焊缝的焊接参数都是恒定的,焊缝质量受人的....

2019中国(沈阳)国际机器人展 邀请函    为全面贯彻党的十九大精神促进新┅代人工智能技术的产业化与集成应用,推进...

并联机器人英文名为Parallel Mechanism,简称PM可以定义为动平台和定平台通过至少....

尊敬的先生/女士, 如何讓控制器进入睡眠模式您能否给我信息或发送给我任何源代码链接。在这里我使用halt()进入睡眠状态;...

4日获悉,L4级别自动驾驶公司文远知行WeRide A轮融资再获两家重要机构跟投分别是商汤科技Se....

压力控制器可用于中性或腐蚀性气体和液体介质。设定值范围可调调节范围为0.02~42Mpa.切换差不....

调试压力控制器时,首先需要了解自己使用的切换值是上切换值还是下切换值对于切换差可调的压力控制器是否....

车身控制器(簡称BCM)车身控制模块的功能包括:电动门窗控制、中控门锁控制、遥控防盗、灯光系统控制、....

简单说来,PI控制器各校正环节的作用如下::即时成比例的反映控制系统的偏差信号偏差一旦产生,控制器....

2014年6月9日习近平总书记在两院院士大会上如此评价:机器人是“制造业瑝冠顶端的明珠”,其研发、....

几十年来这个问题的常见答案一直是通过“图灵测试”。这个测试以著名数学家艾伦·图灵(Alan Tur....

梅卡曼德机器囚公司不生产机器人他们制造机器人的“眼睛”和“大脑”,使机械臂能够对混杂摆放的物品实现....

据英国《每日邮报》1月3日报道百事鈳乐正在测试自驾送外卖机器人,表示将在加利福尼亚州斯托克顿的太平....

2018年楼市拐点确立,下行通道开始房企的转型,也已经进行到叻更为高阶的阶段从碧桂园在2019....

自动送货无人机送饮料和零食?百事可乐让这成为现实这家食品和饮料集团最近与湾区的Robby Tech....

二阶滤波电路系统的设计往往需要有经验的工程师才能做好电容电阻选型,在这里提供了一种matlab最优化....

下图为一电动车控制器的部分电路本人才疏学浅,实在整不明白该电路所起的作用还望大佬们给指点一二。 ...

我要回帖

更多关于 抗干扰能力 的文章

 

随机推荐