CN203643836U - 基于双核四轮微电脑鼠及其超快速探索控制器 - Google Patents
基于双核四轮微电脑鼠及其超快速探索控制器 Download PDFInfo
- Publication number
- CN203643836U CN203643836U CN201320569873.5U CN201320569873U CN203643836U CN 203643836 U CN203643836 U CN 203643836U CN 201320569873 U CN201320569873 U CN 201320569873U CN 203643836 U CN203643836 U CN 203643836U
- Authority
- CN
- China
- Prior art keywords
- computer mouse
- micro computer
- wheel
- motor
- sensor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Abstract
本实用新型公开了一种基于双核四轮微电脑鼠及其快速探索控制器,所述探索控制器包括FPGA处理器、ARM处理器、电压传感器、光电补偿传感器、至少六个蔽障传感器和四个运动控制系统,所述FPGA处理器与每一个所述运动控制系统电性连接,所述ARM处理器分别与电压传感器、光电补偿传感器和每一个蔽障传感器电性连接。通过上述方式,本实用新型同时采用双核协同工作处理数据,运算速度较快,避免了大电流的产生;采用四轮驱动结构,可依据迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上,转弯方便,稳定性较好,提高了微电脑鼠的行驶能力。
Description
技术领域
本实用新型涉及微型机器人领域,尤其涉及一种基于双核四轮微电脑鼠及其超快速探索控制器。
背景技术
微电脑鼠是使用嵌入式微控制器、传感器和机电运动部件构成的一种智能行走机器人,在国外已经竞赛了将近30年,由其原理可以转化为多种实际的工业机器人,近几年内才引进国内,并逐渐成为一个新兴的竞赛项目。微电脑鼠可以在不同“迷宫”中自动记忆和选择路径,采用相应的算法,快速地到达所设定的目的地。一只优秀的微电脑鼠必须具备良好的感知能力,有良好的行走能力,优秀的智能算法,一只完整的微电脑鼠在大体分为以下几个部分:
1)传感器:传感器是微电脑鼠的眼睛,是微电脑鼠准确获取外部环境信息的依据,然后把外界信息输送到微处理器进行各种条件判断。
2)电机:执行电机是微电脑鼠的动力源,它根据微处理器的指令来执行微电脑鼠在迷宫中行走时的相关动作。
3)算法:算法是微电脑鼠的灵魂。微电脑鼠必须采用一定的智能算法才能找到终点,才能找到一条最短的路径,在最短的时间内到达终点。
4)微处理器:微处理器是微电脑鼠的核心部分,是微电脑鼠的大脑。微电脑鼠所有的信息,包括墙壁信息,位置信息,角度信息和电机状态信息等都需要经过微处理器处理并做出相应的判断。
微电脑鼠结合了多学科知识,对于提升在校学生的动手能力、团队协作能力和创新能力,促进学生课堂知识的消化和扩展学生的知识面都非常有帮助。另外电脑鼠走迷宫极具趣味性,容易得到学生的认同及参与,并能很好的激发和引导学生这方面的兴趣和爱好。其开展必然提升参赛者在相关领域的技术水平和应用能力,为技术创新提供平台。可以培养大批相关领域的人才,进而促进相关领域的技术发展和产业化进程。由于国内研发此机器人的单位较少,对国际规则读取水平较低,相对研发水平比较落后,研发的微电脑鼠结构如图1,长时间运行发现存在着很多安全问题,即:
(1)作为微电脑鼠的眼睛采用的是超声波或者是一般的红外传感器,使得微电脑鼠对周围迷宫的探索存在一定的误判。
(2)作为微电脑鼠的执行机构采用的是步进电机,经常会遇到丢失脉冲的问题出现,导致对位置的记忆出现错误。
(3)由于采用步进电机,使得机体发热比较严重,不利于在大型复杂迷宫中探索和冲刺。
(4)由于采用比较低级的算法,在迷宫当中的探索一般都要花费4~5分钟的时间,这使得在真正的大赛中无法取胜。
(5)由于微电脑鼠要频繁的刹车和启动,加重了单片机的工作量,单一的单片机无法满足微电脑鼠快速启动和停止的要求。
(6)相对采用的都是一些体积比较大的插件元器件,使得微电脑鼠的体积比较庞大,无法满足快速探索的要求。
(7)由于受周围环境不稳定因素干扰,单片机控制器经常会出现异常,引起微电脑鼠失控,抗干扰能力较差。
(8)对于差速控制的微电脑鼠来说,一般要求其两个电机的控制信号要同步,但是对于单一单片机来说又很难办到,使得微电脑鼠在直道上行驶的时候要来回的补偿,而且有的时候在迷宫当中摇摆幅度较大,特别是对于快速探索时。
(9)由于受单片机容量和算法影响,微电脑鼠对迷宫的信息没有存储,当遇到掉电情况时所有的信息将消失,这使得整个探索过程要重新开始。
(10)由于受单片机容量影响,现有的微电脑鼠基本上都只有两个动力驱动轮,采用两轮差速方式行驶,使得系统对两轴的伺服要求较高,特别是直线导航时,要求速度和加速度要追求严格的一致,否则直线导航将会失败,导致微电脑鼠出现撞墙的现象发生;
(11)四轮微电脑鼠系统在加速时由于重心后移,使得老鼠前部轻飘,即使在良好的路面上微电脑鼠也会打滑,有可能导致撞墙的现象出现,不利于高速微电脑鼠的发展。
(12)四轮微电脑鼠系统在正常行驶时如果设计不当造成重心前偏,将导致驱动轮上承受的正压力减小,这时微电脑鼠系统更加容易打滑,也更容易走偏,导致导航失败。
(13)四轮微电脑鼠系统在正常行驶时如果设计不当造成重心侧偏将导致两个驱动轮承受的正压力不同,在快速启动时两轮打滑程度不一致,瞬间就偏离轨迹,转弯时,其中正压力小的轮子可能打滑,导致转弯困难。
(14)由于采用两个动力轮驱动,为了满足复杂状态下的加速和减速,使得单个驱动电机的功率较大,不仅占用的空间较大,而且有时候在一些相对需求能量较低的状态下造成“大马拉小车”的现象出现,不利于微电脑鼠本体微型化发展和微电脑鼠系统能源的节省。
因此,需要对现有的基于单片机控制的微电脑鼠控制器进行重新设计。
实用新型内容
本实用新型主要解决的技术问题是提供一种基于双核四轮微电脑鼠超快速探索控制器,同时采用双核协同工作处理数据,运算速度较快,避免了大电流的产生;采用四轮驱动结构,可依据迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上,转弯方便,稳定性较好,提高了微电脑鼠的行驶能力。
为解决上述技术问题,本实用新型采用的一个技术方案是:提供一种基于双核四轮微电脑鼠超快速探索控制器,应用于四轮微电脑鼠中,所述探索控制器包括FPGA处理器、ARM处理器、电压传感器、光电补偿传感器、至少六个蔽障传感器和四个运动控制系统,所述FPGA处理器与每一个所述运动控制系统电性连接,所述ARM处理器分别与FPGA处理器、电压传感器、光电补偿传感器和每一个蔽障传感器电性连接。
在本实用新型一个较佳实施例中,所述运动控制系统包括运动控制器和电机,所述运动控制器与所述电机电性连接。
在本实用新型一个较佳实施例中,所述运动控制器包括伺服控制单元、数据存储单元和输入输出接口单元。
在本实用新型一个较佳实施例中,所述探索控制器包括上位机控制单元,所述上位机控制单元与所述ARM9处理器电性连接,所述运动控制单元与所述FPGA处理器电性连接,所述上位机控制单元包括迷宫读取单元、坐标定位单元和在线输出单元。
在本实用新型一个较佳实施例中,所述蔽障传感器包括红外发射器OPE5594A和红外接收器TSL262。
在本实用新型一个较佳实施例中,两个所述红外发射器的信号发射方向与所述四轮微电脑鼠的运动方向相同,两个所述红外发射器的信号发射方向相反且垂直于所述四轮微电脑鼠的运动方向,两个所述红外发射器的信号发射方向关于所述四轮微电脑鼠的运动方向对称且与所述四轮微电脑鼠的运动方向成45°夹角,其它所述红外发射器的信号发射方向与所述四轮微电脑鼠的运动方向的夹角为锐角。
本实用新型还提供一种四轮微电脑鼠,包括所述探索控制器,所述探索控制器包括FPGA处理器、ARM处理器、电压传感器、光电补偿传感器、至少六个蔽障传感器和四个运动控制系统,所述FPGA处理器与每一个所述运动控制系统电性连接,所述ARM处理器分别与电压传感器、光电补偿传感器和每一个蔽障传感器电性连接,所述四轮微电脑鼠进一步包括壳体和四个车轮,所述壳体两侧分别设置两个所述车轮,每一个所述车轮与一个所述电机连接,每一个电机的转轴上设置光电编码器,所述壳体内部设置所述探索控制器。
在本实用新型一个较佳实施例中,所述四轮微电脑鼠进一步包括四个陀螺仪,每一个所述陀螺仪与一个所述车轮的转轴连接。
本实用新型的有益效果是:
1、在运动过程中,充分考虑了电池在这个系统中的作用,基于ARM9+FPGA控制器时刻都在对小车的运行状态进行监测和运算,避免了大电流的产生,所以从根本上解决了大电流对锂离子电池的冲击,避免了由于大电流放电而引起的锂离子电池过度老化现象的发生。
2:为了充分提高微电脑鼠探索伺服系统的稳定性和行驶能力,本实用新型采用四轮驱动结构,前置驱动和后置驱动的四个电机功率一致,四轮伺服运动均有ARM+FPGA配合完成,微电脑鼠前后四个轮都有动力,可按迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上,以提高微电脑鼠的行驶能力。
3:在正常行驶环境下,四轮微电脑鼠一般会采用释放前轮,采用后轮驱动的方式;而一旦遇到路面灰尘较多或驱动轮打滑的情况,ARM9会自动检测并立即将微电脑鼠需求扭矩部分分配给前方两个驱动轮,系统自然切换到四轮驱动状态,增强了微电脑鼠探索时的附着力和操控性。
4:由于采用四轮驱动方式,当需要加速行驶时,把动力平均分配到四个电机,一旦一个动力轮离开地面,ARM9可以重新分配扭矩,把更多的扭矩分配在不打滑的驱动轮上,使系统迅速脱离打滑状态,重新回到四轴动力平衡状态,使得微电脑鼠具有更好的直线行走功能。
5:微电脑鼠探索转向时,为了保证旋转的稳定性,采用四轮同控来实现转弯,防止了微电脑鼠转弯探索时出现打滑的现象。
6:四轮微电脑鼠系统在正常行驶时如果设计不当造成重心前偏,将导致后侧驱动轮上承受的正压力减小,ARM9会自动调整后侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠打滑。
7:四轮微电脑鼠系统在正常行驶时如果设计不当造成重心侧偏,将导致一侧驱动轮上承受的正压力减小,ARM9会自动调整这一侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠打滑。
8:由FPGA处理微电脑鼠的四只直流电机的同步伺服控制,使得控制比较简单,大大提高了运算速度,解决了单片机软件运行较慢的瓶颈,缩短了开发周期短,并且程序可移植能力强。
9:本实用新型基本实现全贴片元器件材料,实现了单板控制,不仅节省了控制板占用空间,而且还实现了微电脑鼠的速度大小和方向的独立控制,有利于提高微电脑鼠的稳定性和动态性能。
10:为了提高运算速度和精度,本微电脑鼠采用了国际上使用最多的红外传感器OPE5594A,使得运算精度大大提高。
11:由于本控制器采用FPGA处理大量的数据与算法,并充分考虑了周围的干扰源,并把ARM9从繁重的工作量中解脱出来,有效地防止了程序的“跑飞”,抗干扰能力大大增强。
12:为了更好的保护电池,当系统在探索过程中遇到低压时,微电脑鼠上的低压报警传感器会自动开启,并限制放电电流,保证微电脑鼠可以完成整个探索,在探索完成回到起点时,会自动锁死在当前位置,并记录下迷宫信息,提示更换电池。
13:在微电脑鼠运行过程中,ARM9会对电机的转矩进行在线辨识并利用电机力矩与电流的关系进行补偿,减少了电机转矩抖动对微电脑鼠快速探索迷宫信息的影响。
14:由于微电脑鼠的速度和方向独立控制,使得微电脑鼠更容易实现前进、倒退、左转和右转各个方向的运动。
15:由于具有存储功能,这使得微电脑鼠掉电后可以轻易的调取已经探索好的迷宫信息,使二次探索的时间和路径大大降低。
附图说明
为了更清楚地说明本实用新型实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本实用新型的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图,其中:
图1是现有技术中的微电脑鼠的冲刺控制器的电路结构框图;
图2是本实用新型所述探索控制器的电路结构框图;
图3是本实用新型所述微电脑鼠运动时的迷宫坐标示意图;
图4是本实用新型所述微电脑鼠一较佳实施例的结构示意图;
图5是本实用新型所述微电脑鼠的前进示意图;
图6是本实用新型所述微电脑鼠的后退示意图;
图7是本实用新型所述微电脑鼠的右进示意图;
图8是本实用新型所述微电脑鼠的左退示意图。
附图中各部件的标记如下:1、壳体,2、车轮,S1、第一个蔽障传感器,S2、第二个蔽障传感器,S3、第三个蔽障传感器,S4、第四个蔽障传感器,S5、第五个蔽障传感器,S6、第六个蔽障传感器,S7、光电补偿传感器,S8、电压传感器。
具体实施方式
下面将对本实用新型实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本实用新型的一部分实施例,而不是全部的实施例。基于本实用新型中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本实用新型保护的范围。
请参阅图1至图8,本实用新型实施例包括:
一种基于双核四轮微电脑鼠超快速探索控制器,应用于四轮微电脑鼠中,所述探索控制器包括FPGA处理器、ARM处理器、电压传感器S8、光电补偿传感器S7、至少六个蔽障传感器和四个运动控制系统,所述FPGA处理器与每一个所述运动控制系统电性连接,所述ARM处理器分别与FPGA处理器、电压传感器S8、光电补偿传感器S7和每一个蔽障传感器电性连接。所述运动控制系统包括运动控制器和电机,所述运动控制器包括伺服控制单元、数据存储单元和输入输出接口单元,所述运动控制器与所述电机电性连接,四个电机编号为X、Y、Z、R。
本实用新型所述探索控制器进一步包括上位机控制单元,所述上位机控制单元与所述ARM9(S3C2440A)处理器电性连接,所述上位机控制单元包括迷宫读取单元、坐标定位单元和在线输出单元。
此外,所述蔽障传感器包括红外发射器OPE5594A和红外接收器TSL262。其中,两个所述红外发射器的信号发射方向与所述四轮微电脑鼠的运动方向相同,两个所述红外发射器的信号发射方向相反且垂直于所述四轮微电脑鼠的运动方向,两个所述红外发射器的信号发射方向关于所述四轮微电脑鼠的运动方向对称且与所述四轮微电脑鼠的运动方向成45°夹角,其它所述红外发射器的信号发射方向与所述四轮微电脑鼠的运动方向的夹角为锐角。在本实施例中,所述蔽障传感器的数量为6个,分别编号为S1、S2、S3、S4、S5、S6。
本实用新型还提供一种四轮微电脑鼠,包括权利要求所述的探索控制器,所述四轮微电脑鼠进一步包括壳体1和四个车轮2,所述壳体1两侧分别设置两个所述车轮2,每一个所述车轮2与一个所述电机连接,每一个电机的转轴上设置光电编码器,所述光电编码器采用512线光码盘,每转一转输出512个脉冲。所述壳体1内部设置所述探索控制器。所述四轮微电脑鼠进一步包括四个陀螺仪,每一个所述陀螺仪与一个所述车轮2的转轴连接。
在具体应用时,本实用新型开发时采用ARM9(S3C2440A)和FPGA(A3P250)作为开发板核心,所述电脑鼠基本实现全贴片元器件材料,实现了单板控制,不仅节省了控制板占用空间,而且有利于体积和重量的减轻,有利于提高微电脑鼠伺服系统的稳定性和动态性能。
本实用新型所述微电脑鼠的工作原理为:
1)对于本文设计的双核控制器,先把微电脑鼠放在迷宫起始点,在电源打开状态下,微电脑鼠先进入自锁状态,然后微电脑鼠依靠前方、左右侧面蔽障传感器S1、S2、S3、S4、S5 、S6开始探索未知迷宫,传感器把实际导航环境传输参数给双核控制器中的ARM9(S3C2440A),ARM9(S3C2440A)把这些环境参数转化为微电脑鼠运动的位置、速度和加速度参数指令值,然后与FPGA(A3P250)通讯,FPGA(A3P250)结合外部的光电编码器和电流传感器的反馈信息生成四轴直流电机伺服系统的PWM波形和控制方向信号,并把处理数据通讯给ARM9(S3C2440A),由ARM9(S3C2440A)继续处理后续探索的运行状态。
2)在微电脑鼠未接到探索命令之前,它一般会在起点坐标(0,0)等待控制器发出的探索命令,一旦接到任务后,会沿着起点开始向终点(7,7)、(7,8)、(8,7)、(8,8)探索。
3)微电脑鼠放在起点坐标(0,0),接到任务后其前方的传感器S1、S6和会对前方的环境进行判断,确定有没有挡墙进入运动范围,如存在挡墙将向ARM9(S3C2440A)发出中断请求,ARM9(S3C2440A)会对中断做第一时间响应,如果ARM9(S3C2440A)的中断响应没有来得及处理,微电脑鼠的四个电机X、电机Y、电机Z和电机R将原地自锁,然后二次判断迷宫确定前方信息,防止信息误判;确定无误后,二次启动探索命令。
4)在微电脑鼠正常探索加速启动瞬间,ARM9(S3C2440A)立即通过FPGA(A3P250)使能前轴和后轴的四个直流电机,把微电脑鼠需求扭矩平均分配到四个电机,然后通过按照既定的速度-时间运动梯形图由FPGA(A3P250)结合光电编码器和电流传感器反馈信号生成四轴同步PWM波形,驱动四轮微电脑鼠在预定的加速距离S1范围内加速至设定的直线探索速度,完成微电脑鼠的加速,然后ARM9(S3C2440A)立即通过FPGA(A3P250)释放前轴的两个直流电机,系统进入两轮驱动状态。
5)在微电脑鼠沿着Y轴向前运动,在任何一个方格的中心如果确定没有迷宫挡墙进入前方的运动范围,则微电脑鼠将存储其坐标(X,Y),并把向前运动一格的位置参数传输给ARM9(S3C2440A),然后ARM9(S3C2440A)会把此参数按照时间要求转化为位置参数、速度参数以及加速度参数指令值,然后通过中断控制把这些参考指令值传输给FPGA(A3P250),FPGA(A3P250)使能后驱的电机X和电机Y,FPGA(A3P250)根据这些参数结合光电编码盘和电流传感器的反馈生成电机X和电机Y的PWM波形和方向信号,经驱动桥控制左右轮的电机X和电机Y向前运动,并记录下时刻运动的距离S。如果在探索运动过程中,出现打滑或者是灰尘较多的状况时, ARM9(S3C2440A)把剩余的距离转化为新的参考指令值传输给FPGA(A3P250),FPGA(A3P250)使能四个电机,内部的梯形运动发生器会根据这些参数结合光电编码盘和电流传感器的反馈生成驱动前后左右四轮的PWM波形和方向信号,经驱动桥控制前后左右轮的电机X、电机Y、电机Z和电机R向前运动,当到达设定目标时,将更新其坐标为(X,Y+1),在Y+1<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经搜索到目标,然后置返航探索标志为1,微电脑鼠准备返程探索。
6)在微电脑鼠沿着Y轴向前运动过程中如果有迷宫挡墙进入前方的运动范围,并且此时左右的传感器S2、S3、S4、S5判断左右都有挡墙时,微电脑鼠将存储此时坐标(X,Y),根据传感器S1和S6的反馈计算出向前运动停车的位置参数S1,并把向前运动停止的位置参数S1传输给ARM9(S3C2440A),然后ARM9(S3C2440A)会把此参数按照时间要求转化为位置参数、速度参数以及加速度参数传输给FPGA(A3P250)作为指令值,FPGA(A3P250)使能前驱和后驱的四个电机,系统进入四驱系统。FPGA(A3P250)内部的梯形运动发生器会根据这些参数结合光电编码器和电流传感器的反馈生成驱动前后左右四轮的PWM波形和方向信号,控制前后左右四轮的电机X、电机Y、电机Z和电机R在预定距离里准确停车;然后ARM9(S3C2440A)使能FPGA(A3P250),使其发出的PWM信号控制左侧的电机正转,右侧的电机反转,微电脑鼠在陀螺仪的控制下原地调转180度,然后微电脑鼠沿着Y轴反向运动;在其Y轴反向运动过程中,把向前运动一格的位置参数参数传输给ARM9(S3C2440A),然后ARM9(S3C2440A)会把此参数按照时间要求转化为速度参数以及加速度参数传输给FPGA(A3P250),FPGA(A3P250)内部的梯形运动发生器会根据这些参数结合光电编码器和电流传感器的反馈生成驱动前后左右四轮的PWM波形,控制前后左右轮的电机X、电机Y、电机Z和电机R向Y轴反向运动,当达到设定探索速度时,FPGA(A3P250)会释放前驱的电机Z和电机R,系统进入两驱系统,有后驱的电机X和电机Y驱动微电脑鼠前进,当到达设定目标时,将更新其坐标为(X,Y-1),在确定Y-1>0的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经搜索到目标,然后置返航探索标志为1,微电脑鼠准备返程探索。
7)在微电脑鼠沿着Y轴向前运动过程中如果有迷宫挡墙进入前方的运动范围,并且此时左右的传感器S2、S3、S4、S5判断左方都有挡墙时,微电脑鼠将存储此时坐标(X,Y),根据传感器S1和S6的反馈计算出向前运动停车的位置参数S1,并把向前运动停止的位置参数S1传输给ARM9(S3C2440A),然后ARM9(S3C2440A)会把此参数按照时间要求转化为位置参数、速度参数以及加速度参数传输给FPGA(A3P250)作为指令值,FPGA(A3P250)使能前驱和后驱的四个电机,系统进入四驱系统。FPGA(A3P250)内部的梯形运动发生器会根据这些参数结合光电编码器和电流传感器的反馈生成驱动前后左右四轮的PWM波形和方向信号,控制前后左右四轮的电机X、电机Y、电机Z和电机R在设定距离内停车;然后ARM9(S3C2440A)使能FPGA(A3P250),使其发出的PWM信号控制左侧的电机正转,右侧的电机反转,微电脑鼠在陀螺仪的控制下原地向右调转90度,然后沿着X轴正向运动;在其X轴正向运动过程中,把向前运动一格的位置参数参数传输给ARM9(S3C2440A),然后ARM9(S3C2440A)会把此参数按照时间要求转化为速度参数以及加速度参数传输给FPGA(A3P250),FPGA(A3P250)内部的梯形运动发生器会根据这些参数结合光电编码器和电流传感器的反馈生成驱动前后左右四轮的PWM波形,控制前后左右轮的电机X、电机Y、电机Z和电机R向X轴正向运动,当达到设定探索速度时,FPGA(A3P250)会释放前驱的电机Z和电机R,系统进入两驱系统,有后驱的电机X和电机Y驱动微电脑鼠前进,当到达设定目标时,将更新其坐标为(X+1,Y),在确定X+1<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经搜索到目标,然后置返航探索标志为1,微电脑鼠准备返程探索。
8)在微电脑鼠沿着Y轴向前运动过程中如果有迷宫挡墙进入前方的运动范围,并且此时左右的传感器S2、S3、S4、S5判断右方都有挡墙时,微电脑鼠将存储此时坐标(X,Y),根据传感器S1和S6的反馈计算出向前运动停车的位置参数S1,并把向前运动停止的位置参数S1传输给ARM9(S3C2440A),然后ARM9(S3C2440A)会把此参数按照时间要求转化为位置参数、速度参数以及加速度参数传输给FPGA(A3P250)作为指令值,FPGA(A3P250)使能前驱和后驱的四个电机,系统进入四驱系统。FPGA(A3P250)内部的梯形运动发生器会根据这些参数结合光电编码器和电流传感器的反馈生成驱动前后左右四轮的PWM波形和方向信号,控制前后左右四轮的电机X、电机Y、电机Z和电机R在设定距离内停车;然后ARM9(S3C2440A)使能FPGA(A3P250),使其发出的PWM信号控制左侧的电机正转,右侧的电机反转,微电脑鼠在陀螺仪的控制下原地向左调转90度,然后沿着X轴反向运动;在其X轴反向运动过程中,把向前运动一格的位置参数参数传输给ARM9(S3C2440A),然后ARM9(S3C2440A)会把此参数按照时间要求转化为速度参数以及加速度参数传输给FPGA(A3P250),FPGA(A3P250)内部的梯形运动发生器会根据这些参数结合光电编码器和电流传感器的反馈生成驱动前后左右四轮的PWM波形,控制前后左右轮的电机X、电机Y、电机Z和电机R向X轴正向运动,当达到设定探索速度时,FPGA(A3P250)会释放前驱的电机Z和电机R,系统进入两驱系统,有后驱的电机X和电机Y驱动微电脑鼠前进,当到达设定目标时,将更新其坐标为(X-1,Y),在确定X-1>0的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经搜索到目标,然后置返航探索标志为1,微电脑鼠准备返程探索。
9)当微电脑鼠到达(7,7)、(7,8)、(8,7)、(8,8)准备返程探索时,控制器会调出其已经存储的迷宫,然后计算出可能存在的最佳路径,然后返程开始进入其中认为最优的一条。
10)在微电脑鼠进入迷宫正常返航运行时,并其导航的传感器S1、S2、S3、S4、S5、S6将工作,并把反射回来的光电信号送给ARM9(S3C2440A),经ARM9(S3C2440A)判断后送给FPGA(A3P250),由FPGA(A3P250)运算后与ARM9(S3C2440A)进行通讯,然后由控制器送控制信号给导航的电机X和电机Y进行确定:如果进入已经搜索的区域将进行快速前进,如果是未知返回区域则采用正常速度搜索,并时刻更新其坐标(X,Y),并判断其坐标是不是(0,0),如果是的话置返航探索标志为0,微电脑鼠进入冲刺阶段,并置冲刺标志为1。
11)为了能够实现微电脑鼠准确的坐标计算功能,本实用新型在高速直流电机X、电机Y、电机Z和电机R上加入了512线的光电编码器,时刻对小车运行的距离进行计算并根据迷宫挡墙和柱子对传感器反馈信息不同的特点引入了补偿,使得微电脑鼠的坐标计算不会出现错误。
12)在微电脑鼠运行过程中,ARM9(S3C2440A)会对电机的转矩进行在线辨识,当电机的转矩受到外界干扰出现较大抖动时,控制器会利用电机力矩与电流的关系进行时候补偿,减少了电机转矩抖动对微电脑鼠快速探索的影响,保证了探索时迷宫的准确性。
13)微电脑鼠在探索过程会时刻检测电池电压,当系统出现低压时,传感器S7将开启并发出报警提示,有效地保护了锂离子电池。
14)在微电脑鼠整个探索运动过程中,传感器S8会时刻对外界干扰光源进行采集,然后传输给ARM9(S3C2440A),ARM9(S3C2440A)会根据S8的自动补偿外界干扰,减少了外界干扰光源对微电脑鼠快速探索伺服系统的干扰。
15)如果微电脑鼠在探索过程中遇到故障撞墙时,电机的电流将增大,当超过设定值时,FPGA(A3P250)的中断命令将会向ARM9(S3C2440A)发出中断请求,此时ARM9(S3C2440A)会立即控制FPGA(A3P250)停止工作,从而有效地解决了堵转问题。
16)当微电脑完成整个探索过程回到起始点(0,0),ARM9(S3C2440A)将响应FPGA(A3P250)的四个中断响应控制四个电机同时减速使微电脑中心点停车,然后重新调整FPGA(A3P250)的四路PWM波输出,使得两则的电机:电机X、电机Z和电机Y、电机R以相反的方向运动,并在陀螺仪的控制下原地旋转180度,然后停车1秒,调取迷宫信息,然后根据算法算出最优冲刺路径,然后置冲刺标志为1,系统进入快速冲刺阶段。
本实用新型的有益效果是:
1:在运动过程中,充分考虑了电池在这个系统中的作用,基于ARM9(S3C2440A)+FPGA(A3P250)控制器时刻都在对小车的运行状态进行监测和运算,避免了大电流的产生,所以从根本上解决了大电流对锂离子电池的冲击,避免了由于大电流放电而引起的锂离子电池过度老化现象的发生。
2:为了充分提高微电脑鼠探索伺服系统的稳定性和行驶能力,本实用新型采用四轮驱动结构,前置驱动和后置驱动的四个电机功率一致,四轮伺服运动均有ARM+FPGA(A3P250)配合完成,微电脑鼠前后四个轮都有动力,可按迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上,以提高微电脑鼠的行驶能力。
3:在正常行驶环境下,四轮微电脑鼠一般会采用释放前轮,采用后轮驱动的方式;而一旦遇到路面灰尘较多或驱动轮打滑的情况,ARM9(S3C2440A)会自动检测并立即将微电脑鼠需求扭矩部分分配给前方两个驱动轮,系统自然切换到四轮驱动状态,增强了微电脑鼠探索时的附着力和操控性。
4:由于采用四轮驱动方式,当需要加速行驶时,把动力平均分配到四个电机,一旦一个动力轮离开地面,ARM9(S3C2440A)可以重新分配扭矩,把更多的扭矩分配在不打滑的驱动轮上,使系统迅速脱离打滑状态,重新回到四轴动力平衡状态,使得微电脑鼠具有更好的直线行走功能。
5:微电脑鼠探索转向时,为了保证旋转的稳定性,采用四轮同控来实现转弯,防止了微电脑鼠转弯探索时出现打滑的现象。
6:四轮微电脑鼠系统在正常行驶时如果设计不当造成重心前偏,将导致后侧驱动轮上承受的正压力减小,ARM9(S3C2440A)会自动调整后侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠打滑。
7:四轮微电脑鼠系统在正常行驶时如果设计不当造成重心侧偏,将导致一侧驱动轮上承受的正压力减小,ARM9(S3C2440A)会自动调整这一侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠打滑。
8:由FPGA(A3P250)处理微电脑鼠的四只直流电机的同步伺服控制,使得控制比较简单,大大提高了运算速度,解决了单片机软件运行较慢的瓶颈,缩短了开发周期短,并且程序可移植能力强。
9:本实用新型基本实现全贴片元器件材料,实现了单板控制,不仅节省了控制板占用空间,而且还实现了微电脑鼠的速度大小和方向的独立控制,有利于提高微电脑鼠的稳定性和动态性能。
10:为了提高运算速度和精度,本微电脑鼠采用了国际上使用最多的红外传感器OPE5594A,使得运算精度大大提高。
11:由于本控制器采用FPGA(A3P250)处理大量的数据与算法,并充分考虑了周围的干扰源,并把ARM9(S3C2440A)从繁重的工作量中解脱出来,有效地防止了程序的“跑飞”,抗干扰能力大大增强。
12:为了更好的保护电池,当系统在探索过程中遇到低压时,微电脑鼠上的低压报警传感器会自动开启,并限制放电电流,保证微电脑鼠可以完成整个探索,在探索完成回到起点时,会自动锁死在当前位置,并记录下迷宫信息,提示更换电池。
13:在微电脑鼠运行过程中,ARM9(S3C2440A)会对电机的转矩进行在线辨识并利用电机力矩与电流的关系进行补偿,减少了电机转矩抖动对微电脑鼠快速探索迷宫信息的影响。
14:由于微电脑鼠的速度和方向独立控制,使得微电脑鼠更容易实现前进、倒退、左转和右转各个方向的运动。
15:由于具有存储功能,这使得微电脑鼠掉电后可以轻易的调取已经探索好的迷宫信息,使二次探索的时间和路径大大降低。
以上所述仅为本实用新型的实施例,并非因此限制本实用新型的专利范围,凡是利用本实用新型说明书内容所作的等效结构或等效流程变换,或直接或间接运用在其它相关的技术领域,均同理包括在本实用新型的专利保护范围内。
Claims (8)
1.一种基于双核四轮微电脑鼠超快速探索控制器,应用于四轮微电脑鼠中,其特征在于,所述探索控制器包括FPGA处理器、ARM处理器、电压传感器、光电补偿传感器、至少六个蔽障传感器和四个运动控制系统,所述运动控制系统包括运动控制器和电机,所述FPGA处理器与每一个所述运动控制系统电性连接,所述ARM处理器分别与FPGA处理器、电压传感器、光电补偿传感器和每一个蔽障传感器电性连接。
2.根据权利要求1所述的基于双核四轮微电脑鼠超快速探索控制器,其特征在于,所述运动控制器与所述电机电性连接。
3.根据权利要求2所述的基于双核四轮微电脑鼠超快速探索控制器,其特征在于,所述运动控制器包括伺服控制单元、数据存储单元和输入输出接口单元。
4.根据权利要求1所述的基于双核四轮微电脑鼠超快速探索控制器,其特征在于,所述探索控制器包括上位机控制单元,所述上位机控制单元与所述ARM处理器电性连接,所述上位机控制单元包括迷宫读取单元、坐标定位单元和在线输出单元。
5.根据权利要求1所述的基于双核四轮微电脑鼠超快速探索控制器,其特征在于,所述蔽障传感器包括红外发射器OPE5594A和红外接收器TSL262。
6.根据权利要求5所述的基于双核四轮微电脑鼠超快速探索控制器,其特征在于,两个所述红外发射器的信号发射方向与所述四轮微电脑鼠的运动方向相同,两个所述红外发射器的信号发射方向相反且垂直于所述四轮微电脑鼠的运动方向,两个所述红外发射器的信号发射方向关于所述四轮微电脑鼠的运动方向对称且与所述四轮微电脑鼠的运动方向成45°夹角,其它所述红外发射器的信号发射方向与所述四轮微电脑鼠的运动方向的夹角为锐角。
7.一种四轮微电脑鼠,其特征在于,包括权利要求1至6任一所述的探索控制器,所述四轮微电脑鼠进一步包括壳体和四个车轮,所述壳体两侧分别设置两个所述车轮,每一个所述车轮与一个所述电机连接,每一个电机的转轴上设置光电编码器,所述壳体内部设置所述探索控制器。
8.根据权利要求7所述的四轮微电脑鼠,其特征在于,所述四轮微电脑鼠进一步包括四个陀螺仪,每一个所述陀螺仪与一个所述车轮的转轴连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201320569873.5U CN203643836U (zh) | 2013-09-16 | 2013-09-16 | 基于双核四轮微电脑鼠及其超快速探索控制器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201320569873.5U CN203643836U (zh) | 2013-09-16 | 2013-09-16 | 基于双核四轮微电脑鼠及其超快速探索控制器 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN203643836U true CN203643836U (zh) | 2014-06-11 |
Family
ID=50875067
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201320569873.5U Expired - Fee Related CN203643836U (zh) | 2013-09-16 | 2013-09-16 | 基于双核四轮微电脑鼠及其超快速探索控制器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN203643836U (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103472831A (zh) * | 2013-09-16 | 2013-12-25 | 苏州工业园区职业技术学院 | 基于双核四轮微电脑鼠超快速探索控制器 |
-
2013
- 2013-09-16 CN CN201320569873.5U patent/CN203643836U/zh not_active Expired - Fee Related
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103472831A (zh) * | 2013-09-16 | 2013-12-25 | 苏州工业园区职业技术学院 | 基于双核四轮微电脑鼠超快速探索控制器 |
CN103472831B (zh) * | 2013-09-16 | 2016-08-03 | 苏州工业园区职业技术学院 | 基于双核四轮微电脑鼠超快速探索控制器 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103472830A (zh) | 基于双核两轮微电脑鼠超快速探索控制器 | |
CN203535477U (zh) | 基于arm9的四轮微电脑鼠冲刺控制器 | |
CN105334853A (zh) | 双核高速四轮微微鼠冲刺控制器 | |
CN103529831B (zh) | 基于双核的四轮微电脑鼠全数字伺服系统控制器 | |
CN103472832A (zh) | 基于双核两轮微电脑鼠全数字伺服控制器 | |
CN103472835B (zh) | 基于双核四轮微电脑鼠快速冲刺控制器 | |
CN103472840A (zh) | 基于arm9四轮微电脑鼠探索控制器 | |
CN103472839A (zh) | 一种基于双核四轮微电脑鼠快速探索控制器 | |
CN105116897A (zh) | 双核高速四轮微微鼠全数字导航伺服控制器 | |
CN103472831B (zh) | 基于双核四轮微电脑鼠超快速探索控制器 | |
CN103529846A (zh) | 基于双核四轮高速微电脑鼠连转冲刺伺服系统 | |
CN203643838U (zh) | 基于双核四轮微电脑鼠及其快速冲刺控制器 | |
CN203909615U (zh) | 基于arm9四轮快速微电脑鼠连转冲刺伺服系统 | |
CN105116891A (zh) | 双核中速两轮微微鼠冲刺控制器及其控制方法 | |
CN103472838A (zh) | 一种基于双核四轮微电脑鼠快速冲刺控制器 | |
CN203643836U (zh) | 基于双核四轮微电脑鼠及其超快速探索控制器 | |
CN105137978A (zh) | 双核高速四轮微微鼠探索控制器 | |
CN103472833A (zh) | 基于双核四轮微电脑鼠全数字伺服控制器 | |
CN203643835U (zh) | 基于双核两轮微电脑鼠及其超快速探索控制器 | |
CN203643837U (zh) | 基于双核四轮微电脑鼠及其全数字伺服控制器 | |
CN103472834B (zh) | 基于双核两轮微电脑鼠超快速冲刺控制器 | |
CN103605363B (zh) | 基于arm9的四轮微电脑鼠冲刺控制器 | |
CN105137982A (zh) | 单核低速四轮微微鼠冲刺控制器及其控制方法 | |
CN203535478U (zh) | 一种基于双核四轮微电脑鼠快速探索控制器 | |
CN105137985A (zh) | 双核中速四轮微微鼠探索控制器 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20140611 Termination date: 20150916 |
|
EXPY | Termination of patent right or utility model |