一种双核三轴四轮变结构高速微微鼠全数字伺服控制器制造技术

技术编号:13678341 阅读:93 留言:0更新日期:2016-09-08 05:25
本发明专利技术公开了一种双核三轴四轮变结构高速微微鼠全数字伺服控制器,包括微微鼠壳体、车轮、第一红外传感器、第二红外传感器、第三红外传感器、第四红外传感器、第五红外传感器、第六红外传感器、第一高速直流伺服电机、第二高速直流伺服电机、真空吸附电机、第一磁电编码器、第二磁电编码器、运动传感器以及采集传感器,还包括控制板,所述的控制板采用双核控制器,包括ARM和FPGA,所述的ARM与STM32F407进行通信连接。通过上述方式,本发明专利技术提高了双核微微鼠全数字伺服系统的稳定性,有效防止了微微鼠在高速迷宫探索时的地面打滑,避免了微微鼠远远偏离中心位置现象的发生,提高了其快速求解时的稳定性。

【技术实现步骤摘要】

本专利技术涉及一种双核三轴四轮高速微微鼠(PICOMOUSE)全数字伺服控制系统,属于微型迷宫机器人领域。
技术介绍
随着微电子技术、计算机控制技术的不断进步,国外专家在微电脑鼠求解迷宫的技术基础之上提出了一种更具有挑战性的迷宫机器人---微微鼠,其常用二维结构如图1所示。为增强迷宫复杂程度以及老鼠求解迷宫的难度,迷宫挡墙由原有的180mm变成了90mm,原有的迷宫由16*16格变成了32*32格,新的迷宫二维结构如图2所示。电源一旦打开,微微鼠全程完全依靠自身携带的传感器自动导航,并求解由1024个迷宫格组成的各种复杂迷宫,能够快速从起点找到一条到达设定目标点的最佳路径,然后以最快的速度冲刺到终点。微微鼠作为一种新型的迷宫机器人技术,每年世界上有诸多国家和地区在展开这种技术的竞争,并具有不同的竞赛规则,微微鼠在整个迷宫中的行走分为两部分:探索和冲刺,相应花费的时间为探索时间TS和冲刺时间TD以及由于违规而出现的加罚时间TP,微微鼠的最终性能TIME由TS、TD和TP来决定,其中最具有代表性的是日本、美国、英国和新加坡。日本规则如下:TIME=TD;美国规则如下:TIME=TS/30+TD+TP,其中TP为微微鼠出现故障的加罚时间;英国规则如下:TIME=TS/30+TD+TP,其中TP为微微鼠出现故障的加罚时间;新加坡规则如下:TIME=TS/60+TD+TP,其中TP为微微鼠出现故障的加罚时间。从上面的国际规则可以看出,微微鼠求解迷宫在微微鼠的整个运动中占有非常重要的位置,一旦微微鼠求解迷宫失败,微微鼠的整个功能也就无法实现。微微鼠在迷宫中行走过程中要时刻判断周围的环境,然后传输参数到控制器,由控制器反复控制其在迷宫方格中精确的加速和减速运动。一只优秀的微微鼠成功求解迷宫必须具备良好的感知能力,有良好的行走能力,优秀的智能算法,否则将无法完成任务。如果采用现有的简易算法和结构实现微微鼠求解迷宫,在实践中发现:(1)由于求解迷宫数目的大量增加,且迷宫探测设置点不在是原有的迷宫中心,而是迷宫中的任意一格,使得原有的简易微微鼠求解迷宫技术无法求解现有的复杂迷宫;(2)由于微微鼠尺寸的大幅减少,如果微微鼠采用图1中的六组传感器技术探索复杂迷宫,在一些对探索有时间要求的国际规则中,受单核处理器处理速度影响,经常会出现探索时间较长的现象发生,最终导致微微鼠竞争失败;(3)一些简易微微鼠样机伺服系统采用比较低级的单核芯片和算法,使得微微鼠在迷宫当中的行走一般都要花费较长的时间,不仅消耗了大量电池的能量,而且在真正的大赛中也无法取胜;(4)由于迷宫挡墙尺寸的减少,使得微微鼠单格行走运行的距离减少,微微鼠在求解迷宫过程中的频繁刹车和启动加重了单核控制器的工作量,单核伺服控制器无法满足微微鼠快速启动和停车的要求;(5)对于两轮驱动的微微鼠来说一般要求驱动其运动的两个电机PWM控制信号要同步,受计算能力的限制单核伺服系统很难满足这一条件,微微鼠在直道上行驶时不能准确的行走在中线上,在高速行走时很容易撞到迷宫挡墙,导致任务失败;(6)由于受单核控制器容量和算法影响,微微鼠无法存储迷宫信息,当遇到掉电情况时所有的信息将消失,这使得整个探索过程要重新开始;(7)微微鼠在迷宫行走时,基于单核控制易于受到外界干扰,由于没有进行及时补偿导致微微鼠碰撞迷宫挡墙,最终无法完成任务;(8)两轮微微鼠系统在加速行走时由于重心后移,使得老鼠前部轻飘,即使在良好的路面上微微鼠也会打滑,有可能导致撞墙的现象出现,不利于高速微微鼠的发展;(9)两轮微微鼠系统如果设计不当造成重心前偏,将导致驱动轮上承受的正压力减小,这时微微鼠系统更加容易打滑,也更容易走偏,导致导航失败;(10)两轮微微鼠系统如果设计不当造成重心侧偏将导致两个驱动轮承受的正压力不同,在快速启动时两轮打滑程度不一致,瞬间就偏离轨迹,转弯时,其中正压力小的轮子可能打滑,导致转弯困难;(11)由于传统的微微鼠多采用光电编码器实现老鼠的速度和位置的反馈,由于光电编码器的体积较大,使得微微鼠的体积相对较大,无法实现微微鼠伺服系统的微型化发展;(12)由于比赛场地的灰尘较大,特别是迷宫经过多次比赛后,迷宫地板上吸附的灰尘较大,使得快速行驶的微微鼠很容易打滑,导致迷宫信息错误,最终微微鼠无法完成探索和冲刺的任务;(13)由于传统微微鼠伺服系统采用的集成驱动芯片体积较大,微微鼠的体积无法微型化且重量较大,在相同功率直流伺服电机驱动下无法取得足够大的加速度,系统的加速性能较弱;(14)基于单核控制的微微鼠全数字伺服系统既要处理各种光电传感器信号和迷宫信息,而且还要处理微微鼠的多轴伺服控制,使得处理器的工作量较大,极大了影响了微微鼠速度的提高和稳定性。微微鼠求解迷宫是国际新兴的一门技术,由于微微鼠技术的难度较高以及迷宫设计的复杂性,导致国内还没有研发此机器人的单位。因此,需要借助现有的先进控制技术以及先进控制芯片设计一种双核多轴多轮防滑的微微鼠求解迷宫的全数字伺服控制器。
技术实现思路
本专利技术主要解决的技术问题是提供一种双核三轴四轮变结构高速微微鼠全数字伺服控制器,为克服单核控制器不能满足微微鼠快速行走的稳定性和快速性的要求,舍弃了国产微微鼠所采用的单一单片机工作模式,在吸收国外先进控制思想的前提下,自主专利技术了基于ARM(STM32F405)+FPGA(A3P250)的全新双核控制模式,控制板以FPGA为处理核心,以磁电编码器为反馈元件,通过其内部三闭环伺服控制实现三轴直流伺服的同步控制,STM32F405从复杂的工作当中解脱出来,实现部分的信号处理算法和FPGA的控制逻辑,并响应中断,实现数据通信和存储实时信号。为解决上述技术问题,本专利技术采用的一个技术方案是:提供了一种双核三轴四轮变结构高速微微鼠全数字伺服控制器,包括微微鼠壳体、车轮、第一红外传感器、第二红外传感器、第三红外传感器、第四红外传感器、第五红外传感器、第六红外传感器、第一高速直流伺服电机、第二高速直流伺服电机、真空吸附电机、第一磁电编码器、第二磁电编码器、运动传感器以及采集传感器,四个所述的车轮分别两两设置在微微鼠壳体的左右两侧边,所述的第一红外传感器和第六红外传感器分别设置在微微鼠壳体的左右两侧边并位于车轮的前端,所述的第二红外传感器和第五红外传感器设置在微微鼠壳体的前端,所述的第三红外传感器斜向设置在第一红外传感器和第二红外传感器之间,所述的第四红外传感器斜向设置在第五红外传感器和第六红外传感器之间,所述的第一高速直流伺服电机和第二高速直流伺服电机分别安装在微微鼠壳体的左右两边并位于两个车轮之间的位置,所述的真空吸附电机设置在第一高速直流伺服电机和第二高速直流伺服电机上方的中间位置,所述的第一磁电编码器和第二磁电编码器分别设置在第一高速直流伺服电机和第二高速直流伺服电机的下方,所述的运动传感器和采集传感器依次设置在真空吸附电机的下方,还包括控制板,所述的控制板设置在微微鼠壳体内,所述的控制板采用双核控制器,包括ARM和FPGA,所述的ARM与FPGA进行通信连接。在本专利技术一个较佳实施例中,所述的第三传感器和第四传感器斜向设置时与Y轴之间的夹角大小为:。在本专利技术一个较佳实施例中,所述的ARM采用STM32F405控制器,本文档来自技高网
...

