CN103529834A - 基于arm9四轮快速微电脑鼠对角线冲刺系统 - Google Patents

基于arm9四轮快速微电脑鼠对角线冲刺系统 Download PDF

Info

Publication number
CN103529834A
CN103529834A CN201310439573.XA CN201310439573A CN103529834A CN 103529834 A CN103529834 A CN 103529834A CN 201310439573 A CN201310439573 A CN 201310439573A CN 103529834 A CN103529834 A CN 103529834A
Authority
CN
China
Prior art keywords
motor
micro computer
computer mouse
spurt
arm9
Prior art date
Application number
CN201310439573.XA
Other languages
English (en)
Inventor
张好明
王应海
Original Assignee
苏州工业园区职业技术学院
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 苏州工业园区职业技术学院 filed Critical 苏州工业园区职业技术学院
Priority to CN201310439573.XA priority Critical patent/CN103529834A/zh
Publication of CN103529834A publication Critical patent/CN103529834A/zh

Links

Abstract

本发明公开了一种基于ARM9四轮快速微电脑鼠对角线冲刺系统,包括处理器单元、电机X、电机Y、电机Z、电机R以及微电脑鼠机械装置,所述的处理器单元分别与电机X、电机Y、电机Z以及电机R进行电性连接,所述的电机X、电机Y、电机Z以及电机R与微电脑鼠机械装置进行连接,其中,所述的处理器单元包括ARM9处理器和L298N芯片,所述的ARM9处理器和L298N芯片进行电性连接。本发明提供的基于ARM9四轮快速微电脑鼠对角线冲刺系统,抗干扰能力大大增强,同时提高了运算速度,保证基于ARM9四轮快速微电脑鼠对角线冲刺系统的稳定性和可靠性。

Description

