首页 / 专利库 / 变速箱和齿轮 / 四轮驱动 / 四驱车 / 基于ARM9的四轮微电脑鼠冲刺控制器

基于ARM9的四轮微电脑鼠冲刺控制器

阅读:664发布:2021-11-30

专利汇可以提供基于ARM9的四轮微电脑鼠冲刺控制器专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种基于ARM9的四轮微电脑鼠冲刺 控制器 ,包括:主控制单元、第一L298N芯片、第二L298N芯片、第一运动单元、第二运动单元、第三运动单元、第四运动单元和电源,所述电源与所述主控制单元电性连接,所述主控制单元为ARM9处理器,所述ARM9处理器与所述第一L298N芯片、第二L298N芯片电性连接。通过上述方式,本发明基于ARM9的四轮微电脑鼠冲刺控制器具有误干扰率低、控制简单、 稳定性 好、动态性能佳、抗干扰能 力 强、系统调试简单等优点,在微电脑鼠冲刺控制器的普及上有着广泛的市场前景。,下面是基于ARM9的四轮微电脑鼠冲刺控制器专利的具体信息内容。

1.一种基于ARM9的四轮微电脑鼠冲刺控制器,其特征在于,包括:主控制单元、第一L298N芯片、第二L298N芯片、第一运动单元、第二运动单元、第三运动单元、第四运动单元和电源,所述电源与所述主控制单元电性连接,所述主控制单元为ARM9处理器,所述ARM9处理器与所述第一L298N芯片、第二L298N芯片电性连接,所述第一L298N芯片分别电性连接所述第一运动单元和第二运动单元,所述第二L298N芯片分别电性连接所述第三运动单元和第四运动单元,所述第一运动单元、第二运动单元、第三运动单元、第四运动单元均连接有光电编码器,所述电源为锂离子电池
所述基于ARM9的四轮微电脑鼠冲刺控制器的工作原理为:
1)在微电脑鼠未接到冲刺命令之前,它一般会在起点坐标(0,0)等待控制器发出的冲刺命令,并调出已经探索后的最优迷宫,一旦接到冲刺命令后,会沿着起点开始快速向终点(7,7)、(7,8)、(8,7)、(8,8)冲刺;
2)微电脑鼠放在起点坐标(0,0),接到任务后为了防止放错冲刺方向,其前方的传感器S1、S6和会对前方的环境进行判断,确定有没有挡墙进入运动范围,如存在挡墙将向ARM9发出中断请求,ARM9会对中断做第一时间响应,然后禁止L298N的使能端ENA和ENB工作,封微电脑鼠的电机X、电机Y、电机Z和电机R的PWM驱动信号,使其静止在原地,然后二次判断迷宫确定前方信息,防止信息误判;如果没有挡墙进入前方的运动范围,微电脑鼠将进行正常的冲刺;
3)在微电脑鼠沿着Y轴向前快速冲刺过程中如果迷宫信息中显示前方有Z格直线坐标下没有挡墙进入前方的运动范围,微电脑鼠将存储其现在的坐标(X,Y),处理器把向前运动Z格的位置参数传递给ARM9,ARM9根据此位置参数,计算出速度参数以及加速度参数,形成此时条件下的速度-时间梯形图,由于直流电机的速度和电压成正比例,根据这个梯形图结合光电编码器和电流传感器的反馈就可以生成控制左右轮直流电机的PWM波,然后ARM9使能前驱和后驱的两片驱动芯片L298N,通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,启动电机X、电机Y、电机Z和电机R,使系统按照预设的速度-时间运动图进入加速阶段,直到系统到达设定直线冲刺速度,并通过光电编码器记录下微电脑鼠已经运行的距离S1;
然后ARM9禁止前驱的驱动芯片L298N使能,系统释放电机Z和电机R,微电脑鼠进入后驱方式,电机X和电机Y以设定的直线冲刺速度到达指定位置S1+S2,然后系统使能前驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度驱动微电脑鼠开始减速,当速度为零时到达设定目标S1+S2+S1,将更新其坐标为(X,Y+Z),为了快速冲刺需要,在其向前运动过程到达既定目标时,在Y+Z<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
4)在微电脑鼠沿着Y轴反向向前快速冲刺过程中如果迷宫信息中显示前方有Z格直线坐标下没有挡墙进入前方的运动范围,微电脑鼠将存储其现在的坐标(X,Y),处理器把向前运动Z格的位置参数传递给ARM9,ARM9根据此位置参数,计算出速度参数以及加速度参数,形成此时条件下的速度时间梯形图,由于直流电机的速度和电压成正比例,根据这个梯形图结合光电编码器和电流传感器的反馈就可以生成控制左右轮直流电机的PWM波,然后ARM9使能前驱和后驱的两片驱动芯片L298N,通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,启动电机X、电机Y、电机Z和电机R,使系统进入加速阶段,直到系统到达设定直线冲刺速度,并通过光电编码器记录下微电脑鼠已经运行的距离S1;然后ARM9禁止前驱的驱动芯片L298N使能,系统释放电机Z和电机R,微电脑鼠进入后驱方式,电机X和电机Y以设定的直线冲刺速度到达指定位置S1+S2,然后系统使能前驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度驱动微电脑鼠开始减速,当速度为零时到达设定目标S1+S2+S1,将更新其坐标为(X,Y-Z),为了快速冲刺需要,在其向前运动过程到达既定目标时,在Y-Z<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
5)在微电脑鼠沿着Y轴向前运动过程中如果有挡墙进入前方的运动范围,并且此时迷宫信息中左方有挡墙时,微电脑鼠将存储此时坐标(X,Y),然后进入预设的曲线运动轨迹,在右冲刺转弯时,控制器把此时的速度和离中心点A的距离传输给ARM9,ARM9根据当前的速度和冲刺时间要求并结合结合光电编码器和电流传感器的反馈使能前驱和后驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度进行减速,当微电脑鼠到达迷宫中心点时,传感器参考值R90_FrontWallRef开始工作,防止外界干扰开始做误差补偿,保证微电脑鼠处在当前迷宫方格的中心,此时电机X、电机Y、电机Z和电机R速度降为0,ARM9通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,使左侧轮正转,右侧轮反转,板载陀螺仪使微电脑鼠原地右转90度,然后以当前的速度加速,当电机X、电机Y、电机Z和电机R到达设定直线冲刺速度时,禁止前驱的驱动芯片L298N使能,释放电机Z和电机R,使电机X和电机Y以相同的冲刺速度冲出迷宫,此时将更新其坐标为(X+1,Y),在X+1<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
6)在微电脑鼠沿着Y轴向前运动过程中如果有迷宫挡墙进入前方的运动范围,并且此时迷宫信息中右方有挡墙时,微电脑鼠将存储此时坐标(X,Y),然后进入预设的曲线运动轨迹,在左冲刺转弯时,控制器把此时的速度和离中心点A的距离传输给ARM9,ARM9根据当前的速度和冲刺时间要求结合光电编码器和电流传感器的反馈使能前驱和后驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度进行减速,当微电脑鼠到达迷宫中心点时,传感器参考值L90_FrontWallRef开始工作,防止外界干扰开始做误差补偿,保证微电脑鼠处在当前迷宫方格的中心,此时电机X、电机Y、电机Z和电机R速度降为0,ARM9通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,使右侧轮正转,左侧轮反转,板载陀螺仪使微电脑鼠原地左转90度,然后以当前的速度加速,当电机X、电机Y、电机Z和电机R到达设定直线冲刺速度时,禁止前驱的驱动芯片L298N使能,释放电机Z和电机R,使电机X和电机Y以相同的冲刺速度冲出迷宫,此时将更新其坐标为(X-1,Y),在X-1<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
7)当微电脑鼠冲刺到达(7,7)、(7,8)、(8,7)、(8,8)后会准备冲刺后的返程探索以便搜寻更优的路径,控制器会调出其已经存储的迷宫信息,然后计算出可能存在的其它最佳路径,然后返程开始进入其中认为最优的一条;
8)为了能够实现微电脑鼠快速冲刺准确的坐标计算功能,微电脑鼠左右的传感器S2、S3和S4、S5会时刻对周围的迷宫挡墙和柱子进行探测,如果S2、S3或者S4、S5发现传感器信号发生了跃变,则说明微电脑鼠进入了迷宫挡墙和柱子的交接点,此时侧面传感器S2或者是S5会精确探测这一时刻,当再次出现跃变时,说明老鼠已经开始离开当前的迷宫格子,ARM9会根据微电脑鼠当前运行的距离进行计算并根据对传感器反馈信息进行补偿,在高速直流电机X轴、Y轴、电机Z和电机R上加入了512线的光电编码器,由于精度较高,使得微电脑鼠的坐标计算不会出现错误,保证了微电脑鼠快速冲刺迷宫信息的准请性;
9)在微电脑鼠进入迷宫返程探索时,其导航的传感器S1、S2、S3、S4、S5、S6将工作,并把反射回来的光电信号送给ARM9,经ARM9运算后确定现在迷宫所处位置,然后由ARM9根据当前迷宫生成PWM波和送控制信号给L298N:如果进入已经搜索的区域将加大PWM波的占空比,使微电脑鼠进行快速前进,减少迷宫搜索的时间;如果是未知返回区域则采用正常速度搜索,并时刻更新其坐标(X,Y),并判断其坐标是不是(0,0),如果是的话置返航探索标志为0,微电脑鼠进入冲刺阶段,并置冲刺标志为1;
10)在微电脑鼠运动过程中,如果系统出现了干扰,ARM9会根据当前状态对电流加以补偿,快速调整电流环的PID参数,使得系统快速稳定下来,防止高速冲刺时干扰对系统的影响;
11)在微电脑鼠快速冲刺过程中,电池提供的瞬时功率是一定的,在冲刺速度一定的条件下,加速度越大时,需要的矩就越大,此时需要电池提供的电流就越大,为了保护电池,加入了硬件保护,否则将严重伤害电池;
12)为了能够减少光源对微电脑鼠冲刺的干扰,加入了光电传感器S8,此传感器会在微电脑鼠冲刺阶段对周围的异常光源进行读取,并自动送给控制器做实时补偿,消除了外界光源对冲刺的干扰;
13)当微电脑完成整个冲刺过程到达(7,7)、(7,8)、(8,7)、(8,8),微电脑鼠会置探索标志为1,微电脑鼠返程探索回到起始点(0,0),ARM9将控制两片L298N的电平输出使得微电脑起始点中心点停车,然后重新调整L298N的OUT1、OUT2、OUT3和OUT4的电平,使得两侧的电机:电机X、电机Z和电机Y、电机R以相反的方向运动,并在陀螺仪的控制下,原地旋转180度,然后停车1秒,二次调取迷宫信息,然后根据算法算出优化迷宫信息后的最优冲刺路径,然后置冲刺标志为1,系统进入二次快速冲刺阶段,然后按照冲刺----探索---冲刺,完成多次的冲刺,以达到快速冲刺的目的,
所述基于ARM9的四轮微电脑鼠冲刺控制器采用四轮驱动结构,前置驱动和后置驱动的四个电机功率一致,由于采用四轮驱动技术,微电脑鼠前后轮都有动力,可按迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上,以提高微电脑鼠的快速行驶能力;
根据需要实现分时四驱,在正常快速冲刺时,微电脑鼠一般会采用释放前轮,采用后轮驱动的方式;
而一旦遇到路面灰尘较多或驱动轮打滑的情况,ARM9会自动检测并立即将微电脑鼠需求扭矩分配一部分给前方两个前轮,自然切换到四轮驱动状态,增强了微电脑鼠快速冲刺时的附着力和操控性;
由于采用四轮驱动方式,当微电脑鼠需要加速冲刺时,把动力平均分配到四个电机,一旦一个动力轮离开地面,ARM9可以重新分配扭矩,把更多的扭矩分配在不打滑的驱动轮上,使系统迅速脱离打滑状态,重新回到四轴动力平衡状态,使得微电脑鼠保持较高的冲刺能力;
微电脑鼠冲刺转向时,为了保证旋转的稳定性,采用四轮同控来实现转弯:需要停车时,ARM9把动力平均分配到四个电机,四个电机采用相同的加速度进行同步减速,使微电脑鼠准确停车;
然后在陀螺仪的控制下精确旋转需要的度,然后进行加速,在加速行驶时,ARM9把动力平均分配到四个电机,四个电机采用相同的加速度进行同步加速,到达设定速度时,释放前轮采用后轮驱动,
所述第一运动单元、第二运动单元、第三运动单元、第四运动单元均包括电机。
2.根据权利要求1所述的基于ARM9的四轮微电脑鼠冲刺控制器,其特征在于,所述电机为高速直流电机。
3.根据权利要求1所述的基于ARM9的四轮微电脑鼠冲刺控制器,其特征在于,所述主控制单元还外接有上位机控制单元,所述上位机控制单元包括迷宫读取单元、坐标定位单元和在线输出单元,所述迷宫读取单元、坐标定位单元和在线输出单元均与所述ARM处理器电性连接。
4.根据权利要求1所述的基于ARM9的四轮微电脑鼠冲刺控制器,其特征在于,所述主控制单元还连接有至少6个传感器,所述传感器为声波传感器或红外线传感器,用于感应并传输外接环境信息。