【技术保护点】
一种双核三轴四轮变结构高速微微鼠全数字伺服控制器,其特征在于,包括微微鼠壳体、车轮、第一红外传感器、第二红外传感器、第三红外传感器、第四红外传感器、第五红外传感器、第六红外传感器、第一高速直流伺服电机、第二高速直流伺服电机、真空吸附电机、第一磁电编码器、第二磁电编码器、运动传感器以及采集传感器,四个所述的车轮分别两两设置在微微鼠壳体的左右两侧边,所述的第一红外传感器和第六红外传感器分别设置在微微鼠壳体的左右两侧边并位于车轮的前端,所述的第二红外传感器和第五红外传感器设置在微微鼠壳体的前端,所述的第三红外传感器斜向设置在第一红外传感器和第二红外传感器之间,所述的第四红外传感器斜向设置在第五红外传感器和第六红外传感器之间,所述的第一高速直流伺服电机和第二高速直流伺服电机分别安装在微微鼠壳体的左右两边并位于两个车轮之间的位置,所述的真空吸附电机设置在第一高速直流伺服电机和第二高速直流伺服电机上方的中间位置,所述的第一磁电编码器和第二磁电编码器分别设置在第一高速直流伺服电机和第二高速直流伺服电机的下方,所述的运动传感器和采集传感器依次设置在真空吸附电机的下方,还包括控制板,所述的控制板设置在微微鼠壳体内,所述的控制板采用双核控制器,包括ARM和FPGA,所述的ARM与FPGA进行通信连接。...