基于ARM9四轮快速微电脑鼠对角线冲刺系统
技术领域
[0001] 本发明是有属于微型机器人的技术领域,且特别是涉及一种基于ARM9四轮快速微电脑鼠对角线冲刺系统。
背景技术
[0002] 微电脑鼠是使用嵌入式微控制器、传感器和机电运动部件构成的一种智能行走机器人,微电脑鼠可以在不同“迷宫”中自动记忆和选择路径,采用相应的算法,快速地到达所设定的目的地。微电脑鼠比赛在国外已经有30几年的历史,现在每年国际上都要举行上百场类似的微电脑鼠大赛。
[0003] 微电脑鼠竞赛采用运行时间、迷宫时间和碰触这三个参数,从速度、求解迷宫的效率和电脑鼠的可靠性三个方面来进行评分,不同的国家采用不同的评分标准,最有代表的四个国家标准为:
美国IEEE APEC国际微电脑鼠机器人竞赛 探索时间、冲刺时间和固定的接触扣分,都记入总成绩 得分=探索时间/30 +冲刺时间+固定接触扣分 全日本国际微电脑鼠机器人大会(专家级)
总成绩仅计算冲刺时间
得分=最佳冲刺时间
英国微电脑鼠机器人挑战赛
探索时间、冲刺时间和可变的接触扣分都记入总成绩
得分=探索时间/30 +冲刺时间+变动接触扣分
新加坡机器人大赛
探索时间、冲刺时间记入总成绩;每次接触机器人将减少一次尝试机会 得分=探索时间/30 +冲刺时间
从上面的国际标准来看,冲刺时间决定整个微电脑鼠的成败,由于国内研发此微电脑鼠的单位较少,相对研发水平比较落后,现有技术中的微电脑鼠结构如图1所示。长时间运行发现存在着很多安全问题,包括:
(1)作为微电脑鼠的眼睛采用的是超声波或者是一般的红外传感器,而且传感器的设置有误,使得微电脑鼠在快速冲刺时对周围迷宫的判断存在一定的误判,使得微电脑在快速冲刺的时候容易撞上前方的挡墙;
(2)作为微电脑鼠的执行机构采用的是步进电机,经常会遇到丢失脉冲的问题出现,导致对冲刺位置的记忆出现错误,有的时候找不到冲刺的终点;
(3)由于采用步进电机,使得机体发热比较严重,不利于在大型复杂迷宫中快速冲刺;
(4)由于采用比较低级的算法,使得最佳迷宫的计算和冲刺路径的计算都有一定的问题,研发的微电脑鼠基本上不会多次自动加速冲刺,在一般迷宫当中的冲刺一般都要花费15〜30秒的时间,这使得在真正的国际复杂迷宫大赛中无法取胜; (5)由于微电脑鼠在快速冲刺过程中需要频繁的刹车和启动,加重了单片机的工作量,单片信号处理器无法满足微电脑鼠快速冲刺的要求;
(6)相对采用的都是一些体积比较大的插件元器件使得微电脑鼠的体积和重量比较庞大,而且重心较高,无法满足快速冲刺的要求;
(7)由于受周围环境不稳定因素干扰,特别是周围一些光线的干扰,单片机控制器经常会出现异常,引起微电脑鼠失控,抗干扰能力较差;
(8)对于差速控制的微电脑鼠来说,一般要求其两个电机的控制信号要同步,但是对于单一单片机来说很难办到,使得微电脑鼠在高速冲刺时会在迷宫当中摇摆幅度较大,经常出现撞墙的现象发生,导致冲刺失败;
(9)由于受单片机容量和算法影响,微电脑鼠对迷宫的信息没有存储,当遇到掉电情况时候所有的信息将消失,这使得整个冲刺过程无法完成;
(10)由于没有角速度传感器的辅助进行转弯,经常出现转弯角度过小或者过大的现象发生,然后依靠导航的传感器进行补偿,导致在连续多次转弯的迷宫中出现撞墙的现象发生,致使冲刺失败;
(11)采用单个传感器探知前方迷宫的挡墙,极易收到外界干扰,致使前方传感器错误引导快速冲刺的微电脑鼠,导致微电脑鼠在迷宫中冲刺不到位或者撞墙,致使冲刺失败;
(12)由于受单片机容量影响,现有的微电脑鼠基本上都只有两个动力驱动轮,采用两轮差速方式行驶,使得系统对两轴的伺服要求较高,特别是直线加速冲刺导航时,要求速度和加速度要追求严格的一致,否则直线导航将会失败,导致微电脑鼠出现撞墙的现象发生;
(13)两轮微电脑鼠系统在加速时由于重心后移,使得老鼠前部轻飘,即使在良好的路面上微电脑鼠也会打滑,有可能导致撞墙的现象出现,不利于高速微电脑鼠冲刺的发展;
(14)两轮微电脑鼠系统在正常行驶时如果设计不当造成重心前偏,将导致驱动轮上承受的正压力减小,这时微电脑鼠系统更加容易打滑,也更容易走偏,导致导航失败;
(15)两轮微电脑鼠系统在正常行驶时如果设计不当造成重心侧偏将导致两个驱动轮承受的正压力不同,在快速启动时两轮打滑程度不一致,瞬间就偏离轨迹,转弯时,其中正压力小的轮子可能打滑,导致转弯困难;
(16)由于采用两个动力轮驱动,为了满足复杂状态下的加速和减速,使得单个驱动电机的功率较大,不仅占用的空间较大,而且有时候在一些相对需求能量较低的状态下造成“大马拉小车”的现象出现,不利于微电脑鼠本体微型化发展和微电脑鼠系统能源的节省;
综上所述,因此需要对现有的基于单片机控制的微电脑鼠控制器进行重新设计。
发明内容
[0004] 本发明主要解决的技术问题是提供一种基于ARM9四轮快速微电脑鼠对角线冲刺系统,克服单一单片机不能满足微电脑鼠稳定性和快速性的要求,舍弃了国产微电脑鼠所采用的单一单片机工作模式,在基于ARM9处理器的处理器单元中引入多轴驱动集成芯片L298N芯片以ARM9处理器为处理核心,实现四轴直流电机伺服系统的数字信号实时处理,并实现两片L298N芯片控制四台电机的响应中断,实现数据通信和存储实时信号,抗干扰能力大大增强,同时提高了运算速度,保证基于ARM9四轮快速微电脑鼠对角线冲刺系统的稳定性和可靠性。
[0005] 为解决上述技术问题,本发明采用的一个技术方案是:提供一种基于ARM9四轮快速微电脑鼠对角线冲刺系统,包括处理器单兀、电机X、电机Y、电机Z、电机R以及微电脑鼠机械装置,所述的处理器单元分别与电机X、电机Y、电机Z以及电机R进行电性连接,所述的电机X、电机Y、电机Z以及电机R与微电脑鼠机械装置进行连接,其中,所述的处理器单元包括ARM9处理器和L298N芯片,所述的ARM9处理器和L298N芯片进行电性连接。
[0006] 在本发明一个较佳实施例中,所述的处理器单元分别发出第一控制信号、第二控制信号、第三控制信号以及第四控制信号,由第一控制信号、第二控制信号、第三控制信号以及第四控制信号分别对应控制电机X、电机Y、电机Z以及电机R。
[0007] 在本发明一个较佳实施例中,所述的处理器单元还包括设于ARM9处理器和L298N芯片的上位机系统和运动控制系统,所述的上位机系统包括迷宫读取模块、坐标定位模块以及在线输出模块,所述的运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块,其中,所述的迷宫读取模块、坐标定位模块、在线输出模块、数据存储模块以及I/o控制模块分别与所述的L298N芯片进行电性连接。
[0008] 在本发明一个较佳实施例中,所述的伺服控制模块还包括电流模块、速度模块以及坐标模块,所述的控制伺服控制模块与所述的ARM9处理器进行电性连接。
[0009] 在本发明一个较佳实施例中,所述的微电脑鼠连转冲刺系统还包括电池,所述的电池与所述的处理器单元进行电性连接。
[0010] 在本发明一个较佳实施例中,所述的电池为锂离子电池。
[0011 ] 在本发明一个较佳实施例中,所述的电机X、电机Y、电机Z和电机R均为高速永磁直流电机。
[0012] 在本发明一个较佳实施例中,所述的电机X、电机Y、电机Z和电机R的转轴上均设有光电编码器。
[0013] 在本发明一个较佳实施例中,所述的微电脑鼠机械装置上设有光电传感器、电压传感器以及六个屏蔽传感器,所述光电传感器、电压传感器以及屏蔽传感器分别与所述的处理器单元进行电性连接。
[0014] 在本发明一个较佳实施例中,所述的微电脑鼠机械装置上设有两片陀螺仪,所述的陀螺仪与所述的处理器单元进行电性连接。
[0015] 本发明的基于ARM9四轮快速微电脑鼠对角线冲刺系统,克服单一单片机不能满足微电脑鼠稳定性和快速性的要求,舍弃了国产微电脑鼠所采用的单一单片机工作模式,在基于ARM9处理器的处理器单元中引入多轴驱动集成芯片L298N芯片以ARM9处理器为处理核心,实现四轴直流电机伺服系统的数字信号实时处理,并实现两片L298N芯片控制四台电机的响应中断,实现数据通信和存储实时信号,抗干扰能力大大增强,同时提高了运算速度,保证基于ARM9四轮快速微电脑鼠对角线冲刺系统的稳定性和可靠性。
附图说明
[0016] 为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图,其中:
图1为现有技术的微电脑鼠系统的电路图;
图2为本发明较佳实施例的基于ARM9四轮快速微电脑鼠对角线冲刺系统的电路图; 图3为图2中处理器单元的内部系统结构框图;
图4为本发明较佳实施例的微电脑鼠迷宫示意图;
图5为本发明较佳实施例的微电脑鼠的结构示意图;
图6为微电脑鼠速度曲线图;
图7微电脑鼠自动冲刺程序示意图;
图8为微电脑鼠右转冲刺示意图;
图9为微电脑鼠左转冲刺意义图;
图10为楼梯迷宫;
图11为45度冲刺楼梯示意图;
图12为连转M型迷宫;
图13为连转M型示意图;
图14为连转M型参数示意图;
图15为本发明较佳实施例的基于ARM9四轮快速微电脑鼠对角线冲刺系统控制示意
图;
附图5中各部件的标记如下:1、微电脑鼠,2、车轮,3、蔽障传感器,4、光电补偿传感器,
5、电压传感器。
具体实施方式
[0017] 下面将对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
[0018] 请参阅图2至图15,本发明实施例包括:
一种基于ARM9四轮快速微电脑鼠对角线冲刺系统,包括处理器单兀、电机X、电机Y、电机Z、电机R以及微电脑鼠机械装置,所述的处理器单元分别与电机X、电机Y、电机Z以及电机R进行电性连接,所述的电机X、电机Y、电机Z以及电机R与微电脑鼠机械装置进行连接,其中,所述的处理器单元包括ARM9处理器和L298N芯片,所述的ARM9处理器和L298N芯片进行电性连接。
[0019] 上述中,所述的处理器单元分别发出第一控制信号、第二控制信号、第三控制信号以及第四控制信号,由第一控制信号、第二控制信号、第三控制信号以及第四控制信号分别对应控制电机X、电机Y、电机Z以及电机R。
[0020] 所述的微电脑鼠连转冲刺系统还包括电池,所述的电池与所述的处理器单元进行电性连接。其中,所述的电池为锂离子电池,是一种供电装置,为整个系统的工作提供工作电压。
[0021] 进一步的,所述的电机X、电机Y、电机Z和电机R均为高速永磁直流电机。其中,所述的电机X、电机Y、电机Z和电机R的转轴上均设有光电编码器。[0022] 其工作原理为:由电池为整个系统的工作提供工作电压,处理器单元分别发出第一控制信号、第二控制信号、第三控制信号以及第四控制信号,由第一控制信号、第二控制信号、第三控制信号以及第四控制信号分别对应控制电机X、电机Y、电机Z以及电机R,通过所述的电机X的第一控制信号、通过所述的电机Y的第二控制信号、通过所述的电机Z的第三控制信号和通过所述的电机R的第四控制信号经过合成之后,控制微电脑鼠机械装置的运动。
[0023] 本发明中,所述的处理器单元包括ARM9处理器和L298N芯片,所述的ARM9处理器和L298N芯片进行电性连接。
[0024] ARM9 处理器米用 R I SC ( Reduce Instruction Computer,精简指令集计算机)结构,具有寄存器多、寻址方式简单、批量传输数据、使用地址自动增减等特点。新一代的ARM9处理器,通过全新的设计,采用了更多的晶体管,能够达到两倍以上于ARM7处理器的处理能力。这种处理能力的提高是通过增加时钟频率和减少指令执行周期实现的。
[0025] S3C2440A采用ARM920T内核,其主要特点有:
(1) 1.2V 内核,1.8V/2.5V/3.3V 储存器,3.3V 扩展 I/O, 16KB 指令 Cache (1-Cache)/16KB 数据 Cache (D-Cache);
(2) 3 路 URAT ;
(3) 4路PWM定时器/I路内部定时器/看门狗定时器;
(4) 8路10位ADC和触摸屏接口 ;
(5) 130个通用1/0,24个外部中断源;
(6)32bit定点RISC处理器,改进型ARM / Thumb代码交织,增强性乘法器设计。支持实时(real-time)调试;
(7)片内指令和数据SRAM,而且指令和数据的存储器容量可调;
(8)片内指令和数据高速缓冲器(cache)容量从4K字节到IM字节;
(9)设置保护单元(protection unit),非常适合嵌入式应用中对存储器进行分段和保
护;
(10)采用AMBA AHB总线接口,为外设提供统一的地址和数据总线;
(11)支持外部协处理器,指令和数据总线有简单的握手信令支持;
(12)支持标准基本逻辑单元扫描测试方法学,而且支持BIST (built-1n-self-test);
(13)支持嵌入式跟踪宏单元,支持实时跟踪指令和数据。
[0026] L298N芯片是SGS公司的产品,比较常见的是20管脚PowerS020封装。内部包含4通道逻辑驱动电路,可以方便的驱动两个直流电机,输出电压最高可达50V,可以直接通过电源来调节输出电压。L298N芯片的6脚VS接电源电压,VS电压范围为+ 2.5~46 V,输出电流可达2.5 A,可驱动电感性负载。2脚和19脚下管的发射极分别单独引出以便接入电流采样电阻,形成电流传感信号。其中一片L298N芯片的的8脚和14脚ΕηΑ,ΕηΒ是使能控制端,分别控制电机X和 电机Y的停转。L298N芯片的7,9,13,15脚接ARM9 (S3C2440A)的输入脚,由ARM9 (S3C2440A)控制0UT1,0UT2和0UT3,0UT4的电平,来控制电机X和电机Y的正反转;另外一片L298N芯片的的8脚和14脚ΕηΑ,ΕηΒ分别控制电机Z和电机R的停转。L298N芯片的7,9,13,15脚接々觀9 (S3C2440A)的输入脚,由ARM9 (S3C2440A)控制OUT I, OUT2和OUT3,0UT4的电平,来控制电机Z和电机R的正反转。
[0027] 进一步的,所述的处理器单元还包括设于ARM9处理器和L298N芯片的上位机系统和运动控制系统,所述的上位机系统包括迷宫读取模块、坐标定位模块以及在线输出模块,所述的运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块。
[0028] 其中,所述的迷宫读取模块、坐标定位模块、在线输出模块、数据存储模块以及I/O控制模块分别与所述的L298N芯片进行电性连接;所述的控制伺服控制模块与所述ARM9处理器进行电性连接。
[0029] 迷宫读取模块将已经预设好的迷宫进行调出;坐标定位模用于提示微电脑鼠的位置以及位置参数设置等;在线输出模块用于提示微电脑鼠的工作状态;数据存储模块为一存储器;1/0控制模块包括RS-232串行接口、ICE端口等。所述的伺服控制模块进一步包括电流模块、速度模块以及坐标模块。其中,电流模块与电池和处理器单元连接,电流模块用于调整电池的供电功率达到微电脑鼠需要的范围;速度模块用来调节微电脑鼠实际转速;坐标模块用于检测微电脑鼠的坐标位置,接到处理器单元发出的冲刺命令后,会沿着起点开始快速向终点冲刺。
[0030] 基于ARM9处理器的处理器单元,把微电脑鼠放在迷宫起始点,在电源打开状态下,微电脑鼠先进入自锁状态,然后ARM9处理器会根据按键信息重新搜索并优化迷宫或者是自动调取存储的迷宫信息并计算出冲刺路径,微电脑鼠依靠前方、左右侧面蔽障传感器根据实际导航环境传输参数给控制器中的ARM9处理器,ARM9处理器处理后使能L298N芯片,然后由L298N芯片生成四路PWM波驱动四个独立电机并实现其快速冲刺时的伺服控制,最后把处理数据通讯给ARM9处理器,由ARM9处理器继续处理后续的运行状态。
[0031] 结合以上描述,所述的L298N芯片用于控制迷宫读取模块、坐标定位模块、在线输出模块、数据存储模块以及I/o控制模块,ARM9处理器用于控制伺服控制模块,这样就实现了 ARM9处理器与L298N芯片的分工,把L298N芯片从复杂的工作当中解脱出来,且ARM9处理器和L298N芯片之间也可以进行通讯,实时进行数据交换和调用。
[0032] 本发明为了克服单一单片机不能满足基于ARM9四轮快速微电脑鼠对角线冲刺系统的稳定性和快速性的要求,舍弃了国产微电脑鼠所采用的单一单片机工作模式,在基于ARM9处理器的处理器单元中引入多轴驱动集成芯片L298N芯片以ARM9处理器为处理核心,实现四轴直流电机伺服系统的数字信号实时处理,并实现两片L298N芯片控制四台电机的响应中断,实现数据通信和存储实时信号。
[0033] 在本实施例中,所述微电脑鼠I上设有六个红外传感器0PE5594A作为蔽障传感器3,每一个蔽障传感器3分别与所述处理器单元进行电性连接,将六个蔽障传感器3分别编号为S1、S2、S3、S4、S5、S6,其中,蔽障传感器SI和蔽障传感器S6的信号发射方向与所述车轮2的运动方向相同,蔽障传感器S2和蔽障传感器S5的信号发射方向相反且垂直于所述车轮2的运动方向,蔽障传感器S3和蔽障传感器S4与所述车轮2的运动方向的夹角为一般为45度。
[0034] 进一步的,所述微电脑鼠I包括电压传感器5和光电传感器4,所述电压传感器5和光电传感器4分别与所述处理器单元进行电性连接,所述电压传感器5编号为S8,所述光电传感器4编号为S7。
[0035] 再进一步的,所述的微电脑鼠I上还设有两片陀螺仪(图未视),所述的陀螺仪与所述的处理器单元进行电性连接。
[0036] 其具体功能实现如下:
1)在微电脑鼠打开电源瞬间,系统将会按照图7的方式完成冲刺,首先系统要完成初始化,然后等待按键信息,未接到按键信息命令之前,它一般会在起点坐标(0,O)等待控制器发出的冲刺命令,根据按键信息,本发明有多种冲刺方法:如果按下的是START(启动)键,说明系统要放弃以前的迷宫信息先进行搜索,然后搜索完成后生成优化的冲刺迷宫信息,微电脑鼠进入自动多次冲刺阶段;如果按下的是RESET (复位)+STRAT (启动)键,说明系统要调出已经探索后的最优迷宫,然后沿着起点开始快速向终点(7,7)、(7,8)、(8,7)、(8,8)冲刺;如果按下的是RESET (复位)+STRAT (启动)+SPEED (速度)键,说明系统要调出已经探索后的最优迷宫,然后沿着起点以设定的冲刺速度开始快速向终点(7,7)、(7,8)、(8,7)、(8,8)冲刺;
2)微电脑鼠放在起点坐标(0,0),接到任务后为了防止放错冲刺方向,其前方的传感器S1、S6和会对前方的环境进行判断,确定有没有挡墙进入运动范围,如存在挡墙将向ARM9处理器发出中断请求,ARM9处理器会对中断做第一时间响应,然后禁止L298N芯片的使能端ENA和ENB工作,封锁微电脑鼠的电机X、电机Y、电机Z和电机R的PWM驱动信号,使其静止在原地,然后二次判断迷宫确定前方信息,防止信息误判;如果没有挡墙进入前方的运动范围,微电脑鼠将进行正常的冲刺;
3)本发明舍弃了传统单一速度冲刺模式,按照图6的速度和时间曲线控制微电脑鼠的加速和减速,梯形图包含的面积为微电脑鼠运动的距离,在微电脑鼠沿着Y轴向前快速冲刺过程中如果迷宫信息中显示前方有Z格直线坐标下没有挡墙进入前方的运动范围,系统进入冲刺子程序1,微电脑鼠将存储其现在的坐标(X,Y),处理器把向前运动Z格的位置参数传递给ARM9处理器,ARM9处理器根据此位置参数,计算出速度参数以及加速度参数,形成此时条件下的速度-时间梯形图,由于直流电机的速度和电压成正比例,根据这个梯形图图结合光电编码器和电流传感器的反馈就可以生成控制左右轮直流电机的PWM波,然后ARM9处理器使能前驱和后驱的两片驱动芯片L298N芯片,通过调整两片L298N芯片管脚0UT1、0UT2和0UT3、0UT4的电平,启动电机X、电机Y、电机Z和电机R,使系统按照图6的速度-时间运动图进入加速阶段,直到系统到达设定直线冲刺速度,并通过光电编码器记录下微电脑鼠已经运行的距离SI ;如果地面不易打滑,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格直线坐标下没有挡墙进入前方的运动范围,系统进入冲刺子程序1,微电脑鼠将存储其现在的坐标(X,Y),处理器把向前运动Z格的位置参数传递给ARM9处理器,ARM9处理器根据此位置参数,计算出速度参数以及加速度参数,形成此时条件下的速度时间梯形图,由于直流电机的速度和电压成正比例,根据这个梯形图图结合光电编码器和电流传感器的反馈就可以生成控制左右轮直流电机的PWM波,然后ARM9处理器使能前驱和后驱的两片驱动芯片L298N芯片,通过调整两片L298N芯片管脚0UT1、0UT2和0UT3、0UT4的电平,启动电机X、电机Y、电机Z和电机R,使系统进入加速阶段,直到系统到达设定直线冲刺速度,并通过光电编码器记录下微电脑鼠已经运行的距离SI ;然后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,冲刺标志为O,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
5)在微电脑鼠沿着Y轴向前运动过程中如果有迷宫挡墙进入前方的运动范围,并且此时迷宫信息中左方有挡墙右方无挡墙时,微电脑鼠将存储此时坐标(X,Y),然后进入图8所示的曲线运动轨迹,系统进入冲刺子程序2,在右冲刺转弯时,ARM9处理器首先把行走直线很短的距离Leading按照各种冲刺条件不同的要求转化为速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制左右轮以相同的加速度和速度控制电机X、电机Y、电机Z和电机R向前快速运动;当到达既定目标时,传感器参考值R90_FrontffallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结束后,ARM9处理器把行走的曲线轨迹R_Arcl和R_Arc3按照各种冲刺条件不同的要求转化为速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,控制前后左右四轮工作;当到达既定目标后,ARM9处理器把行走的曲线轨迹R_Arc2和R_Arc4按照各种冲刺条件不同的要求转化为后驱和前驱的四轮速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,控制前后左右四轮工作;当到达既定目标后,微电脑鼠在陀螺仪的控制下已经右转90度,控制器把直线行走很短的距离Passing按照各种冲刺条件不同的要求转化为速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,控制电机X、电机Y、电机Z和电机R向前快速运动,当到达既定目标后完成整个右转弯的轨迹曲线运动,此时将更新其坐标为(X+1,Y),在X+l〈15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
6)在微电脑鼠沿着Y轴向前运动过程中如果有迷宫挡墙进入前方的运动范围,并且此时迷宫信息中右方有挡墙左方无挡墙时,微电脑鼠将存储此时坐标(X,Y),然后进入图9所示的曲线运动轨迹,系统进入冲刺子程序3,在左冲刺转弯时,ARM9处理器首先把行走直线很短的距离Leading按照各种冲刺条件不同的要求转化为速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制左右轮以相同的加速度和速度控制电机X、电机Y、电机Z和电机R向前快速运动;当到达既定目标时,传感器参考值L90_FrontffallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结束后,ARM9处理器把行走的曲线轨和L_Arc3按照各种冲刺条件不同的要求转化为速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,控制前后左右四轮工作;当到达既定目标后,ARM9处理器把行走的曲线轨迹L_Arc2和L_Arc4按照各种冲刺条件不同的要求转化为后驱和前驱的四轮速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,控制前后左右四轮工作;当到达既定目标后,微电脑鼠在陀螺仪的控制下已经左转90度,控制器把直线行走很短的距离Passing按照各种冲刺条件不同的要求转化为速度参数以及加速度参数指令值,然后结合光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,控制电机X、电机Y、电机Z和电机R向前快速运动,当到达既定目标后完成整个右转弯的轨迹曲线运动,此时将更新其坐标为(X-1,Y),在X-1X)的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
7)在微电脑鼠沿着X轴、Y轴向前运动过程中如果有类似图10的楼梯型迷宫挡墙进入前方的运动范围,系统进入冲刺子程序4,微电脑鼠将存储此时坐标(X,Y),然后进入图11所示的对角线运动轨迹,在直道坐标为(X,Y)时,ARM9处理器控制电机X、电机Y、电机Z和电机R以相同的速度匀速前进,在前进过程中传感器S2、S3和S4、S5共同作用,保证微电脑鼠冲刺的时候一定沿着迷宫中线行驶,即将冲出坐标为(X,Y)迷宫方格时,微电脑鼠前方传感器SI和S6将工作,当读到预设值时,说明微电脑鼠的前部已经进入坐标(X+1,Y),然后把微电脑鼠传感器SI到电机中心的距离SX传输给ARM9处理器,ARM9处理器首先把行走直线很短的距离SX按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制四轮以相同的加速度和速度直线前进;当到达既定目标时,把此时的迷宫坐标更新为(X+1,Y);此刻微电脑鼠开始为45度对角线冲刺做姿态调整,控制器会把曲线运动轨迹L_Arcl_45和L_Arc3_45按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制左右轮以恒定的比值前进;当到达既定目标后,立即调整微电脑鼠前后左右四轮的速度,控制器把曲线运动轨迹L-Arc2_45和L_Arc4_45按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制左右轮以恒定的比值前进;在陀螺仪的控制下,保证到达当到达既定目标A点时曲线L_△此2_45和1^_4此4_45的斜率为45度,然后控制器把直线行走很短的距离Passingl按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制左右轮的PWM波给L298N芯片,然后控制前后左右四轮以相同的加速度和速度前进,当到达既定目标后通过三段不同的轨迹完成整个左转弯45度方向的改变,微电脑鼠进入对角线冲刺阶段,此时前方传感器SI和S6开始工作;ARM9处理器首先把行走直线距离√Ζ按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器反馈、电流传感器的反馈和传感器SI和S6对前方柱子的探测,经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制前后左右四轮以相同的加速度和速度直线前进;当到达既定目标时,微电脑鼠完成在坐标(X+l,Υ+1)到坐标(Χ+2,Υ+1)下的对角线冲刺,微电脑鼠完成一格楼梯迷宫的冲刺,把此时的迷宫坐标更新为(Χ+2,Υ+2);依次类推,微电脑鼠完成Z格楼梯迷宫的冲刺,更新迷宫为(Χ+Ζ+1,Υ+Ζ+1),微电脑鼠开始做转出动作,此时控制器会把曲线运动轨迹R_arcl_45和R_arc3_45按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制前后左右四轮以恒定的比值前进;当到达既定目标后,立即调整微电脑鼠左右轮的速度,控制器把曲线运动轨迹R_arc2_45和R_arc4_45按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制左右轮以恒定的比值前进;在陀螺仪的控制下,保证到达当到达既定目标B点时曲线R_arc2_45和R_arc4_45的斜率为O度,然后控制器把直线行走很短的距离Passing2按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制前后左右四轮以相同的加速度和速度前进,当到达既定目标后通过三段不同的轨迹完成在坐标(X+Z+1,Y+Z+1)下整个右转弯45度曲线轨迹的运动,微电脑鼠完成对角线冲刺后变为直路的轨迹改变,微电脑鼠进入直线冲刺阶段,此时前方传感器S2、S3、S4和S5开始工作,进入直线导航;并更新当前坐标为(Χ+Ζ+2,Υ+Ζ+1)在Χ+Ζ+2〈15和Y+Z+l〈15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为O,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
8)在微电脑鼠沿着X轴、Y轴向前运动过程中如果有类似图12的M型迷宫挡墙进入前方的运动范围,系统进入冲刺子程序5,微电脑鼠将存储此时坐标(X,Y),然后进入图13、图14所示的曲线运动轨迹,在一次左冲刺转弯时,ARM9处理器首先把行走直线很短的距离Leadingl按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制前后左右四轮以相同的加速度和速度直线前进;当到达既定目标时,把此时的迷宫坐标更新为(Χ+1,Y),传感器参考值L90_FrontWallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结束后控制器会把曲线运动轨迹L_Arcl和L_Arc3按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,控制器会把曲线运动轨迹L_Arc2和L_Arc4按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,微电脑鼠在陀螺仪的控制下已经左转90度,控制器把直线行走很短的距离PaSSingl+Leading2,按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮以相同的加速度和速度前进,当传感器S5的值产生有高电平到低电平的跃变时,更新微电脑鼠坐标为(X+1,Y+1),微电脑鼠继续以当前的速度和加速前进,当到达既定目标时,传感器参考值R90_FrOntWallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结束后控制器会把曲线运动轨迹R_Arcl和R_Arc3按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,控制器会把曲线运动轨迹R_Arc2和R_Arc4按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,微电脑鼠在陀螺仪的控制下已经右转90度,控制器把直线行走很短的距离PaSSing2+Leading3按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮以相同的加速度和速度前进,当传感器S5的值产生有高电平到低电平的跃变时,更新微电脑鼠坐标为(X+2,Y+1),微电脑鼠继续以当前的速度和加速前进,当到达既定目标时,传感器参考值R90_FrOntWallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结束后控制器会把曲线运动轨迹R_Arcl和R_Arc3按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,控制器会把曲线运动轨迹R_Arc2和R_Arc4按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,微电脑鼠在陀螺仪的控制下已经右转90度,控制器把直线行走很短的距离PaSSing3+Leading4按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮以相同的加速度和速度前进,当传感器S2的值产生有高电平到低电平的跃变时,更新微电脑鼠坐标为(X+2,Y),微电脑鼠继续以当前的速度和加速前进,当到达既定目标时,传感器参考值L90_FrOntWallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结束后控制器会把曲线运动轨迹L_Arcl和L_Arc3按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制前后左右四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,控制器会把曲线运动轨迹L_Arc2和L_Arc4按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮的速度以恒定的比值转弯;当到达既定目标后,陀螺仪控制微电脑鼠已经左转90度,控制器把直线行走很短的距离PaSSing4+Leading5按照不同的冲刺条件时间要求转化为速度参数以及加速度参数指令值,然后结合电机X、电机Y、电机Z和电机R上的光电编码器和电流传感器的反馈经内部位置、速度和加速度控制程序,生成控制四轮的PWM波给L298N芯片,然后控制四轮以相同的加速度和速度前进,当传感器S5的值产生有高电平到低电平的跃变时,微电脑鼠完成一个M型的冲刺,更新微电脑鼠坐标为(X+3,Y),依次类推,微电脑鼠经过Z个M型后,更新微电脑鼠坐标为(X+2*Z+1,Y),判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫路径;
9)当微电脑鼠冲刺到达(7,7)、(7,8)、(8,7)、(8,8)后会准备冲刺后的返程探索以便搜寻更优的路径,控制器会调出其已经存储的迷宫信息,然后计算出可能存在的其它最佳路径,然后返程开始进入其中认为最优的一条,
10)为了能够实现微电脑鼠快速冲刺准确的坐标计算功能,微电脑鼠左右的传感器S2、S3和S4、S5会时刻对周围的迷宫挡墙和柱子进行探测,如果S2、S3或者S4、S5发现传感器信号发生了跃变,则说明微电脑鼠进入了迷宫挡墙和柱子的交接点,此时侧面传感器S2或者是S5会精确探测这一时刻,当再次出现跃变时,说明老鼠已经开始离开当前的迷宫格子,ARM9处理器会根据微电脑鼠当前运行的距离进行计算并根据对传感器反馈信息进行补偿,本发明在高速直流电机X轴、Y轴、电机Z和电机R上加入了 512线的光电编码器,由于精度较高,使得微电脑鼠的坐标计算不会出现错误,保证了微电脑鼠快速冲刺迷宫信息的准请性;
11)在微电脑鼠进入迷宫返程探索时,其导航的传感器S1、S2、S3、S4、S5、S6将工作,并把反射回来的光电信号送给ARM9处理器,经ARM9处理器运算后确定现在迷宫所处位置,然后由ARM9处理器根据当前迷宫生成PWM波和送控制信号给L298N芯片:如果进入已经搜索的区域将加大PWM波的占空比,使微电脑鼠进行快速前进,减少迷宫搜索的时间;如果是未知返回区域则采用正常速度搜索,并时刻更新其坐标(X,Y),并判断其坐标是不是(0,
0),如果是的话置返航探索标志为0,微电脑鼠进入冲刺阶段,并置冲刺标志为I ;
12)在微电脑鼠运动过程中,如果系统出现了干扰,ARM9处理器会根据当前状态对电流加以补偿,快速调整电流环的PID参数,使得系统快速稳定下来,防止高速冲刺时干扰对系统的影响;
13)在微电脑鼠快速冲刺过程中,电池提供的瞬时功率是一定的,在冲刺速度一定的条件下,加速度越大时,需要的力矩就越大,此时需要电池提供的电流就越大,为了保护电池,本发明加入了硬件保护,否则将严重伤害电池;
14)为了能够减少光源对微电脑鼠冲刺的干扰,本发明加入了光电传感器S8,此传感器会在微电脑鼠冲刺阶段对周围的异常光源进行读取,并自动送给控制器做实时补偿,消除了外界光源对冲刺的干扰;
15)当微电脑完成整个冲刺过程到达(7,7)、(7,8)、(8,7)、(8,8),微电脑鼠会置探索标志为1,微电脑鼠返程探索回到起始点(0,0),ARM9处理器将控制两片L298N芯片的电平输出使得微电脑起始点中心点停车,然后重新调整L298N芯片的0UT1、0UT2、0UT3和0UT4的电平,使得两侧的电机:电机X、电机Z和电机Y、电机R以相反的方向运动,并在陀螺仪的控制下,原地旋转180度,然后停车I秒,二次调取迷宫信息,然后根据算法算出优化迷宫信息后的最优冲刺路径,然后置冲刺标志为1,系统进入二次快速冲刺阶段,然后按照冲刺——探索冲刺,完成多次的冲刺,以达到快速冲刺的目的。
[0037] 本发明基于ARM9四轮快速微电脑鼠对角线冲刺系统具有的有益效果是:
1:在运动过程中,充分考虑了电池在这个系统中的作用,基于ARM9处理器控制器时刻都在对微电脑鼠的运行状态进行监测和运算,避免了大电流的产生,并且时刻显示锂离子电池的S0C,有利于了解电池的能量状态,由于本发明采用永磁直流电机,电机的加速度和电机的电流呈一定比例关系,所以当电池SOC较低时,为了保证冲刺时能量的要求,可以在冲刺前提前换掉电池,从而减少了电池因为放电电流过高对高速冲刺的误干扰;
2:为了充分保证微电脑鼠系统快速冲刺时的稳定性和行驶能力,本发明采用四轮驱动结构,前置驱动和后置驱动的四个电机功率一致,由于采用四轮驱动技术,微电脑鼠前后轮都有动力,可按迷宫地面和周围环境状态不同而将需求扭矩按不同比例分布在前后所有的轮子上,以提高微电脑鼠的快速行驶能力;
3:根据需要实现分时四驱,在正常快速冲刺时,微电脑鼠一般会采用释放前轮,采用后轮驱动的方式;而一旦遇到路面灰尘较多或驱动轮打滑的情况,ARM9处理器会自动检测并立即将微电脑鼠需求扭矩分配一部分给前方两个前轮,自然切换到四轮驱动状态,增强了微电脑鼠快速冲刺时的附着力和操控性;
4:由于采用四轮驱动方式,当微电脑鼠需要加速冲刺时,把动力平均分配到四个电机,一旦一个动力轮离开地面,ARM9处理器可以重新分配扭矩,把更多的扭矩分配在不打滑的驱动轮上,使系统迅速脱离打滑状态,重新回到四轴动力平衡状态,使得微电脑鼠保持较高的冲刺能力;
5:微电脑鼠冲刺转向时,为了保证旋转的稳定性,采用四轮同控来实现转弯:需要停车时,ARM9处理器把动力平均分配到四个电机,四个电机采用相同的加速度进行同步减速,使微电脑鼠准确停车;然后在陀螺仪的控制下精确旋转需要的角度,然后进行加速,在加速行驶时,ARM9处理器把动力平均分配到四个电机,四个电机采用相同的加速度进行同步加速,到达设定速度时,释放前轮采用后轮驱动;由ARM9处理器结合转弯时间的要求根据轨迹的不同生成四路PWM控制直流电机X、电机Y、电机Z和电机R,完成四轴直流伺服系统的冋步转弯控制;
6:四轮微电脑鼠系统在正常行驶时如果设计不当造成重心前偏,将导致后侧驱动轮上承受的正压力减小,ARM9处理器会在其冲刺时自动调整后侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠快速次冲刺时打滑;
7:四轮微电脑鼠系统在正常行驶时如果设计不当造成重心侧偏,将导致一侧驱动轮上承受的正压力减小,ARM9处理器会在其冲刺时自动调整这一侧的动力分配,使系统处于一种新的平衡状态,防止微电脑鼠快速次冲刺时打滑;
8:由ARM9处理器处理微电脑鼠高速冲刺时的四只直流电机的伺服控制,使得控制比较简单,大大提高了运算速度,解决了单片机软件运行较慢的瓶颈,缩短了开发周期短,并且程序可移植能力强;
9:本发明基本实现全贴片元器件材料,实现了单板控制,不仅降低了微电脑鼠的体积,而且也降低了其重心,有利于其快速冲刺;
10:本发明加入了两片陀螺仪ADXRS300ABG,ADXRS300陀螺仪采用了 ADI公司的集成微电子机械系统(IMMS)专利工艺,带有集成信号调理的表面微机械角速度传感器比任何同功能的陀螺仪的尺寸小,功耗低,抗冲击和震动性好,一个陀螺仪的角速度可以按时间累计以便确定角坐标,这对于微电脑鼠连续旋转一定角度计算具有导航作用,可以实现两轮微电脑鼠的速度大小和方向的独立控制,有利于提高微电脑鼠冲刺时的稳定性和动态性能;另外一个陀螺仪来测量车轮转速,如果陀螺仪检测到车轮速度失控,控制器会使其回到控制状态;
11:为了提高运算速度和精度,本微电脑鼠采用国际上使用最多的红外发射器OPE5594A和红外接收器TSL262,并且对于前方的迷宫挡墙舍弃了国内单一传感器探测模式而采用双传感器探测,使得运算精度大大提高,有利于提高前方迷宫挡墙对高速冲刺时的导航作用;
12:由于本控制器采用ARM9处理器处理迷宫读取和冲刺算法,有效地防止了程序的“跑飞”,抗干扰能力大大增强;
13:由于本控制器采用来L298N芯片来驱动四轴直流电机,极大地减少了驱动电路所占用的空间,并提高了系统的效率和稳定性;
14:由ARM9处理器输出冲刺时PWM调制信号和方向信号,然后通过L298N芯片的使能端直接驱动直流电机,不仅减轻了 ARM9处理器的负担,而且简化了接口电路,使得系统的调试简单;
15:在微电脑鼠快速冲刺过程中,控制器会对直流电机的转矩进行在线辨识并利用电机力矩与电流的关系进行补偿,减少了电机转矩抖动对微电脑鼠快速冲刺的影;
16:由于微电脑鼠的四轮速度和方向独立控制,使得微电脑鼠更容易实现曲线轨迹的转动;
17:由于具有存储功能,这使得微电脑鼠可以轻易调取已经探索好的迷宫信息,可以优化二次冲刺的路径,降低冲刺时间;
18:根据对接触扣分不同的冲刺要求,本文设计多种冲刺方法,完全满足现实需要;
19:由于采用自动冲刺方法,所以从根本上杜绝了接触扣分;但是一旦遇到冲刺失败时,由于具有存储迷宫信息的功能,所以可以轻易调取已经优化的冲刺迷宫信息,减少了探索的环节;
20:为了减少冲刺时间,对于楼梯型冲刺迷宫采用45度对角线转法,比连续转法还要节省时间,并且在在冲刺阶段一直有前方的传感器SI和S6对柱子信息进行采集并时刻进行补偿,保证了冲刺的准确性和稳定性;
21:为了减少冲刺时间,对于M型迷宫采用U转法,由于在冲刺阶段一直有传感器进行补偿,增加了冲刺的稳定性;
22:对于多次连转由于采用综合考虑位置、速度和加速度参数,避免了单独转法的累计误差造成冲刺失败现象的发生。
[0038] 以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书内容所作的等效结构或等效流程变换,或直接或间接运用在其它相关的技术领域,均同理包括在本发明的专利保护范围内。