说明书全文

基于ARM9的四轮微电脑鼠冲刺控制器

技术领域

[0001] 本发明涉及机器人领域,特别是涉及一种基于ARM9的四轮微电脑鼠冲刺控制器。

背景技术

[0002] 微电脑鼠是使用嵌入式微控制器传感器和机电运动部件构成的一种智能行走机器人,在国外已经竞赛了将近30年,由其原理可以转化为多种实际的工业机器人,近几年内才引进国内,并逐渐成为一个新兴的竞赛项目。微电脑鼠可以在不同“迷宫”中自动记忆和选择路径,采用相应的算法,快速地到达所设定的目的地。一只优秀的微电脑鼠必须具备良好的感知,有良好的行走能力,优秀的智能算法。一只完整的微电脑鼠包括传感器、电机、算法和微处理器,其中微处理器是微电脑鼠的核心部分,控制并判断所有信心,包括墙壁信息,位置信息,度信息和电机状态信息等。
[0003] 现有的微处理器一般采用的是单片机。由于国内研发此机器人的单位较少,相对研发平比较落后,研发的微电脑鼠在长时间运行发现存在着很多安全问题,如下:
[0004] (1)作为微电脑鼠的眼睛采用的是声波或者是一般的红外传感器,使得微电脑鼠在快速冲刺时对周围迷宫的判断存在一定的误判,使得微电脑在快速冲刺的时候容易撞上前方的挡墙
[0005] (2)作为微电脑鼠的执行机构采用的是步进电机,经常会遇到丢失脉冲的问题出现,导致对冲刺位置的记忆出现错误,有的时候找不到冲刺的终点;
[0006] (3)由于采用步进电机,使得机体发热比较严重,不利于在大型复杂迷宫中快速冲刺;
[0007] (4)由于采用比较低级的算法,使得最佳迷宫的计算和冲刺路径的计算都有一定的问题在一般迷宫当中的冲刺一般都要花费15~30秒的时间,这使得在真正的大赛中无法取胜;
[0008] (5)由于微电脑鼠在快速冲刺过程中要频繁的刹车和启动,加重了单片机的工作量,单片信号处理器无法满足微电脑鼠快速冲刺的要求;
[0009] (6)相对采用的都是一些体积比较大的插件元器件使得微电脑鼠的体积比较庞大,重心较高,无法满足快速冲刺的要求;
[0010] (7)由于受周围环境不稳定因素干扰,特别是周围一些光线的干扰,单片机控制器经常会出现异常,引起微电脑鼠失控,抗干扰能力较差;
[0011] (8)对于差速控制的微电脑鼠来说,一般要求其两个电机的控制信号要同步,但是对于单一单片机来说又很难办到,使得微电脑鼠在高速冲刺时会在迷宫当中摇摆幅度较大;
[0012] (9)由于受单片机容量和算法影响,微电脑鼠对迷宫的信息没有存储,当遇到掉电情况时候所有的信息将消失,这使得整个冲刺过程无法完成;
[0013] (10)由于受单片机容量影响,现有的微电脑鼠基本上都只有两个动力驱动轮,采用四轮差速方式行驶,使得系统对两轴的伺服要求较高,特别是直线加速冲刺导航时,要求速度和加速度要追求严格的一致,否则直线导航将会失败,导致微电脑鼠出现撞墙的现象发生;
[0014] (11)四轮微电脑鼠系统在加速时由于重心后移,使得老鼠前部轻飘,即使在良好的路面上微电脑鼠也会打滑,有可能导致撞墙的现象出现,不利于高速微电脑鼠冲刺的发展;
[0015] (12)四轮微电脑鼠系统在正常行驶时如果设计不当造成重心前偏,将导致驱动轮上承受的正压力减小,这时微电脑鼠系统更加容易打滑,也更容易走偏,导致导航失败;
[0016] (13)四轮微电脑鼠系统在正常行驶时如果设计不当造成重心侧偏将导致两个驱动轮承受的正压力不同,在快速启动时四轮打滑程度不一致,瞬间就偏离轨迹,转弯时,其中正压力小的轮子可能打滑,导致转弯困难;
[0017] (14)由于采用两个动力轮驱动,为了满足复杂状态下的加速和减速,使得单个驱动电机的功率较大,不仅占用的空间较大,而且有时候在一些相对需求能量较低的状态下造成“大拉小车”的现象出现,不利于微电脑鼠本体微型化发展和微电脑鼠系统能源的节省。

