本发明专利技术公开了双核中速六轮微微鼠冲刺控制器，包括电池装置、传感器装置、辅助导航装置、真空抽吸装置和控制单元模块；所述电池装置分别电连接控制单元模块、电机X、电机Y和电机M，所述传感器装置和陀螺仪装置分别信号连接控制单元模块，所述控制单元模块分别信号连接电机X、Y和M；所述辅助导航装置包括方向传感器D1、陀螺仪G1和加速度计A1。本发明专利技术通过位于底盘下的真空抽吸装置解决了微微鼠在冲刺中打滑的现象，同时根据微微鼠前进的速度以及地面情况自动调节真空抽吸直流电机M的伺服控制，使得微微鼠不再受制于迷宫地面路况。
【技术实现步骤摘要】
本专利技术涉及微型迷宫冲刺机器人领域，尤其涉及一种。
技术介绍
微电脑鼠是使用嵌入式微控制器、传感器和机电运动部件构成的一种智能行走机器人，在国外已经竞赛了将近30年，其常采用两轮结构，两轮微电脑鼠二维结构如图1所不O微电脑鼠可以在不同“迷宫”中自动记忆和选择路径，采用相应的算法，快速地到达所设定的目的地。其求解的迷宫之一示意如图2所示。随着微电子技术、计算机控制技术的不断进步，国外专家在微电脑鼠求解迷宫的技术基础之上提出了一种更具有挑战性的迷宫机器人一微微鼠:为了增强迷宫复杂程度以及老鼠求解迷宫的难度，迷宫挡墙由原有的180mm变成了 90mm，原有的迷宫由16*16格变成了 32*32格，新的迷宫二维结构如图3所示。电源一旦打开，微微鼠全程完全依靠自身携带的传感器自动导航，并求解由1024个迷宫格组成的各种复杂迷宫，能够快速从起点找到一条到达设定目标点的最佳路径，然后以最快的速度冲刺到终点。作为一种自助导航智能机器人，因为通过无线装置可以向控制器输入迷宫信息，微微鼠或者微电脑鼠国际准则拒绝使用无线装置，为了能够得到微微鼠或者是微电脑鼠冲刺、冲刺后的信息，只能通过算法快速寄存并储存其行走信息，当完成任务后通过控制器的232串口或者是USB串口读取存储信息。微微鼠在迷宫中冲刺过程中要时刻判断周围的环境，然后传输参数到控制器，由控制器反复控制其在迷宫方格中精确的加速和减速进行运动。一只优秀的微微鼠必须具备良好的感知能力，有良好的行走能力，优秀的智能算法，否则将无法完成任务。微微鼠技术综合了多学科知识，对于提升在校学生的动手能力、团队协作能力和创新能力，促进学生课堂知识的消化和扩展学生的知识面都非常有帮助，并且微微鼠走迷宫技术的开展可以培养大批相关领域的人才，进而促进相关领域的技术发展和产业化进程。如果认为微微鼠只是微电脑鼠的简单拷贝，按照微电脑鼠技术来设计微微鼠，在实践中则会发现如下问题: (I)基于轮式的微微鼠只能被动的适应迷宫地面的打滑程度，随着微微鼠速度的提高，其打滑概率也极大增加，导致求解迷宫失败。(2)由于求解迷宫数目的大量增加，原有的微电脑鼠求解迷宫技术无法求解现有的复杂迷宫。(3)由于微微鼠尺寸的大幅减少，如果微微鼠采用图1中的六组传感器技术探测迷宫，经常出现传感器相互干扰的状况，导致其读取迷宫信息失败。(4)由于微电脑鼠伺服系统采用的都是比较低级的算法，使得微微鼠在迷宫当中的冲刺一般都要花费较长的时间，这使得在真正的大赛中无法取胜。(5)由于迷宫挡墙尺寸的减少，使得微微鼠单格运行的距离减少，微微鼠频繁的刹车和启动加重了单片机的工作量，单一的单片机无法满足微微鼠冲刺时快速启动和停车的要求。(6)对于两轮驱动的微微鼠来说一般要求驱动其运动的两个电机PffM控制信号要同步，受计算能力的限制单一单片机伺服系统很难满足这一条件，微微鼠在直道上行驶时不能准确的行走在中线上，在高速冲刺时很容易撞到迷宫挡墙，导致任务失败。(7)由于受单片机容量影响，现有的微微鼠基本上都只有两个动力驱动轮，采用两轮差速方式行驶，使得系统对六轴的伺服要求较高，特别是直线加速冲刺时，要求速度和加速度要追求严格的一致，否则直线冲刺将会失败，导致微微鼠出现撞墙的现象发生； (8)两轮微微鼠系统在加速冲刺时由于重心后移，使得老鼠前部轻飘，即使在良好的路面上微微鼠也会打滑，有可能导致撞墙的现象出现，不利于高速微微鼠冲刺的发展。(9)两轮微微鼠系统在正常冲刺时行驶时如果设计不当造成重心前偏，将导致驱动轮上承受的正压力减小，这时微微鼠系统更加容易打滑，也更容易走偏，导致冲刺失败。(10)两轮微微鼠系统在正常冲刺行驶时如果设计不当造成重心侧偏将导致两个驱动轮承受的正压力不同，在快速启动时两轮打滑程度不一致，瞬间就偏离轨迹，转弯时，其中正压力小的轮子可能打滑，导致转弯困难。(11)由于采用两个动力轮驱动，为了满足复杂状态下的加速和减速冲刺，使得单个驱动电机的功率较大，不仅占用的空间较大，而且有时候在一些相对需求能量较低的状态下造成“大马拉小车”的现象出现，不利于微微鼠本体微型化发展和微微鼠系统能源的节省O(12)如果采用前驱+后驱的全时四驱，虽然冲刺时动态性能较好，但是全时四驱顾名思义随时随地都保持四驱状态，但是其耗能较高。(13)如果采用前驱+后驱的分时四驱探索方式，无论是采用前驱或者是后驱时都具有一定的弱点，在转弯探索时角度不是过大，就是不够，转弯动态性能较差； (14)如果采用中驱+后驱的四轮驱动方式进行冲刺，通过释放后驱两轮采用中驱两轮转弯，虽然微微鼠转弯探索性能有所提高，电机的效率也得到一定优化，但是在高速冲刺时会造成重心后偏，需要软件对此进行保护。(15)无论是两轮驱动或者是四轮驱动，在高速冲刺遇到迷宫接缝处具有一定的高度差时，冲刺动态性能都会收到严重影响。(16)基于轮式的微微鼠在冲刺阶段只能被动的适应迷宫地面的打滑程度，随着微微鼠速度的提高，其打滑概率也极大增加，导致求解迷宫失败。微微鼠求解迷宫是国际新兴的一门技术，由于微微鼠技术的难度较高以及迷宫设计的复杂性，导致国内还没有研发此机器人的单位。因此，需要设计一种满足初级者学习微微鼠求解迷宫的高速冲刺控制器。
技术实现思路
本专利技术的目的是解决现有技术的不足，提供一种双核中速六轮微微鼠冲刺控制器，以解决微微鼠在冲刺过程中打滑、传感器相互干扰、处理时间慢等问题。本专利技术采用的技术方案是:为了提高运算速度，保证微微鼠冲刺控制器的稳定性和可靠性，本专利技术在基于STM32F407的控制器中引入精密运动控制专用芯片LM629，形成基于STM32F407+专用运动控制芯片的全新双核控制器，此控制器充分考虑电池在这个系统的作用，把冲刺控制器中工作量最大的六轴行走伺服系统以及单轴真空抽吸伺服系统由STM32F407和LM629配合处理，充分发挥STM32F407数据处理速度较快和LM629伺服调节器的特点，而人机界面、路径优化、轨迹参数、加速度、速度和位置数据存储和计算、I/O控制等功能交给STM32F407完成，这样就实现了 STM32F407与LM629的分工，同时二者之间也可以进行通讯，实时进行数据交换和调用。本专利技术采用的有益效果是:1、在冲刺过程中，充分考虑了电池在这个系统中的作用，基于STM32F407+LM629控制器时刻都在对微微鼠的运行状态进行监测和运算，同时电流传感器C1~C6实时在对电流进行检测并反馈给控制器进行保护，避免了大电流的产生，并且时刻显示锂离子电池的S0C，有利于了解电池的能量状态，由于本专利技术采用永磁直流电机，电机的加速度和电机的电流呈一定比例关系，所以当电池SOC较低时，为了保证冲刺时能量的要求，可以在冲刺前提前换掉电池，从而减少了电池因为放电电流过高对高速冲刺的误干扰。2、为了充分提高多轮微微鼠冲刺控制器的稳定性和行驶能力，并兼顾两轮中置转向的优点，并保证微微鼠的重心位置有利于各种运动，本专利技术采用六轮驱动结构:中置驱动的功率较大，后置和前置驱动的四个个电机功率较小，只有在动力需求较高时才启动，起到助力作用。由于采用六轮驱动技术，微微鼠前后中六个动力轮都有动力，可按迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上，提本文档来自技高网...
【技术保护点】
双核中速六轮微微鼠冲刺控制器，其特征是包括电池装置、传感器装置、辅助导航装置、真空抽吸装置和控制单元模块； 所述电池装置分别电连接控制单元模块、电机X、电机Y和电机M，所述传感器装置和陀螺仪装置分别信号连接控制单元模块，所述控制单元模块分别信号连接电机X、Y和M；所述辅助导航装置包括方向传感器D1、陀螺仪G1和加速度计A1； 所述电池装置分别电连接控制单元模块、电机X、电机Y、电机Z、电机R、电机U、电机W和电机M、，所述传感器装置和陀螺仪装置分别信号连接控制单元模块，所述控制单元模块分别信号连接电机X、Y、Z、R、U、W和M； 所述电机X和电机Y位于中部两侧，电机Z和电机R位于尾部两侧，电机W和电机U位于前部两侧；电机M位于尾部中上部； 所述传感器装置包括位于两侧的红外传感器S1和S6，位于前端的红外传感器S2和S5，所述传感器S1、S6共同作用判断前方挡墙，传感器S2判断其左边挡墙的存在，传感器 S5判断其右边挡墙的存在，同时S2和S5合作为直线运动提供导航依据； 所述控制单元模块包括上位机程序模块和运动控制程序模块，所述上位机程序模块包括STM32F407处理器，所述运动控制程序模块包括LM629处理器，所述LM629处理器包括六轴行走伺服控制单元和单轴真空吸附伺服控制单元，所述STM32F407处理器电性连接LM629处理器，所述六轴行走伺服控制单元信号连接单轴真空吸附伺服控制单元。...
【技术特征摘要】
【专利技术属性】
技术研发人员：张好明，杨锐敏，
申请(专利权)人：铜陵学院，
类型：发明
国别省市：安徽;34
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。