Claims (10)

1.一种基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,包括处理器单元、电机X、电机Y、电机Z、电机R以及微电脑鼠机械装置,所述的处理器单元分别与电机X、电机Y、电机Z以及电机R进行电性连接,所述的电机X、电机Y、电机Z以及电机R与微电脑鼠机械装置进行连接,其中,所述的处理器单元包括ARM9处理器和L298N芯片,所述的ARM9处理器和L298N芯片进行电性连接。
2.根据权利要求1所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的处理器单元分别发出第一控制信号、第二控制信号、第三控制信号以及第四控制信号,由第一控制信号、第二控制信号、第三控制信号以及第四控制信号分别对应控制电机X、电机Y、电机Z以及电机R。
3.根据权利要求1所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的处理器单元还包括设于ARM9处理器和L298N芯片的上位机系统和运动控制系统,所述的上位机系统包括迷宫读取模块、坐标定位模块以及在线输出模块,所述的运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块,其中,所述的迷宫读取模块、坐标定位模块、在线输出模块、数据存储模块以及I/O控制模块分别与所述的L298N芯片进行电性连接。
4.根据权利要求3所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的伺服控制模块还包括电流模块、速度模块以及坐标模块,所述的控制伺服控制模块与所述的ARM9处理器进行电性连接。
5.根据权利要求1所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的微电脑鼠连转冲刺系统还包括电池,所述的电池与所述的处理器单元进行电性连接。
6.根据权利要求5所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的电池为锂离子电池。
7.根据权利要求1所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的电机X、电机Y、电机Z和电机R均为高速永磁直流电机。
8.根据权利要求1所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的电机X、电机Y、电机Z和电机R的转轴上均设有光电编码器。
9.根据权利要求1所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的微电脑鼠机械装置上设有光电传感器、电压传感器以及六个屏蔽传感器,所述光电传感器、电压传感器以及屏蔽传感器分别与所述的处理器单元进行电性连接。
10.根据权利要求1所述的基于ARM9四轮快速微电脑鼠对角线冲刺系统,其特征在于,所述的微电脑鼠机械装置上设有两片陀螺仪,所述的陀螺仪与所述的处理器单元进行电性连接。
CN201310439573.XA 2013-09-24 2013-09-24 基于arm9四轮快速微电脑鼠对角线冲刺系统 CN103529834A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310439573.XA CN103529834A (zh) 2013-09-24 2013-09-24 基于arm9四轮快速微电脑鼠对角线冲刺系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310439573.XA CN103529834A (zh) 2013-09-24 2013-09-24 基于arm9四轮快速微电脑鼠对角线冲刺系统