发明内容

[0018] 本发明主要解决的技术问题是提供一种基于ARM9的四轮微电脑鼠冲刺控制器,为克服单片机不能满足微电脑鼠稳定性和快速性的要求,舍弃了国产微电脑鼠所采用的单片机工作模式,在吸收国外先进控制思想的前提下,自主研发了基于ARM9+L298N的全新控制模式。控制板以ARM9为处理核心,实现两轴直流电机同步伺服数字信号的实时处理,并实现 L298N的左右轮的控制逻辑,实现微电脑鼠快速冲刺时两轴电机的同步控制,简化操作,提高效率,在基于ARM9的四轮微电脑鼠冲刺控制器的普及上有着广泛的市场前景。
[0019] 为解决上述技术问题,本发明提供一种基于ARM9的四轮微电脑鼠冲刺控制器,包括:主控制单元、第一L298N芯片、第二L298N芯片、第一运动单元、第二运动单元、第三运动单元、第四运动单元和电源,所述电源与所述主控制单元电性连接,所述主控制单元为ARM9处理器,所述ARM9处理器与所述第一L298N芯片、第二L298N芯片电性连接,所述第一L298N芯片分别电性连接所述第一运动单元和第二运动单元,所述第二L298N芯片分别电性连接所述第三运动单元和第四运动单元,所述第一运动单元、第二运动单元、第三运动单元、第四运动单元均连接有光电编码器,所述电源为锂离子电池
[0020] 在本发明一个较佳实施例中,所述第一运动单元、第二运动单元、第三运动单元、第四运动单元均包括电机。
[0021] 在本发明一个较佳实施例中,所述电机为高速直流电机。
[0022] 在本发明一个较佳实施例中,所述主控制单元还外接有上位机控制单元,所述上位机控制单元包括迷宫读取单元、坐标定位单元和在线输出单元,所述迷宫读取单元、坐标定位单元和在线输出单元均与所述ARM处理器电性连接。
[0023] 在本发明一个较佳实施例中,所述主控制单元还连接有至少6个传感器,所述传感器为超声波传感器或红外线传感器,用于感应并传输外接环境信息。
[0024] 在本发明一个较佳实施例中,所述电机还连接车轮,所述车轮的数量与所述电机的数量相同。
[0025] 本发明的有益效果是:本发明基于ARM9的四轮微电脑鼠冲刺控制器具有误干扰率低、控制简单、稳定性好、动态性能佳、抗干扰能力强、系统调试简单等优点,在微电脑鼠冲刺控制器的普及上有着广泛的市场前景。附图说明
[0026] 为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图,其中:
[0027] 图1是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的结构示意图;
[0028] 图2是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的原理图;
[0029] 图3是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的程序框图
[0030] 图4是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的迷宫示意图;
[0031] 图5是本发明的基于ARM9的四轮微电脑鼠一较佳实施例的二维示意图;
[0032] 图6是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的速度曲线图;
[0033] 图7是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的右转冲刺示意图;
[0034] 图8是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的右转和左转的冲刺速度时间示意图;
[0035] 图9是本发明的基于ARM9的四轮微电脑鼠冲刺主控制单元一较佳实施例的左转冲刺示意图;
[0036] 附图中各部件的标记如下:1、主控制单元,2、第一L298N芯片,3、第二L298N芯片,4、第一运动单元,5、第二运动单元,6、第三运动单元,7、第四运动单元,8、电源。

