一种单核三轴四轮变结构微微鼠全数字伺服系统控制器的制造方法

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

【发明内容】

[0010] 本发明主要解决的技术问题是提供一种单核三轴四轮变结构微微鼠全数字伺服 系统控制器，为克服单片机不能满足微微鼠求解复杂迷宫的要求，参考国产微电脑鼠所采 用的单机工作模式，在吸收国外先进控制思想的前提下，自主研发了基于STM32F405的全数 字三轴四轮微微鼠伺服控制器，控制板以STM32F405为处理核心，实现微微鼠探索迷宫和微 微鼠在迷宫中冲刺时数字信号的实时处理，并实现对两轴驱动控制芯片A3906SESTR-T的实 时输入和输出控制，快速响应中断，实现数据通信和存储实时信号。
[0011] 为解决上述技术问题，本发明采用的一个技术方案是：提供了一种单核三轴四轮 变结构微微鼠全数字伺服系统控制器，包括微微鼠壳体、车轮、第一红外传感器、第二红外 传感器、第三红外传感器、第四红外传感器、第五红外传感器、第六红外传感器、第一高速直 流伺服电机、第二高速直流伺服电机、真空吸附电机、第一磁电编码器、第二磁电编码器、运 动传感器以及采集传感器，四个所述的车轮分别两两设置在微微鼠壳体的左右两侧边，所 述的第一红外传感器和第六红外传感器分别设置在微微鼠壳体的左右两侧边并位于车轮 的前端，所述的第二红外传感器和第五红外传感器设置在微微鼠壳体的前端，所述的第三 红外传感器斜向设置在第一红外传感器和第二红外传感器之间，所述的第四红外传感器斜 向设置在第五红外传感器和第六红外传感器之间，所述的第一高速直流伺服电机和第二高 速直流伺服电机分别安装在微微鼠壳体的左右两边并位于两个车轮之间的位置，所述的真 空吸附电机设置在第一高速直流伺服电机和第二高速直流伺服电机上方的中间位置，所述 的第一磁电编码器和第二磁电编码器分别设置在第一高速直流伺服电机和第二高速直流 伺服电机的下方，所述的运动传感器和采集传感器依次设置在真空吸附电机的下方。
[0012] 在本发明一个较佳实施例中，所述的第三传感器和第四传感器斜向设置时与Y轴 之间的夹角大小为：45G <沒<608。
[0013] 在本发明一个较佳实施例中，所述的第一磁电编码器和第二磁电编码器均采用基 于磁电传感器AS5040H的编码器。
[0014] 在本发明一个较佳实施例中，所述的车轮上均设置有真空吸盘。
[0015] 在本发明一个较佳实施例中，所述的单核三轴四轮变结构微微鼠全数字伺服系统 控制器还包括电源装置和控制板，由所述的电源装置单独提供电流驱动所述的控制板，所 述的控制板分别发出第一控制信号、第二控制信号和第三控制信号，由所述的第一控制信 号、第二控制信号和第三控制信号分别控制所述的第二高速直流伺服电机、第一高速直流 伺服电机和真空吸附电机的信号合成之后再控制微微鼠的运动。
[0016] 在本发明一个较佳实施例中，所述的电源装置采用锂离子电池。
[0017]在本发明一个较佳实施例中，所述的控制板采用STM32F405全数字伺服控制， STM32F405全数字伺服控制是基于STM32F405的控制器中引入多轴集成专用驱动芯片 A3906SESTR-T，所述的控制板以STM32F405为处理核心。
[0018]在本发明一个较佳实施例中，所述的单核三轴四轮变结构微微鼠全数字伺服系统 控制器还设置有上位机程序和运动控制程序，所述的上位机程序还包括迷宫探知、迷宫存 储和数据输出，所述的运动控制程序还包括基于STM32F405三轴全数字直流伺服控制、迷宫 定位和模式选择。
[0019]在本发明一个较佳实施例中，所述的基于STM32F405三轴全数字直流伺服控制还 包括相互连接的四轮微微鼠全数字直流伺服控制和基于单轴直流电机吸附摩擦伺服控制， 所述的四轮微微鼠全数字直流伺服控制包括位置模块、速度模块和加速度模块。
[0020] 本发明的有益效果是:本发明的单核三轴四轮变结构微微鼠全数字伺服系统控制 器，提高了单核微微鼠全数字伺服系统的稳定性，真空吸附电机通过真空抽吸装置不停抽 吸微型真空吸盘内的空气，使微型真空吸盘的内外压力不一样，产生一定的负压，使其对带 有灰尘的迷宫地面产生一定的吸附力，有效防止了微微鼠在高速迷宫探索时的地面打滑； 运动传感器可以测量出微微鼠的偏航率，当微微鼠在求解迷宫姿态发生变化超过设定阀值 时，在一个新的采样周期采样控制器就立即对其位置补偿，避免了微微鼠远远偏离中心位 置现象的发生，提高了其快速求解时的稳定性。
【附图说明】
[0021] 为了更清楚地说明本发明实施例中的技术方案，下面将对实施例描述中所需要使 用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于 本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它 的附图，其中： 图1为二轮驱动微微鼠二维图； 图2为微微鼠32*32迷宫示意图； 图3为A3906SESTR-T与两轴电机的连接图示意图； 图4为三轴四轮变结构微微鼠二维原理图； 图5为基于STM32F405三轴四轮变结构微微鼠原理框图； 图6为基于STM32F405三轴四轮变结构微微鼠伺服控制程序框图； 图7为微微鼠导航模式。
【具体实施方式】
[0022]下面将对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施 例仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通 技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范 围。
[0023]如图4所示，本发明实施例包括： 一种单核三轴四轮变结构微微鼠全数字伺服系统控制器，包括微微鼠壳体、车轮、第一 红外传感器S1、第二红外传感器S2、第三红外传感器S3、第四红外传感器S4、第五红外传感 器S5、第六红外传感器S6、第一高速直流伺服电机Y、第二高速直流伺服电机X、真空吸附电 机M、第一磁电编码器M1、第二磁电编码器M2、运动传感器G1以及采集传感器L1，四个所述的 车轮分别两两设置在微微鼠壳体的左右两侧边，所述的第一红外传感器S1和第六红外传感 器S6分别设置在微微鼠壳体的左右两侧边并位于车轮的前端，所述的第二红外传感器S2和 第五红外传感器S5设置在微微鼠壳体的前端，所述的第三红外传感器S3斜向设置在第一红 外传感器S1和第二红外传感器S2之间，所述的第四红外传感器S4斜向设置在第五红外传感 器S5和第六红外传感器S6之间，所述的第一高速直流伺服电机Y和第二高速直流伺服电机X 分别安装在微微鼠壳体的左右两边并位于两个车轮之间的位置，所述的真空吸附电机MS 置在第一高速直流伺服电机Y和第二高速直流伺服电机X上方的中间位置，所述的第一磁电 编码器Ml和第二磁电编码器M2分别设置在第一高速直流伺服电机Y和第二高速直流伺服电 机X的下方，所述的运动传感器G1和采集传感器L1依次设置在真空吸附电机M的下方。其中， 所述的车轮包括X轮、Y轮、R轮和Z轮。
[0024]上述中，所述的第三传感器S1和第四传感器S4斜向设置时与Y轴之间的夹角大小 为
[0025] 在本实施例中，所述的第一磁电编码器Ml和第二磁电编码器M2均采用基于磁电传 感器AS5040H的编码器;所述的车轮上均设置有真空吸盘，吸附性能好。
[0026]如图5所示，所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器还包括电 源装置和控制板，由所述的电源装置单独提供电流驱动所述的控制板，所述的控制板分别 发出第一控制信号、第二控制信号和第三控制信号，由所述的第一控制信号、第二控制信号 和第三控制信号分别控制所述的第二高速直流伺服电机、第一高速直流伺服电机和真空吸 附电机的信号合成之后再控制微微鼠的运动。
[0027] 上述中，所述的电源装置采用锂离子电池;所述的控制板采用STM32F405全数字伺 服控制，STM32F405全数字伺服控制是基于STM32F405的控制器中引入多轴集成专用驱动芯 片A3906SESTR-T，所述的控制板以STM32F405为处理核心。
[0028] STM32F4系列除引脚和软件兼容高性能的F2系列外，F4的主频（168MHz)高于F2系 列（120MHz)，并支持单周期DSP指令和浮点单元、更大的SRAM容量（192 KB，F2为128 KB)、 512KB-1MB的嵌入式闪存以及影像、网络接口和数据加密等更先进的外设。STM32F4系列基 于最新的ARM Cortex M4内核，在现有出色的STM32微控制器产品组合中新增了信号处理 功能，并提高了运行速度;STM32F405X集成了定时器、3个ADC、2个DAC、串行接口、外存接口、 实时时钟、CRC计算单元和模拟真随机数发生器在内的整套先进外设，这些性能使得F4系列 可以较容易满足控制和信号处理功能混合的数字信号控制需求。高效的信号处理功能与 C 〇rteX-M4处理器系列的低能耗、低成本和易于使用的优点的组合，使得其可以为多轴电动 机控制提供灵活解决方案。这些特点使得STM32F405特别适合微微鼠三轴四轮伺服系统的 信号处理。
[0029] 本发明为了减少单核微微鼠全数字伺服系统的体积，舍弃了传统的两轴直流伺服 电机H型驱动桥L6207D，而采用体积更小、电压更小的两轴直流伺服电机驱动桥 A3906SESTR-T，A3906SESTR-T是一种单双路直流电机驱动芯片，A3906旨在用于低电压步 进电动机、单路及双路直流电机的脉宽控制(PWM)，可在各通道输出高达1 A的电流，工作 电压范围为2.5至9 VJ3906SESTR-T内置固定关断时间PWM计时器，根据对芯片外围 采样电阻的选择，设置峰值电流。过流输出标记用于通知控制器电机电流已经达到峰值，可 用于过流保护，上述特点使得A3906SESTR-T特别适合应用于微微鼠的两轴行走伺服系统 中，A3906SESTR-T与微微鼠两轴直流伺服电机的连接图如图3所示，其中INI，IN2，IN3，IN4 和SLEEP信号来自于伺服控制器，控制器通过调整INI，IN2，IN3，IN4的信号来调整其输出信 号0UT1A，0UT1B，0UT2A，0UT2B，继而实现直流伺服电机的四象限运动。
[0030] 如图6所示，所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器还设置有 上位机程序和运动控制程序，所述的上位机程序还包括迷宫探知、迷宫存储和数据输出，所 述的运动控制程序还包括基于STM32F405三轴全数字直流伺服控制、迷宫定位和模式选择。
[0031] 其中，所述的基于STM32F405三轴全数字直流伺服控制还包括相互连接的四轮微 微鼠全数字直流伺服控制和基于单轴直流电机吸附摩擦伺服控制，所述的四轮微微鼠全数 字直流伺服控制包括位置模块、速度模块和加速度模块。
[0032] 为了提高单核微微鼠全数字伺服系统的稳定性，增加微微鼠与地面的接触面积， 减少微微鼠重心的前移、后移或者是侧移，本发明借助齿轮机械结构实现两轴四轮的功能， 左右每轴电机的转轴上配备一个小的机械齿轮，此齿轮和前后两个轮子的大齿轮机械连 接，其中大齿轮的齿为每周60,小齿轮的齿为每周15,通过这样的机械连接使得每个轮子都 变成了动力轮。
[0033] 为了进一步提高单核微微鼠全数字伺服系统的稳定性，防止微微鼠在高速探索时 由于地面灰尘较多而导致行走打滑，本发明在微微鼠伺服硬件系统中加入了微型真空吸附 电机M，在微微鼠运动过程中，真空吸附电机M通过真空抽吸装置不停抽吸微型真空吸盘内 的空气，使微型真空吸盘的内外压力不一样，产生一定的负压，使其对带有灰尘的迷宫地面 产生一定的吸附力，有效防止了微微鼠在高速迷宫探索时的地面打滑。
[0034] 为了进一步提高微微鼠在求解迷宫时的稳定性，本发明在微微鼠伺服硬件系统中 加入了高性能MEMS运动传感器LY3200ALH(运动传感器G1)，LY3200ALH可以测量出微微鼠 的偏航率，LY3200ALH参数时刻被STM32F405控制器记录并计算，当微微鼠在求解迷宫姿态 发生变化超过设定阀值时，在一个新的采样周期控制器就立即对其位置补偿，避免了微微 鼠远远偏离中心位置现象的发生，提高了其快速求解时的稳定性。
[0035] 为了更好的采集迷宫信息和减少红外传感器占用的体积，本发明采用红外传感器 SFH4350代替了传统使用的0PE9954A，红外传感器31、32、33、34、35、36的红外光经侧边挡墙 反馈后会被对应的红外接收器BPW85A接收，然后BPW85A的反馈值经控制器计算后作为当前 位置的反馈，控制器通过这些反馈值调整微微鼠的姿态。
[0036] 为了减少光电编码器占用的提价，并减少灰尘对光电编码器的影响，本发明采用 基于磁电传感器AS5040H的编码器M1、M2替代了传统的光电编码器C1和C2,此传感器可以有 效测量出两轴直流伺服电机运动时的速度和位移，为微微鼠快速探索、冲刺的三闭环伺服 控制提供了可靠依据。
[0037] 在实验中发现，采用四组传感器可以提高传感器的采样频率，有利于提高微微鼠 的速度，但是四组传感器如果补偿做的不好将有可能导致微微鼠求解的是一个错误的迷 宫；如果采用六组传感器探测未知迷宫，求解迷宫一般不会出现错误，但是过多的传感器组 合影响了采样频率，不利于微微鼠速度的提高;为了兼顾不同的国际规则以及迷宫探索的 准确性，本发明自主研发了基于六组传感器自由组合变结构探测迷宫的全新控制模式，所 发明的三轴四轮微微鼠二维结构如图4所示，在图4中，为了更好的探测迷宫，红外传感器S3 和S4与Y轴之间的夹角大小为 :43<?<身<6〇0:，在此区间，传感器配合工作状态最佳。对于探 索无时间要求的国际规则，通过软件开启六组传感器探索模式，红外传感器S1、S6共同作用 判断前方挡墙，红外传感器S2、S3判断其左边挡墙的存在，红外传感器S4、S5判断其右边挡 墙的存在，同时红外传感器S2、S3和S4、S5合作为微微鼠直线运动提供导航依据;对于探索 有时间要求的国际规则，通过软件开启四组传感器模式，传感器S1、S6共同作用判断前方挡 墙，红外传感器S3判断其左边挡墙的存在，红外传感器S4判断其右边挡墙的存在，同时红外 传感器S3和S4合作为微微鼠直线运动提供导航依据。红外传感器S1、S3、S4、S6的红外光经 侧边挡墙反馈后会被对应的红外接收器BPW85A接收，然后BPW85A的反馈值经控制器计算后 作为当前位置的反馈，然后控制器通过这些反馈值调整微微鼠的姿态。
[0038] 综上，本发明为克服单片机不能满足微微鼠求解复杂迷宫的要求，参考国产微电 脑鼠所采用的单机工作模式，在吸收国外先进控制思想的前提下，自主研发了基于 STM32F405的全数字三轴四轮微微鼠伺服控制器，其原理如图5所示:控制板以STM32F405为 处理核心，实现微微鼠探索迷宫和微微鼠在迷宫中冲刺时数字信号的实时处理，并实现对 两轴驱动控制芯片A3906SESTR-T的实时输入和输出控制，快速响应中断，实现数据通信和 存储实时信号。
[0039] 本次发明设计的全数字伺服控制器程序框图如图6。
[0040] 为达上述目的，本发明采取以下技术方案，为了提高三轴四轮微微鼠伺服系统的 运算速度和数字化程度，保证微微鼠系统的稳定性和可靠性，本发明在基于STM32F405的控 制器中引入多轴集成专用驱动芯片A3906SESTR-T，此控制器充分考虑电池在这个系统的作 用，把控制系统中工作量最大的三轴伺服系统、人机界面、迷宫探知、数据存储、数据输出、 模式控制选择等功能交给STM32F405完成，并实现对两轴驱动控制芯片A3906SESTR-T的实 时输入和输出控制。为了提高电机的带载能力并缩小其占用体积，本发明用高速永磁直流 伺服电机代替了普通的直流电机。
[0041 ]参照图4、图5、图6、图7，具体实施步骤是： 对于本文设计的基于STM32F405单核三轴四轮变结构微微鼠全数字伺服控制系统，微 微鼠首先被放在迷宫起始点，在电源打开状态下微微鼠先进入自锁状态，此时控制器开启 真空抽吸电机M，然后微微鼠依靠前方、左右侧面蔽障传感器S1、S3、S4、S6(SS1、S2、S3、S4、 S5、S6)根据实际导航环境传输参数给控制器中的STM32F405，STM32F405把这些环境参数转 化为微微鼠两轴电机要运行的距离、速度和加速度参考值，STM32F405再结合磁电编码器 Ml、M2的反馈生成驱动两轴直流电机的PWM波，STM32F405调整两轴直流伺服电机驱动芯片 A3906SESTR-T的输出信号，A3906SESTR-T驱动两轴直流伺服电机X和Y前进，电机运行参数 经磁电编码器Ml和M2反馈给STM32F405，由STM32F405读取经二次处理后调整A3906SESTR-T 的管脚输出状态，继而改变微微鼠的运动状态。
[0042]参照图6,其具体的功能实现如下： 1) 为了能够实现三轴四轮微微鼠运动，本控制系统引入了直流伺服电机驱动芯片 A3906SESTR-T，但是通过I/O口与STM32F405连接，由STM32F405控制其输入和输出信号，由 A3906SESTR-T控制伺服电机X和伺服电机Y的开通和关断； 2) 打开电源瞬间，STM32F405会对电池电压进行检测，如果低压的话，将禁止 A3906SESTR-T工作，0UT1A、0UT2A、0UT1B和0UT2B均为低电平，高速直流伺服电机X、高速直 流伺服电机Y均不能启动，同时电压传感器VI将工作，并发出报警信号，如果系统电压正常， 控制板首先开启真空吸附电机M，通过抽吸装置先对微型真空吸盘抽吸，使真空吸盘对地面 具有一定的吸附力，控制器并实时检测，如果地面不干净，系统会自动调节真空吸附电机M 加大真空吸盘对地面的吸附力； 3) 在微电脑运动过程中，红外传感器3152、53、54、55、56(六个独立的红外发射管 SFH4350发出的红外光经六个独立的红外接收器BPW85A接受后转化为周围迷宫的信息）判 断周围的环境并送给STM32F405,控制板会根据规则选择开启四组传感器模式或是六组传 感器模式，STM32F405把这些环境参数转化为微微鼠前后左右四轮要运行的距离、速度和加 速度指令值，STM32F405再结合磁电编码器的反馈生成微微鼠运动的速度-时间运动梯形 图，这个梯形包含的面积就是微微鼠电机X、电机Y要运行的距离S，STM32F405然后根据这个 梯形图的加速度和速度距离参数生成驱动两轴高速直流伺服电机X和电机Y的PWM波，由 STM32F405调整A3906SESTR-T的输入信号，A3906SESTR-T驱动两个高速直流伺服电机X和Y 运动，控制器实时检测电机X、电机Y的磁电编码器Ml和M2的反馈，并根据电机X和电机Y速度 大小自动调节电机M的伺服控制，从而改变真空吸盘对地面的吸附力； 4) 在微微鼠运动过程中如果控制器发现迷宫求解出现死循环将向STM32F405发出中断 请求，STM32F405会对中断做第一时间响应，如果STM32F405的中断响应没有来得及处理，微 微鼠的电机X、电机Y将原地自锁； 5 )与电机X、电机Y相对应的磁电编码器Ml和M2会输出其位置信号A和位置信号B，磁电 编码器的位置信号A脉冲和B脉冲逻辑状态每变化一次，STM32F405内的位置寄存器会根据 左右轮的运行方向加1或者是减1; 6) 磁电编码器Ml和M2的位置信号被STM32F405处理后，就产生一个INDEX信号给 STM32F405寄存器，记录电机的绝对位置，然后换算成微微鼠在迷宫中的具体位置，并储存 当前迷宫彳目息； 7) 三轴四轮伺服控制器根据微微鼠在迷宫的具体位置，送相应的加速度、速度和位置 数据等给STM32F405作为参考值，然后STM32F405根据外围干扰情况计算出微微鼠需要更新 的实际加速度、速度和位置信号。控制器根据微微鼠实际的速度信号确定如何调整电机M的 伺服控制，进而改变微微鼠在不同速度下与地面的摩擦系数，满足实际要求； 8) STM32F405根据实际外围磁电传感器Ml和M2传感信号确定电机X、电机Y正反转信号， 从而实现电机的正反转控制； 9) 微微鼠一旦加速、减速、路面灰尘较多时，STM32F405会自动使能真空吸附装置，开启 电机M的伺服控制，微微鼠自然切换到三轴四轮驱动状态，增强了微微鼠的附着力和操控 性； 10) 在微微鼠向前运动过程中，红外传感器S3(或S2、S3)和红外传感器S4(或S4、S5)会 对左右的挡墙进行判断，并记录储存当前迷宫挡墙信息，微微鼠根据前进方向左右挡墙的 迷宫信息进入单墙导航模式或者是双墙导航模式：当红外传感器S3(或S2、S3)和红外传感 器S4(或S4、S5)探测到左右均有挡墙时，全数字微微鼠进入双墙导航模式，此时红外传感器 S3(或S2、S3)和红外传感器S4(或S4、S5)会把探测到的迷宫信息输入到全数字伺服控制器， 控制器把红外实时探测的值与预设定值相比较，当微微鼠快速行走受到外界干扰脱离了设 定中心位置时，探测值将与设定值产生较大偏差，此时传感器G1 (LY3200ALH)记录下当前微 微鼠的偏航率，全数字伺服控制器开始进行实时补偿并通过A3906SESTR-T微调两轴伺服电 机X和Y的PWM波输入，通过此方式可以重新调整微微鼠的姿态，使其重新回到设定中心位 置；当红外传感器S3(或S2、S3)探测到左侧面有挡墙而红外传感器S4(或S4、S5)探测到右侧 无挡墙时，全数字微微鼠进入左墙导航模式，此时红外传感器S3(或S2、S3)会把探测到的迷 宫信息输入到全数字伺服控制器，控制器会把实时探测的值与预设定值想比较，当微微鼠 快速行走受到外界干扰脱离了设定中心位置时，探测值将与设定值产生一定偏差，此时传 感器G1(LY3200ALH)记录下当前微微鼠的偏航率，全数字伺服控制器开始进行实时补偿并 通过A3906SESTR-T微调两轴伺服电机X和Y的PWM波输入，通过此方式可以重新调整微微鼠 的姿态，使其重新回到设定中心位置；当红外传感器S4(或S4、S5)探测到右侧面有挡墙而红 外传感器S3(或S2、S3)探测到左侧无挡墙时时，全数字微微鼠进入右墙导航模式，此时红外 传感器S4(或S4、S5)会把探测到的迷宫信息输入到全数字伺服控制器，控制板会把实时探 测的值与预设定值想比较，当微微鼠快速行走时受到外界干扰脱离了设定中心位置时，探 测值将与设定值产生一定偏差，此时传感器G1 (LY3200ALH)记录下当前微微鼠的偏航率，全 数字伺服控制器开始进行实时补偿并通过A3906SESTR-T微调两轴伺服电机X和Y的PWM波输 入通过此方式可以重新调整微微鼠的姿态，使其重新回到设定中心位置； 11) 当三轴四轮微微鼠在传感器G1 (LY3200ALH)的控制下运动到新地址时，微处理器将 更新其坐标，并判断其坐标是不是(XI，Y1)，如果不是将继续更新其坐标，如果是将通知控 制器已到达目标，然后置返航探索标志为1，微微鼠准备返程探索； 12) 为了能够实现微微鼠在探索和冲刺时准确的坐标计算，微微鼠左右的红外传感器 S3(或S2、S3)和S4(或S4、S5)会时刻对周围的迷宫挡墙和柱子进行探测，如果红外传感器S3 (或S2、S3)或者红外传感器S4(或S4、S5)发现传感器信号发生了较大数值的跃变，则说明微 微鼠进入了从有迷宫挡墙到无迷宫挡墙(或者是从无迷宫挡墙到有迷宫挡墙)状态的变化， STM32F405会根据微微鼠当前运行状态并结合磁电编码器Ml和M2的输入进行精确补偿，彻 底消除微微鼠在复杂迷宫中已经累计的误差； 13) 如果微微鼠在运行过程中遇到故障撞墙时，电机X、电机Y的电流将增大，当超过设 定值时，A3906SESTR-T的电流采集电路将工作，STM32F405将拉低A3906SESTR-T的输入信 号，此时控制器会立即控制A3906SESTR-T停止工作，进而释放电机X、电机Y，从而有效地解 决了堵转问题； 14) 微微鼠在运行过程会时刻检测电池电压，当系统出现低压时，传感器VI将开启并发 出报警提示，有效地保护了锂离子电池； 15) 在微微鼠运动过程中，如果伺服系统转矩出现了脉动干扰，STM32F405会根据当前 状态对电流环加以补偿，快速调整电流环的PID参数，使得系统快速稳定下来，防止转矩脉 动对伺服系统性能的影响； 16) 在微微鼠整个运动过程中，传感器L1会时刻对外界干扰光源进行采集，然后传输给 STM32F405，STM32F405会根据L1的自动补偿外界干扰，减少了外界干扰光源对微微鼠快速 探索和冲刺伺服系统的干扰； 17) 当微微鼠在传感器G1 (LY3200ALH)的控制下回到坐标起点（0，0)，控制器会根据微 微鼠原有的状态更新其信息，如果是第一次返程探索回来，则控制器会根据已有的探测迷 宫信息采用改进洪水算法求解出最佳路径;如果是冲刺返程探索回来，则控制器会根据更 新的探测迷宫信息采用改进洪水算法二次求解出最佳路径，然后控制器根据冲刺速度的大 小自动调整电机M，改变真空吸盘对地面的吸附力，满足快速冲刺时的摩擦需要。
[0043]本发明具有的有益效果是： 1:本发明中的电阻和电容均采用0402封装替代了原有的0603封装，可以更好的减少微 微鼠的体积，有利于微微鼠的微型化发展； 2:本发明STM32F405采用BGA封装替代了原有的LQFP176封装，使得芯片占有的体积更 小，有利于减少微微鼠伺服控制系统的体积，且BGA封装更利于微微鼠伺服控制器芯片的散 执. ， 3:为了充分提高微微鼠伺服系统的稳定性和行驶能力，并兼顾两轮驱动的优点，本发 明舍弃了原有的多动力实时四驱结构，通过齿轮机械结构实现两轴四轮功能，既减少了微 微鼠控制器驱动动力电机的数目，又通过齿轮实现了多轮的功能，提高微微鼠的求解迷宫 时的行走稳定性； 4:由于STM32F405集成了新的DSP和FPU指令，168MHz的高速处理性能提高了数字信号 控制器的执行速度和代码效率，使得微微鼠伺服控制器实时控制性能增加； 5:根据需要实现吸附功能;在微微鼠求解迷宫过程中，一旦遇到路面灰尘较多或加速 状况时，STM32F405会根据两轴电机的磁电编码器反馈立即开启吸附电机M的伺服控制，微 微鼠系统自然切换到三轴四轮驱动状态，增强了微微鼠的附着力和操控性； 6:由于采用两轴四轮驱动结构，增加了微微鼠与地面的接触面积，减少了两轮微微鼠 机械结构造成的失速问题的发生，使得微微鼠具有更好的行走功能； 7:在此微微鼠伺服系统中引入了高性能MEMS运动传感器LY3200ALH，实现了微微鼠在 求解迷宫时的瞬时旋转速度的检测，并利用反馈实现全程导航的实时校正，有利于提高微 微鼠高速行走时的稳定性和动态性能； 8:微微鼠转向时，为了保证旋转的稳定性和准确性，通过传感器LY3200ALH的实时反 馈，基于STM32F405的探索伺服控制器对微微鼠的转弯实时校正，提高了微微鼠求解迷宫信 息的正确性； 9:由STM32F405处理微微鼠求解迷宫期间三只电机的独立伺服控制，使得控制比较简 单，大大提高了运算速度，解决了单片机软件运行较慢的瓶颈，缩短了开发周期短，并且程 序可移植能力强； 10:根据国际规则的不同，控制器通过软件可以实现四组传感器和六组传感器的变结 构切换，提高了微微鼠求解迷宫的技术，有利于提高系统的运算速度； 11:由于采用磁电编码器技术替代了传统的光电编码器技术，使得微微鼠的体积可以 更小，有利于微微鼠微型化的发展； 12:由于采用磁电编码器替代了传统的光电编码器，使得灰尘对编码器的数据采集影 响大大降低，提高了微微鼠高速行走速度和位移的精确性，也保证了微微鼠求解迷宫的准 确性； 13:由于本控制器采用STM32F405处理迷宫存储和探索、冲刺算法，有效地防止了程序 的"跑飞"，抗干扰能力大大增强； 14:在微微鼠运行过程中，控制器会对高速直流伺服电机X、电机Y和电机M的转矩进行 在线辨识并利用电机力矩与电流的关系进行补偿，减少了电机转矩抖动对微微鼠快速探 索、快速冲刺的影响； 15:通过调节电机M可以有效调节真空吸盘对地面的吸附力，消除了微微鼠在高速探 索、高速冲刺时打滑现象的发生； 16:由于具有存储功能，这使得微微鼠掉电后可以轻易的调取已经探索好的迷宫信息， 使二次探索的时间和路径大大降低； 17:在控制中，STM32F405可以根据实际周围迷宫情况调整控制器内部的PID参数，轻松 实现分段P、H)、PID控制和非线性PID控制，使系统具有一定的自适应能力； 18:在运动过程中，伺服控制系统充分考虑了电池在这个系统中的作用，基于 STM32F405+A3906SESTR-T控制器时刻都在对微微鼠的运行状态进行监测和运算，由于 A3906SESTR-T内部集成了电流采集电路，时刻对电机的电流可以进行采集，从根本上避免 了大电流的产生，所以解决了大电流对锂离子电池的冲击，避免了由于大电流放电而引起 的锂离子电池过度老化现象的发生； 19:A3906SESTR-T的电流采集功能可以很好的解决微微鼠在运行过程中遇到撞墙等情 况发生的电机堵转，当输出超出设定值时，A3906SESTR-T的电流采集电路立即工作，直流电 机X、电机Y的驱动信号被拉低，从而有效地解决了堵转问题。
[0044]综上所述，本发明的单核三轴四轮变结构微微鼠全数字伺服系统控制器，提高了 单核微微鼠全数字伺服系统的稳定性，真空吸附电机通过真空抽吸装置不停抽吸微型真空 吸盘内的空气，使微型真空吸盘的内外压力不一样，产生一定的负压，使其对带有灰尘的迷 宫地面产生一定的吸附力，有效防止了微微鼠在高速迷宫探索时的地面打滑;运动传感器 可以测量出微微鼠的偏航率，当微微鼠在求解迷宫姿态发生变化超过设定阀值时，在一个 新的采样周期采样控制器就立即对其位置补偿，避免了微微鼠远远偏离中心位置现象的发 生，提尚了其快速求解时的稳定性。
[0045]以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发 明说明书内容所作的等效结构或等效流程变换，或直接或间接运用在其它相关的技术领 域，均同理包括在本发明的专利保护范围内。
【主权项】
1. 一种单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征在于，包括微微鼠 壳体、车轮、第一红外传感器、第二红外传感器、第三红外传感器、第四红外传感器、第五红 外传感器、第六红外传感器、第一高速直流伺服电机、第二高速直流伺服电机、真空吸附电 机、第一磁电编码器、第二磁电编码器、运动传感器以及采集传感器，四个所述的车轮分别 两两设置在微微鼠壳体的左右两侧边，所述的第一红外传感器和第六红外传感器分别设置 在微微鼠壳体的左右两侧边并位于车轮的前端，所述的第二红外传感器和第五红外传感器 设置在微微鼠壳体的前端，所述的第三红外传感器斜向设置在第一红外传感器和第二红外 传感器之间，所述的第四红外传感器斜向设置在第五红外传感器和第六红外传感器之间， 所述的第一高速直流伺服电机和第二高速直流伺服电机分别安装在微微鼠壳体的左右两 边并位于两个车轮之间的位置，所述的真空吸附电机设置在第一高速直流伺服电机和第二 高速直流伺服电机上方的中间位置，所述的第一磁电编码器和第二磁电编码器分别设置在 第一高速直流伺服电机和第二高速直流伺服电机的下方，所述的运动传感器和采集传感器 依次设置在真空吸附电机的下方。2. 根据权利要求1所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征在 于，所述的第三传感器和第四传感器斜向设置时与Y轴之间的夹角大小为3. 根据权利要求1所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征 在于，所述的第一磁电编码器和第二磁电编码器均采用基于磁电传感器AS5040H的编码器。4. 根据权利要求1所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征 在于，所述的车轮上均设置有真空吸盘。5. 根据权利要求1所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征 在于，所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器还包括电源装置和控制 板，由所述的电源装置单独提供电流驱动所述的控制板，所述的控制板分别发出第一控制 信号、第二控制信号和第三控制信号，由所述的第一控制信号、第二控制信号和第三控制信 号分别控制所述的第二高速直流伺服电机、第一高速直流伺服电机和真空吸附电机的信号 合成之后再控制微微鼠的运动。6. 根据权利要求5所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征 在于，所述的电源装置采用锂离子电池。7. 根据权利要求5所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征 在于，所述的控制板采用STM32F405全数字伺服控制，STM32F405全数字伺服控制是基于 STM32F405的控制器中引入多轴集成专用驱动芯片A3906SESTR-T，所述的控制板以 STM32F405为处理核心。8. 根据权利要求1所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征 在于，所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器还设置有上位机程序和运 动控制程序，所述的上位机程序还包括迷宫探知、迷宫存储和数据输出，所述的运动控制程 序还包括基于STM32F405三轴全数字直流伺服控制、迷宫定位和模式选择。9. 根据权利要求8所述的单核三轴四轮变结构微微鼠全数字伺服系统控制器，其特征 在于，所述的基于STM32F405三轴全数字直流伺服控制还包括相互连接的四轮微微鼠全数 字直流伺服控制和基于单轴直流电机吸附摩擦伺服控制，所述的四轮微微鼠全数字直流伺 服控制包括位置模块、速度模块和加速度模块。
【文档编号】G05D1/02GK105892470SQ201610506941
【公开日】2016年8月24日
【申请日】2016年7月1日
【发明人】张好明, 陈阳
【申请人】江苏若博机器人科技有限公司