Publications (1)

Publication Number Publication Date
CN103529834A true CN103529834A (zh) 2014-01-22

Family

ID=49931921

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310439573.XA CN103529834A (zh) 2013-09-24 2013-09-24 基于arm9四轮快速微电脑鼠对角线冲刺系统

Country Status (1)

Country Link
CN (1) CN103529834A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105005308A (zh) * 2015-08-24 2015-10-28 铜陵学院 基于stm32f407六轮灭火机器人伺服控制器
CN105159323A (zh) * 2015-08-24 2015-12-16 铜陵学院 六轮单核全自动低速灭火机器人伺服控制器

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62171011A (en) * 1986-01-23 1987-07-28 Casio Comput Co Ltd Control method for autonomic moving robot
EP1832398A1 (en) * 2006-03-10 2007-09-12 Abb Research Ltd. A robot controller, a computer unit and a base module for a robot controller
CN101239466A (zh) * 2007-12-28 2008-08-13 北京工业大学 一种微型迷宫机器人
CN102841618A (zh) * 2012-09-21 2012-12-26 苏州工业园区职业技术学院 新型微电脑鼠快速探索自动控制系统
CN102841620A (zh) * 2012-09-21 2012-12-26 苏州工业园区职业技术学院 新型微电脑鼠快速冲刺自动控制系统
CN203535486U (zh) * 2013-09-24 2014-04-09 苏州工业园区职业技术学院 基于arm9四轮快速微电脑鼠对角线冲刺系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62171011A (en) * 1986-01-23 1987-07-28 Casio Comput Co Ltd Control method for autonomic moving robot
EP1832398A1 (en) * 2006-03-10 2007-09-12 Abb Research Ltd. A robot controller, a computer unit and a base module for a robot controller
CN101239466A (zh) * 2007-12-28 2008-08-13 北京工业大学 一种微型迷宫机器人
CN102841618A (zh) * 2012-09-21 2012-12-26 苏州工业园区职业技术学院 新型微电脑鼠快速探索自动控制系统
CN102841620A (zh) * 2012-09-21 2012-12-26 苏州工业园区职业技术学院 新型微电脑鼠快速冲刺自动控制系统
CN203535486U (zh) * 2013-09-24 2014-04-09 苏州工业园区职业技术学院 基于arm9四轮快速微电脑鼠对角线冲刺系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
周建玉: "基于粒子群算法的迷宫电脑鼠应用研究", 《中国优秀硕士学位论文全文数据库-信息科技辑》 *
张辉辉 等: "基于ARM的电脑鼠控制系统研究", 《电子元器件应用》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105005308A (zh) * 2015-08-24 2015-10-28 铜陵学院 基于stm32f407六轮灭火机器人伺服控制器
CN105159323A (zh) * 2015-08-24 2015-12-16 铜陵学院 六轮单核全自动低速灭火机器人伺服控制器