具体实施方式

[0037] 下面将对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
[0038] 请参阅图1至图8,本发明实施例包括:
[0039] 一种基于ARM9的四轮微电脑鼠冲刺控制器,包括:主控制单元1、第一L298N芯片2、第二L298N芯片3、第一运动单元4、第二运动单元5、第三运动单元6、第四运动单元7和电源8。
[0040] 所述电源8与所述主控制单元1电性连接,所述主控制单元1为ARM9处理器,所述主控制单元1为ARM9处理器,ARM9处理器采用精简指令集计算器结构,具有寄存器多、寻址方式简单、批量传输数据、使用地址自动增减等特点,相比于ARM7处理器,这里通过增加时钟频率和减少指令执行周期实现了两倍以上于ARM7处理器的能力;所述ARM9处理器与所述第一L298N芯片2、第二L298N芯片3电性连接,所述第一L298N芯片2分别电性连接所述第一运动单元4和第二运动单元5,所述第二L298N芯片3分别电性连接所述第三运动单元6和第四运动单元7,所述第一运动单元4、第二运动单元5、第三运动单元6、第四运动单元7均连接有光电编码器,所述电源8为锂离子电池
[0041] 优选地,所述第一运动单元4、第二运动单元5、第三运动单元6、第四运动单元7均包括电机。
[0042] 优选地,所述电机为高速直流电机。
[0043] 优选地,所述主控制单元1还外接有上位机控制单元,所述上位机控制单元包括迷宫读取单元、坐标定位单元和在线输出单元,所述迷宫读取单元、坐标定位单元和在线输出单元均与所述ARM处理器电性连接。
[0044] 优选地,所述主控制单元1还连接有至少6个传感器,所述传感器为超声波传感器或红外线传感器,用于感应并传输外接环境信息。
[0045] 优选地,所述电机还连接车轮,所述车轮的数量与所述电机的数量相同。
[0046] 本发明的工作原理为:
[0047] 1)在微电脑鼠未接到冲刺命令之前,它一般会在起点坐标(0,0)等待控制器发出的冲刺命令,并调出已经探索后的最优迷宫,一旦接到冲刺命令后,会沿着起点开始快速向终点(7,7)、(7,8)、(8,7)、(8,8)冲刺。
[0048] 2)微电脑鼠放在起点坐标(0,0),接到任务后为了防止放错冲刺方向,其前方的传感器S1、S6和会对前方的环境进行判断,确定有没有挡墙进入运动范围,如存在挡墙将向ARM9(S3C2440A)发出中断请求,ARM9(S3C2440A)会对中断做第一时间响应,然后禁止L298N的使能端ENA和ENB工作,封微电脑鼠的电机X、电机Y、电机Z和电机R的PWM驱动信号,使其静止在原地,然后二次判断迷宫确定前方信息,防止信息误判;如果没有挡墙进入前方的运动范围,微电脑鼠将进行正常的冲刺。
[0049] 3)本发明舍弃了传统单一速度冲刺模式,按照图6的速度和时间曲线控制微电脑鼠的加速和减速,梯形图包含的面积为微电脑鼠运动的距离。在微电脑鼠沿着Y轴向前快速冲刺过程中如果迷宫信息中显示前方有Z格直线坐标下没有挡墙进入前方的运动范围,微电脑鼠将存储其现在的坐标(X,Y),处理器把向前运动Z格的位置参数传递给ARM9(S3C2440A),ARM9(S3C2440A)根据此位置参数,计算出速度参数以及加速度参数,形成此时条件下的速度-时间梯形图,由于直流电机的速度和电压成正比例,根据这个梯形图图结合光电编码器和电流传感器的反馈就可以生成控制左右轮直流电机的PWM波,然后ARM9
(S3C2440A)使能前驱和后驱的两片驱动芯片L298N,通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,启动电机X、电机Y、电机Z和电机R,使系统按照图6的速度-时间运动图进入加速阶段,直到系统到达设定直线冲刺速度,并通过光电编码器记录下微电脑鼠已经运行的距离S1;然后ARM9(S3C2440A)禁止前驱的驱动芯片L298N使能,系统释放电机Z和电机R,微电脑鼠进入后驱方式,电机X和电机Y以设定的直线冲刺速度到达指定位置S1+S2,然后系统使能前驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度驱动微电脑鼠开始减速,当速度为零时到达设定目标S1+S2+S1,将更新其坐标为(X,Y+Z),为了快速冲刺需要,在其向前运动过程到达既定目标时,在Y+Z<15的前提下,判断其坐标是不是(7,
7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
[0050] 4)在微电脑鼠沿着Y轴反向向前快速冲刺过程中如果迷宫信息中显示前方有Z格直线坐标下没有挡墙进入前方的运动范围,微电脑鼠将存储其现在的坐标(X,Y),处理器把向前运动Z格的位置参数传递给ARM9(S3C2440A),ARM9(S3C2440A)根据此位置参数,计算出速度参数以及加速度参数,形成此时条件下的速度时间梯形图,由于直流电机的速度和电压成正比例,根据这个梯形图图结合光电编码器和电流传感器的反馈就可以生成控制左右轮直流电机的PWM波,然后ARM9(S3C2440A)使能前驱和后驱的两片驱动芯片L298N,通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,启动电机X、电机Y、电机Z和电机R,使系统进入加速阶段,直到系统到达设定直线冲刺速度,并通过光电编码器记录下微电脑鼠已经运行的距离S1;然后ARM9(S3C2440A)禁止前驱的驱动芯片L298N使能,系统释放电机Z和电机R,微电脑鼠进入后驱方式,电机X和电机Y以设定的直线冲刺速度到达指定位置S1+S2,然后系统使能前驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度驱动微电脑鼠开始减速,当速度为零时到达设定目标S1+S2+S1,将更新其坐标为(X,Y-Z),为了快速冲刺需要,在其向前运动过程到达既定目标时,在Y-Z<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
[0051] 5)在微电脑鼠沿着Y轴向前运动过程中如果有挡墙进入前方的运动范围,并且此时迷宫信息中左方有挡墙时,微电脑鼠将存储此时坐标(X,Y),然后进入图8所示的曲线运动轨迹,在右冲刺转弯时,控制器把此时的速度和离中心点A的距离传输给ARM9(S3C2440A),ARM9(S3C2440A)根据当前的速度和冲刺时间要求并结合结合光电编码器和电流传感器的反馈使能前驱和后驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度进行减速,当微电脑鼠到达迷宫中心点时,传感器参考值R90_FrontWallRef开始工作,防止外界干扰开始做误差补偿,保证微电脑鼠处在当前迷宫方格的中心,此时电机X、电机Y、电机Z和电机R速度降为0,ARM9(S3C2440A)通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,使左侧轮正转,右侧轮反转,板载陀螺仪使微电脑鼠原地右转90度,然后以当前的速度加速,当电机X、电机Y、电机Z和电机R到达设定直线冲刺速度时,禁止前驱的驱动芯片L298N使能,释放电机Z和电机R,使电机X和电机Y以相同的冲刺速度冲出迷宫。此时将更新其坐标为(X+1,Y),在X+1<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
[0052] 6)在微电脑鼠沿着Y轴向前运动过程中如果有迷宫挡墙进入前方的运动范围,并且此时迷宫信息中右方有挡墙时,微电脑鼠将存储此时坐标(X,Y),然后进入图7所示的曲线运动轨迹,在左冲刺转弯时,控制器把此时的速度和离中心点A的距离传输给ARM9(S3C2440A),ARM9(S3C2440A)根据当前的速度和冲刺时间要求结合光电编码器和电流传感器的反馈使能前驱和后驱的驱动芯片L298N,使电机X、电机Y、电机Z和电机R以相同的加速度进行减速,当微电脑鼠到达迷宫中心点时,传感器参考值L90_FrontWallRef开始工作,防止外界干扰开始做误差补偿,保证微电脑鼠处在当前迷宫方格的中心,此时电机X、电机Y、电机Z和电机R速度降为0,ARM9(S3C2440A)通过调整两片L298N管脚OUT1、OUT2和OUT3、OUT4的电平,使右侧轮正转,左侧轮反转,板载陀螺仪使微电脑鼠原地左转90度,然后以当前的速度加速,当电机X、电机Y、电机Z和电机R到达设定直线冲刺速度时,禁止前驱的驱动芯片L298N使能,释放电机Z和电机R,使电机X和电机Y以相同的冲刺速度冲出迷宫。此时将更新其坐标为(X-1,Y),在X-1<15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
[0053] 7)当微电脑鼠冲刺到达(7,7)、(7,8)、(8,7)、(8,8)后会准备冲刺后的返程探索以便搜寻更优的路径,控制器会调出其已经存储的迷宫信息,然后计算出可能存在的其它最佳路径,然后返程开始进入其中认为最优的一条。
[0054] 8)为了能够实现微电脑鼠快速冲刺准确的坐标计算功能,微电脑鼠左右的传感器S2、S3和S4、S5会时刻对周围的迷宫挡墙和柱子进行探测,如果S2、S3或者S4、S5发现传感器信号发生了跃变,则说明微电脑鼠进入了迷宫挡墙和柱子的交接点,此时侧面传感器S2或者是S5会精确探测这一时刻,当再次出现跃变时,说明老鼠已经开始离开当前的迷宫格子,ARM9(S3C2440A)会根据微电脑鼠当前运行的距离进行计算并根据对传感器反馈信息进行补偿,本发明在高速直流电机X轴、Y轴、电机Z和电机R上加入了512线的光电编码器,由于精度较高,使得微电脑鼠的坐标计算不会出现错误,保证了微电脑鼠快速冲刺迷宫信息的准请性。
[0055] 9)在微电脑鼠进入迷宫返程探索时,其导航的传感器S1、S2、S3、S4、S5、S6将工作,并把反射回来的光电信号送给ARM9(S3C2440A),经ARM9(S3C2440A)运算后确定现在迷宫所处位置,然后由ARM9(S3C2440A)根据当前迷宫生成PWM波和送控制信号给L298N:如果进入已经搜索的区域将加大PWM波的占空比,使微电脑鼠进行快速前进,减少迷宫搜索的时间;如果是未知返回区域则采用正常速度搜索,并时刻更新其坐标(X,Y),并判断其坐标是不是(0,0),如果是的话置返航探索标志为0,微电脑鼠进入冲刺阶段,并置冲刺标志为1。
[0056] 10)在微电脑鼠运动过程中,如果系统出现了干扰,ARM9(S3C2440A)会根据当前状态对电流加以补偿,快速调整电流环的PID参数,使得系统快速稳定下来,防止高速冲刺时干扰对系统的影响。
[0057] 11)在微电脑鼠快速冲刺过程中,电池提供的瞬时功率是一定的,在冲刺速度一定的条件下,加速度越大时,需要的力矩就越大,此时需要电池提供的电流就越大,为了保护电池,本发明加入了硬件保护,否则将严重伤害电池。
[0058] 12)为了能够减少光源对微电脑鼠冲刺的干扰,本发明加入了光电传感器S8,此传感器会在微电脑鼠冲刺阶段对周围的异常光源进行读取,并自动送给控制器做实时补偿,消除了外界光源对冲刺的干扰。
[0059] 13)当微电脑完成整个冲刺过程到达(7,7)、(7,8)、(8,7)、(8,8),微电脑鼠会置探索标志为1,微电脑鼠返程探索回到起始点(0,0),ARM9(S3C2440A)将控制两片L298N的电平输出使得微电脑起始点中心点停车,然后重新调整L298N的OUT1、OUT2、OUT3和OUT4的电平,使得两侧的电机:电机X、电机Z和电机Y、电机R以相反的方向运动,并在陀螺仪的控制下,原地旋转180度,然后停车1秒,二次调取迷宫信息,然后根据算法算出优化迷宫信息后的最优冲刺路径,然后置冲刺标志为1,系统进入二次快速冲刺阶段。然后按照冲刺----探索---冲刺,完成多次的冲刺,以达到快速冲刺的目的。
[0060] 本发明基于ARM9的四轮微电脑鼠冲刺控制器的有益效果是:
[0061] (1)在运动过程中,充分考虑了电池在这个系统中的作用,基于ARM9控制器时刻都在对微电脑鼠的运行状态进行监测和运算,避免了大电流的产生,并且时刻显示锂离子电池的SOC,有利于了解电池的能量状态,由于本发明采用永磁直流电机,电机的加速度和电机的电流呈一定比例关系,所以当电池SOC较低时,为了保证冲刺时能量的要求,可以在冲刺前提前换掉电池,从而减少了电池因为放电电流过高对高速冲刺的误干扰;
[0062] (2)为了充分保证微电脑鼠系统快速冲刺时的稳定性和行驶能力,本发明采用四轮驱动结构,前置驱动和后置驱动的四个电机功率一致,由于采用四轮驱动技术,微电脑鼠前后轮都有动力,可按迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上,以提高微电脑鼠的快速行驶能力;
[0063] (3)根据需要实现分时四驱。在正常快速冲刺时,微电脑鼠一般会采用释放前轮,采用后轮驱动的方式;而一旦遇到路面灰尘较多或驱动轮打滑的情况,ARM9会自动检测并立即将微电脑鼠需求扭矩分配一部分给前方两个前轮,自然切换到四轮驱动状态,增强了微电脑鼠快速冲刺时的附着力和操控性;
[0064] (4)由于采用四轮驱动方式,当微电脑鼠需要加速冲刺时,把动力平均分配到四个电机,一旦一个动力轮离开地面,ARM9可以重新分配扭矩,把更多的扭矩分配在不打滑的驱动轮上,使系统迅速脱离打滑状态,重新回到四轴动力平衡状态,使得微电脑鼠保持较高的冲刺能力;
[0065] (5)微电脑鼠冲刺转向时,为了保证旋转的稳定性,采用四轮同控来实现转弯:需要停车时,ARM9把动力平均分配到四个电机,四个电机采用相同的加速度进行同步减速,使微电脑鼠准确停车;然后在陀螺仪的控制下精确旋转需要的角度,然后进行加速,在加速行驶时,ARM9把动力平均分配到四个电机,四个电机采用相同的加速度进行同步加速,到达设定速度时,释放前轮采用后轮驱动;由ARM9结合转弯时间的要求根据轨迹的不同生成四路PWM控制直流电机X、电机Y、电机Z和电机R,完成四轴直流伺服系统的同步转弯控制;
[0066] (6)四轮微电脑鼠系统在正常行驶时如果设计不当造成重心前偏,将导致后侧驱动轮上承受的正压力减小,ARM9会在其冲刺时自动调整后侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠快速次冲刺时打滑;
[0067] (7)四轮微电脑鼠系统在正常行驶时如果设计不当造成重心侧偏,将导致一侧驱动轮上承受的正压力减小,ARM9会在其冲刺时自动调整这一侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠快速次冲刺时打滑;
[0068] (8)由ARM9处理微电脑鼠高速冲刺时的四只直流电机的伺服控制,使得控制比较简单,大大提高了运算速度,解决了单片机软件运行较慢的瓶颈,缩短了开发周期短,并且程序可移植能力强;
[0069] (9)本发明基本实现全贴片元器件材料,实现了单板控制,不仅降低了微电脑鼠的体积,而且也降低了其重心,有利于其快速冲刺;
[0070] (10)本发明实现了微电脑鼠的速度大小和方向的独立控制,有利于提高微电脑鼠小车的稳定性和动态性能;
[0071] (11)为了提高运算速度和精度,本微电脑鼠采用了国际上使用最多的红外发射器OPE5594A和红外接收器TSL262,使得运算精度大大提高,有利于提高高速冲刺时对前面迷宫挡墙的探知;
[0072] (12)由于本控制器采用ARM9处理迷宫读取和冲刺算法,有效地防止了程序的“跑飞”,抗干扰能力大大增强;
[0073] (13)由于本控制器采用来L298N来驱动四轴直流电机,极大地减少了驱动电路所占用的空间,并提高了系统的效率和稳定性;
[0074] (14)由ARM9输出冲刺时PWM调制信号和方向信号,然后通过L298N的使能端直接驱动直流电机,不仅减轻了ARM9的负担,而且简化了接口电路,使得系统的调试简单;
[0075] (15)在微电脑鼠快速冲刺过程中,控制器会对直流电机的转矩进行在线辨识并利用电机力矩与电流的关系进行补偿,减少了电机转矩抖动对微电脑鼠快速冲刺的影响;
[0076] (16)由于微电脑鼠的四轮速度和方向独立控制,使得微电脑鼠更容易实现曲线轨迹的转动;
[0077] (17)由于具有存储功能,这使得微电脑鼠可以轻易调取已经探索好的迷宫信息,可以优化二次冲刺的路径,降低冲刺时间。
[0078] 以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书内容所作的等效结构或等效流程变换,或直接或间接运用在其它相关的技术领域,均同理包括在本发明的专利保护范围内。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