本发明专利技术公开了双核高速两轮微微鼠全数字导航伺服控制器，包括底盘，所述底盘上设有电池装置、传感器装置、陀螺仪装置G、真空抽吸装置和控制单元模块，所述底盘两侧连接运动轮。本发明专利技术通过位于底盘下的真空抽吸装置解决了微微鼠在行走中打滑的现象，同时根据微微鼠前进的速度以及地面情况自动调节真空抽吸直流电机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)微微鼠在导航行走过程中，一旦遇到撞墙情况都会发生电机堵转情况，造成电机瞬间电流过大，严重时烧坏电机。微微鼠求解迷宫是国际新兴的一门技术，由于微微鼠技术的难度较高以及迷宫设计的复杂性，导致国内还没有研发此机器人的单位。因此，需要设计一种满足初级者学习微微鼠求解迷宫的全数字导航伺服控制器。
技术实现思路
本专利技术的目的是解决现有技术的不足，提供一种双核高速两轮微微鼠全数字导航伺服控制器，以解决微微鼠在导航行走过程中打滑、传感器相互干扰、处理时间慢等问题。本专利技术采用的技术方案是:基于STM32F407+FPGA芯片的全新控制模式，其程序框图如图4所示。全数字微微鼠两轴伺服控制系统以FPGA微处理器为核心，充分发挥FPGA数据处理速度较快的特点，使其全权处理三轴直流伺服系统的各种算法，把STM32F407从复杂的数据处理中解脱出来。其中伺服系统位置、速度、电流的给定值由微处理器STM32F407根据传感器S1、S2、S5、S6的导航值来生成，光电编码器反馈和电机的检测电流经FPGA内部算法解码后作为三闭环伺服控制的反馈值，经FPGA内部PID调节后生成控制三轴电机的PffM波。同时STM32F407实现部分的信号处理算法(直流电机转矩补偿等)和FPGA的控制逻辑，并响应中断，实现二者之间的数据通信和存储实时信号。双核高速两轮微微鼠全数字导航伺服控制器，包括底盘，所述底盘上设有电池装置、传感器装置、陀螺仪装置G、真空抽吸装置和控制单元模块，所述底盘两侧连接运动轮；所述电池装置电连接控制单元模块，所述传感器装置和陀螺仪装置分别信号连接控制单元模块，所述控制单元模块分别信号连接电机X、Y和M ;所述电机X和电机Y分别传动联接运动轮，所述电机M传动联接真空抽吸装置，所述抽真空装置连接真空吸盘，所述真空吸盘位于底盘底部；所述陀螺仪装置G位于底盘的中心位置；所述传感器装置包括位于底盘两侧的红外传感器SI和S6，位于底盘前端的红外传感器S2和S5，所述传感器S1、S6共同作用判断前方挡墙，传感器S2判断其左边挡墙的存在，传感器S5判断其右边挡墙的存在，同时S2和S5合作为直线运动提供导航依据；所述控制单元模块包括STM32F407处理器、FPGA处理器、两轴行走伺服控制单元和单轴真空吸附伺服控制单元，所述STM32F407处理器电性连接FPGA处理器，所述两轴行走伺服控制单元信号连接单轴真空吸附伺服控制单元。双核高速两轮微微鼠全数字导航伺服控制方法，其步骤如下:1)电压检测:检测电池电压、传感器电路和时钟电路；2)底盘真空抽吸:STM32F407控制器首先开启真空抽吸直流电机M，通过真空抽吸装置先对真空吸盘抽吸，使真空吸盘对地面具有一定的吸附力，STM32F407控制器实时检测；3)迷宫行走:判断周围的环境并送给STM32F407，STM32F407把这些环境参数转化为微微鼠左右轮要运行的位置、速度和加速度指令值，并把这些值传输给FPGA，然后FPGA再结合光电编码器的反馈、电流传感器C1、C2的反馈经其内部三闭环伺服系统算法得到驱动两轴直流电机运行的PWM波，并通过驱动桥驱动两个独立直流电机X和电机Y向前运动；4)调整纠错:光补偿传感器LI会时刻对外界干扰光源进行采集，然后传输给STM32F407，STM32F407会根据LI的数值自动补偿外界干扰，减少了外界干扰光源对微微鼠导航时的干扰；5)坐标检测:装在微微鼠上的高速永磁直流电机X和电机Y上的光电编码器的位置信号A脉冲、B脉冲和Z当前第1页1 2 3 4 本文档来自技高网...
【技术保护点】
双核高速两轮微微鼠全数字导航伺服控制器，其特征是包括底盘，所述底盘上设有电池装置、传感器装置、陀螺仪装置G、真空抽吸装置和控制单元模块，所述底盘两侧连接运动轮； 所述电池装置电连接控制单元模块，所述传感器装置和陀螺仪装置分别信号连接控制单元模块，所述控制单元模块分别信号连接电机X、Y和M； 所述电机X和电机Y分别传动联接运动轮，所述电机M传动联接真空抽吸装置，所述抽真空装置连接真空吸盘，所述真空吸盘位于底盘底部； 所述陀螺仪装置G位于底盘的中心位置； 所述传感器装置包括位于底盘两侧的红外传感器S1和S6，位于底盘前端的红外传感器S2和S5，所述传感器S1、S6共同作用判断前方挡墙，传感器S2判断其左边挡墙的存在，传感器 S5判断其右边挡墙的存在，同时S2和S5合作为直线运动提供导航依据； 所述控制单元模块包括STM32F407处理器、FPGA处理器、两轴行走伺服控制单元和单轴真空吸附伺服控制单元，所述STM32F407处理器电性连接FPGA处理器，所述两轴行走伺服控制单元信号连接单轴真空吸附伺服控制单元。
【技术特征摘要】
【专利技术属性】
技术研发人员：张好明，杨锐敏，
申请(专利权)人：铜陵学院，
类型：发明
国别省市：安徽;34
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。