Similar Documents

Publication Publication Date Title
CN104820429B (zh) 基于超声波距离检测的无人机避障系统及其控制方法
Son et al. Robust multirate control scheme with predictive virtual lanes for lane-keeping system of autonomous highway driving
CN103121447B (zh) 一种弯道防侧滑侧翻自动控制系统及方法
EP2437130B1 (en) Control apparatus for autonomous operating vehicle
Wu et al. The heterogeneous systems integration design and implementation for lane keeping on a vehicle
CN104932493A (zh) 一种自主导航的移动机器人及其自主导航的方法
CN103439977B (zh) 适用于光电跟踪仪的高速目标跟踪控制方法
KR20090108509A (ko) 차량의 조향 방법 및 그 장치
CN104267736B (zh) 一种帆船自主控制方法、装置及帆船
US20200275816A1 (en) Method for Detecting Skidding of Robot, Mapping Method and Chip
CN105353762A (zh) 基于双余度姿态传感器的六旋翼无人机及其控制方法
CN201886351U (zh) 一种用于迷宫冲刺的电脑鼠
CN108519773A (zh) 一种结构化环境下无人驾驶车辆的路径规划方法
CN105783612B (zh) 一种通用小型化数字电动舵机控制器及其控制方法
CN106054896A (zh) 一种智能导航机器人小车系统
CN105843071B (zh) 一种智能车辆运动控制实物仿真系统
CN107246876A (zh) 一种无人驾驶汽车自主定位与地图构建的方法及系统
CN101971116B (zh) 自动移动体及其控制方法、以及控制系统
CN104597912A (zh) 一种六旋翼无人直升机跟踪飞行控制系统及方法
JPH03265008A (en) Automatic traveling device
CN103121451B (zh) 一种弯路换道轨迹的跟踪控制方法
CN203909620U (zh) 具备自主航线飞行能力的六旋翼无人飞行器飞行控制系统
CN103523243B (zh) 非偏置动量单飞轮加磁控制方法
CN102815357B (zh) 一种基于惯性平衡轮的自平衡载人独轮车
CN202758242U (zh) 基于arm和fpga架构的固定翼无人机自动驾驶仪

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20140122