【技术特征摘要】
1.一种双核三轴四轮变结构高速微微鼠全数字伺服控制器,其特征在于,包括微微鼠壳体、车轮、第一红外传感器、第二红外传感器、第三红外传感器、第四红外传感器、第五红外传感器、第六红外传感器、第一高速直流伺服电机、第二高速直流伺服电机、真空吸附电机、第一磁电编码器、第二磁电编码器、运动传感器以及采集传感器,四个所述的车轮分别两两设置在微微鼠壳体的左右两侧边,所述的第一红外传感器和第六红外传感器分别设置在微微鼠壳体的左右两侧边并位于车轮的前端,所述的第二红外传感器和第五红外传感器设置在微微鼠壳体的前端,所述的第三红外传感器斜向设置在第一红外传感器和第二红外传感器之间,所述的第四红外传感器斜向设置在第五红外传感器和第六红外传感器之间,所述的第一高速直流伺服电机和第二高速直流伺服电机分别安装在微微鼠壳体的左右两边并位于两个车轮之间的位置,所述的真空吸附电机设置在第一高速直流伺服电机和第二高速直流伺服电机上方的中间位置,所述的第一磁电编码器和第二磁电编码器分别设置在第一高速直流伺服电机和第二高速直流伺服电机的下方,所述的运动传感器和采集传感器依次设置在真空吸附电机的下方,还包括控制板,所述的控制板设置在微微鼠壳体内,所述的控制板采用双核控制器,包括ARM和FPGA,所述的ARM与FPGA进行通信连接。2.根据权利要求1所述的双核三轴四轮变结构高速微微鼠全数字伺服控制器,其特征在于,所述的第三传感器和第四传感器斜向设置时与Y轴之间的夹角大小为:。3.根据权利要求1所述的双核三轴四轮变结构高速微微鼠全数字伺服控制器,其特征在于,所述的ARM采用STM32F405控制器,所述的FPGA采用A3...

【专利技术属性】
技术研发人员:张好明陈阳
申请(专利权)人:江苏若博机器人科技有限公司
类型:发明
国别省市:江苏;32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1