CN102841620B - 新型微电脑鼠快速冲刺自动控制系统 - Google Patents

新型微电脑鼠快速冲刺自动控制系统 Download PDF

Info

Publication number
CN102841620B
CN102841620B CN201210354024.8A CN201210354024A CN102841620B CN 102841620 B CN102841620 B CN 102841620B CN 201210354024 A CN201210354024 A CN 201210354024A CN 102841620 B CN102841620 B CN 102841620B
Authority
CN
China
Prior art keywords
module
speed
micro computer
computer mouse
mouse
Prior art date
Application number
CN201210354024.8A
Other languages
English (en)
Other versions
CN102841620A (zh
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 CN201210354024.8A priority Critical patent/CN102841620B/zh
Publication of CN102841620A publication Critical patent/CN102841620A/zh
Application granted granted Critical
Publication of CN102841620B publication Critical patent/CN102841620B/zh

Links

Abstract

本发明公开了一种新型微电脑鼠快速冲刺自动控制系统,包括处理器单元、第一控制器、第二控制器、第一高速直流电机、第二高速直流电机以及微电脑鼠,所述的处理器单元发出控制信号至所述的第一控制器和第二控制器,由所述的第一控制器分别控制第二高速直流电机和第一高速直流电机,通过第一高速直流电机和第二高速直流电机的驱动信号经过信号处理器合成之后,由所述的第一高速直流电机控制微电脑鼠的速度,所述的第二高速直流电机控制微电脑鼠的方向,其中,所述的处理器单元为一双核处理器,包括单片机和LM629芯片。本发明在形成基于单片机+LM629的双核处理器,把单片机从繁重的工作量中解脱出来,抗干扰能力大大增强。

Description

新型微电脑鼠快速冲刺自动控制系统
技术领域
[0001] 本发明是有关于微型机器人的技术领域,且特别是有关于新型微电脑鼠快速冲刺 自动控制系统。
背景技术
[0002] 微电脑鼠是使用嵌入式微控制器、传感器和机电运动部件构成的一种智能行走机 器人,在国外已经竞赛了将近30年,由其原理可以转化为多种实际的工业机器人,近几年 内才引进国内,并逐渐成为一个新兴的竞赛项目。微电脑鼠可以在不同"迷宫"中自动记忆 和选择路径,采用相应的算法,快速地到达所设定的目的地。一只优秀的微电脑鼠必须具备 良好的感知能力,有良好的行走能力,优秀的智能算法,一只完整的微电脑鼠在大体分为以 下几个部分:
[0003] 1)传感器:传感器是微电脑鼠的眼睛,是微电脑鼠准确获取外部环境信息的依据, 然后把外界信息输送到微处理器进行各种条件判断。
[0004] 2)电机:执行电机是微电脑鼠的动力源,它根据微处理器的指令来执行微电脑鼠 在迷宫中行走时的相关动作。
[0005] 3)算法:算法是微电脑鼠的灵魂。微电脑鼠必须采用一定的智能算法才能找到终 点,才能找到一条最短的路径,在最短的时间内到达终点。
[0006] 4)微处理器:微处理器是微电脑鼠的核心部分,是微电脑鼠的大脑。微电脑鼠所 有的信息,包括墙壁信息,位置信息,角度信息和电机状态信息等都需要经过微处理器处理 并做出相应的判断。
[0007] 微电脑鼠结合了多学科知识,对于提升在校学生的动手能力、团队协作能力和创 新能力,促进学生课堂知识的消化和扩展学生的知识面都非常有帮助。另外电脑鼠走迷宫 极具趣味性,容易得到学生的认同及参与,并能很好的激发和引导学生这方面的兴趣和爱 好。其开展必然提升参赛者在相关领域的技术水平和应用能力,为技术创新提供平台。可 以培养大批相关领域的人才,进而促进相关领域的技术发展和产业化进程。
[0008] 由于国内研发此机器人的单位较少,对国际规则读取水平较低,相对水平比较落 后,现有技术中的新型微电脑鼠快速冲刺自动控制系统制包含一个单片机,如图1所示。长 时间运行发现存在着很多安全问题,包括 :
[0009] (1)作为微电脑鼠的眼睛采用的是超声波或者是一般的红外传感器,使得微电脑 鼠在快速冲刺时对周围迷宫的判断存在一定的误判;
[0010] (2)作为微电脑鼠的执行机构采用的是步进电机,经常会遇到丢失脉冲的问题出 现,导致对冲刺位置的记忆出现错误;
[0011] (3)由于采用步进电机,使得机体发热比较严重,不利于在大型复杂迷宫中快速冲 刺;
[0012] (4)由于采用比较低级的算法,在迷宫当中的冲刺一般都要花费15~30秒的时间, 这使得在真正的大赛中无法取胜;
[0013] (5)由于微电脑鼠在快速冲刺过程中要频繁的刹车和启动,加重了单片机的工作 量,单片信号处理器无法满足微电脑鼠快速冲刺的要求;
[0014] (6)相对采用的都是一些体积比较大的插件元器件使得微电脑鼠的体积比较庞 大,无法满足快速冲刺的要求;
[0015] (7)由于受周围环境不稳定因素干扰,特别是周围一些光线的干扰,单片机控制器 经常会出现异常,引起微电脑鼠失控,抗干扰能力较差;
[0016] (8)对于差速控制的微电脑鼠来说,一般要求其两个电机的控制信号要同步,但是 对于单一单片机来说又很难办到,使得微电脑鼠在直道上行驶的时候就要来回的补偿,特 别是对于高速冲刺时,微电脑鼠有的时候在迷宫当中摇摆幅度较大;
[0017] (9)由于受单片机容量和算法影响,微电脑鼠对迷宫的信息没有存储,当遇到掉电 情况时候所有的信息将消失,这使得整个冲刺过程无法完成。
[0018] 因此,需要对现有的基于单片机控制的新型微电脑鼠快速冲刺自动控制系统进行 重新设计。
发明内容
[0019] 针对上述问题,本发明的目的是提供一种新型微电脑鼠快速冲刺自动控制系统, 解决了现有技术中抗干扰能力差的问题。
[0020] 为解决上述技术问题,本发明采用的一个技术方案是:提供一种新型微电脑鼠快 速冲刺自动控制系统,包括处理器单元、第一控制器、第二控制器、第一高速直流电机、第二 高速直流电机以及微电脑鼠,所述的处理器单元发出控制信号至所述的第一控制器和第二 控制器,由所述的第一控制器分别控制第二高速直流电机和第一高速直流电机,通过第一 高速直流电机和第二高速直流电机的驱动信号经过信号处理器合成之后,由所述的第一高 速直流电机控制微电脑鼠的速度,所述的第二高速直流电机控制微电脑鼠的方向,其中,所 述的处理器单元为一双核处理器,包括单片机和LM629芯片。
[0021] 在本发明一个较佳实施例中,所述的处理器单元还包括设于单片机和LM629芯片 的上位机系统和运动控制系统,所述的上位机系统包括迷宫读取模块、坐标定位模块以及 在线输出模块,所述的运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块, 其中,单片机用于控制迷宫读取模块、坐标定位模块、在线输出模块、数据存储模块以及I/O 控制模块,LM629芯片用于控制伺服控制模块,且单片机及LM629芯片之间实时进行数据交 换和调用。
[0022] 在本发明一个较佳实施例中,所述的快速冲刺自动控制系统还包括电池,所述的 电池为锂离子电池。
[0023] 在本发明一个较佳实施例中,所述的伺服控制模块还包括转换模块,所述的转换 模块包括模拟数字转换器及数字模拟转换器。
[0024] 在本发明一个较佳实施例中,所述的伺服控制模块还包括编码器模块,所述的编 码器模块用于检测微电脑鼠实际转速,判断是否符合速度要求,是否过快或过慢,并发出控 制信号。
[0025] 在本发明一个较佳实施例中,所述的伺服控制模块还包括电流模块,所述的电流 模块用于调整电池的供电功率达到微电脑鼠需要的范围。
[0026] 在本发明一个较佳实施例中,所述的伺服控制模块还包括速度模块,所述的速度 模块与编码器模块通讯连接,当编码器模块检测微电脑鼠实际转速过快或过慢,速度模块 根据编码器模块检测的结果来调节微电脑鼠实际转速。
[0027] 在本发明一个较佳实施例中,所述的伺服控制模块还包括坐标模块,所述的坐标 模块用于检测微电脑鼠的坐标位置,接到控制器发出的冲刺命令后,会沿着起点开始快速 向终点冲刺。
[0028] 本发明的新型微电脑鼠快速冲刺自动控制系统,为了提高运算速度,保证新型微 电脑鼠快速冲刺自动控制系统的稳定性和可靠性,本发明在处理器单元的单片机中引入 LM629芯片,形成基于单片机+LM629的双核处理器,此处理器单元充分考虑电池在这个 系统的作用,把新型微电脑鼠快速冲刺自动控制系统中工作量最大的两轴伺服系统交给 LM629芯片处理,充分发挥LM629芯片数据处理速度较快的特点,而迷宫读取模块、坐标定 位模块、在线输出模块、数据存储模块以及I/O控制模块交给单片机控制,这样就实现了单 片机与LM629芯片的分工,把单片机从繁重的工作量中解脱出来,抗干扰能力大大增强。
附图说明
[0029] 图1为现有技术的新型微电脑鼠快速冲刺自动控制系统的方框图;
[0030] 图2为本发明较佳实施例的新型微电脑鼠快速冲刺自动控制系统的方框图;
[0031] 图3为图2中处理器单元的方框图;
[0032] 图4为本发明较佳实施例的微电脑鼠迷宫示意图;
[0033] 图5为微电脑鼠速度曲线图;
[0034] 图6为微电脑鼠右转冲刺示意图;
[0035] 图7为微电脑鼠左转冲刺意义图。
具体实施方式
[0036] 下面结合附图对本发明的较佳实施例进行详细阐述,以使本发明的优点和特征能 更易于被本领域技术人员理解,从而对本发明的保护范围做出更为清楚明确的界定。
[0037] 单片机自20世纪70年代末诞生至今,经历了单片微型计算机SCM、微控制器MCU 及片上系统SoC三大阶段,前两个阶段分别以MCS-51和80C51为代表。随着在嵌入式领域 中对单片机的性能和功能要求越来越高,以往的单片机无论是运行速度还是系统集成度等 多方面都不能满足新的设计需要,这时Silicon Labs公司推出了 C8051F系列单片机,成 为SoC的典型代表。C8051F具有上手快(全兼容8051指令集)、研发快(开发工具易用, 可缩短研发周期)和见效快(调试手段灵活)的特点,其性能优势具体体现在以下方面: 基于增强的CIP-51内核,其指令集与MCS-51完全兼容,具有标准8051的组织架构,可以使 用标准的803χ/805χ汇编器和编译器进行软件开发。CIP-51采用流水线结构,70%的的指 令执行时间为1或2个系统时钟周期,是标准8051指令执行速度的12倍;其峰值执行速度 可达100MIPS(C8051F120等),是目前世界上速度最快的8位单片机;增加了中断源。标准 的8051只有7个中断源Silicon Labs公司C8051F系列单片机扩展了中断处理这对于 时实多任务系统的处理是很重要的扩展的中断系统向CIP-51提供22个中断源允许大量的 模拟和数字外设中断一个中断处理需要较少的CPU干预却有更高的执行效率;集成了丰富 的模拟资源,绝大部分的C8051F系列单片机都集成了单个或两个ADC,在片内模拟开关的 作用下可实现对多路模拟信号的采集转换;片内ADC的采样精度最高可达24bit,采样速率 最高可达500ksps,部分型号还集成了单个或两个独立的高分辨率DAC,可满足绝大多数混 合信号系统的应用并实现与模拟电子系统的无缝接口;片内温度传感器则可以迅速而精确 的监测环境温度并通过程序作出相应处理,提高了系统运行的可靠性。选用C8051F120作 为本系统的中央处理器完全能够满足系统的需要。
[0038] LM629芯片是National semiconductor生产的一款用于精密运动控制的专用芯 片,有24脚和28脚二种表面安装式封装,在一个芯片内集成了数字式运动控制的全部功 能,使得设计一个快速、准确的运动控制系统的任务变得轻松、容易,它有以下特性:
[0039] 1)工作频率为6MHz和8MHz,工作温度范围为-40°C〜+85°C,使用5V电源。
[0040] 2) 32位的位置、速度和加速度存器;
[0041] 3) 8位分辨率的PWM脉宽调制输出;
[0042] 4) 16位可编程数字PID控制器;
[0043] 5)内部的梯形速度发生器;
[0044] 6)该芯片可实时修改速度、目标位置和PID控制参数;
[0045] 7)实时可编程中断;可编程微分项采样间隔;
[0046] 8)对增量码盘信号进行四倍频;
[0047] 9)可设置于速度或位置伺服两种工作状态。
[0048] 上述特点使得LM629芯片特别适合伺服运动控制中。
[0049] 如图2所示,为本发明较佳实施例的新型微电脑鼠快速冲刺自动控制系统的方框 图。本实施例中,新型微电脑鼠快速冲刺自动控制系统包括电池、处理器单元、第一控制器、 第二控制器、第一高速直流电机、第二高速直流电机以及微电脑鼠。其中,所述的电池为锂 离子电池,是一种供电装置,为整个系统的工作提供工作电压。
[0050] 本发明中所述的处理器单元内置控制系统,所述的处理器单元发出控制信号至所 述的第一控制器和第二控制器,由所述的第一控制器分别控制第二高速直流电机和第一高 速直流电机,通过第一高速直流电机和第二高速直流电机的驱动信号经过信号处理器合成 之后,由所述的第一高速直流电机控制微电脑鼠的速度,所述的第二高速直流电机控制微 电脑鼠的方向。其中,所述的处理器单元为一双核处理器,包括单片机和LM629芯片。
[0051] 本发明为克服单一的单片机不能满足新型微电脑鼠快速冲刺自动控制系统的稳 定性和快速性的要求,舍弃了新型微电脑鼠快速冲刺自动控制系统所采用单一的单片机的 工作模式,提供了基于单片机+LM629芯片的全新控制模式。处理器单元以LM629芯片为处 理核心,实现数字信号的实时处理,把单片机从复杂的工作当中解脱出来,实现部分的信号 处理算法和LM629芯片的控制逻辑,并响应中断,实现数据通信和存储实时信号。
[0052] 请参阅图3,所述的处理器单元为一双核处理器,其包括单片机及LM629芯片,二 者可相互通讯,实时进行数据交换和调用。所述的处理器单元还包括设于单片机以及LM629 芯片的上位机系统和运动控制系统,所述的上位机系统包括迷宫读取模块、坐标定位模块 以及在线输出模块,所述的运动控制系统包括伺服控制模块、数据存储模块以及I/O控制 模块,其中,单片机用于控制迷宫读取模块、坐标定位模块、在线输出模块、数据存储模块以 及I/O控制模块,LM629芯片用于控制伺服控制模块。
[0053] 上位机系统包括迷宫读取模块、坐标定位模块以及在线输出模块。迷宫读取模块 将已经预设好的迷宫进行调出;坐标定位模用于提示微电脑鼠的位置以及位置参数设置 等;在线输出模块用于提示微电脑鼠的工作状态。
[0054] 运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块。其中,数据存 储模块为一存储器;I/O控制模块包括RS-232串行接口、ICE端口等。伺服控制模块进一步 包括转换模块、编码器模块、电流模块、速度模块以及坐标模块。
[0055] 其中,所述的转换模块包括模拟数字转换器(ADC, Analog to Digital Converter)及数字模拟转换器(DAC,Digital to Analog Converter);所述的编码器模块 用于检测微电脑鼠实际转速,判断是否符合速度要求,是否过快或过慢,并发出控制信号。
[0056] 所述的电流模块与电池和控制器、转换模块连接。转换模块根据电池和控制器的 电流,判断工作功率,并把功率状况反馈至电池,电流模块用于调整电池的供电功率达到微 电脑鼠需要的范围。
[0057] 所述的速度模块与编码器模块通讯连接,当编码器模块检测微电脑鼠实际转速过 快或过慢,速度模块根据编码器模块检测的结果来调节微电脑鼠实际转速。
[0058] 所述的坐标模块用于检测微电脑鼠的坐标位置,接到控制器发出的冲刺命令后, 会沿着起点开始快速向终点冲刺。
[0059] 对于处理器单元为一双核处理器,在电源打开状态下,微电脑鼠先进入自锁状态, 然后把微电脑鼠放在迷宫起始点,微电脑鼠靠前方、左右侧面蔽障传感器根据实际导航环 境传输参数给处理器单元中的单片机,单片机处理后与LM629芯片通讯,然后由LM629芯片 处理两个独立电机的伺服控制,并把处理数据通讯给单片机,由单片机继续处理后续的运 行状态。
[0060] 结合以上描述,上位机系统包括迷宫读取模块、坐标定位模块、在线输出模块;运 动控制系统包括伺服控制模块、数据存储模块、1/0控制模块。其中,工作量最大的伺服控 制模块交给LM629芯片控制,其余的包括上位机系统的全部模块交给单片机控制,这样就 实现了单片机与LM629芯片的分工,同时二者之间也可以进行通讯,实时进行数据交换和 调用。
[0061] 其具体的功能实现如下:
[0062] 1)在微电脑鼠未接到冲刺命令之前,如图4所示,它一般会在起点坐标(0,0)等待 控制器发出的冲刺命令,并调出已经探索后的最优迷宫,一旦接到冲刺命令后,会沿着起点 开始快速向终点(7, 7)、(7,8)、(8, 7)、(8,8)冲刺;
[0063] 2)微电脑鼠放在起点坐标(0,0),接到任务后为了防止放错冲刺方向,其前方的传 感器SI、S6和会对前方的环境进行判断,确定有没有挡墙进入运动范围,如存在挡墙将向 单片机发出中断请求,单片机会对中断做第一时间响应,如果单片机的中断响应没有来得 及处理,微电脑鼠的第一马达和第二马达将继续自锁,然后二次判断迷宫确定前方信息,防 止信息误判,如果没有挡墙进入前方的运动范围,微电脑鼠将进行正常的冲刺;
[0064] 3)在微电脑鼠沿着Y轴向前运动如果有多个坐标没有挡墙进入前方的运动范围, 微电脑鼠将存储其坐标(X,Y),为了快速行走需要,舍弃了传统单一速度冲刺模式,按照图 5的速度和时间曲线进行加速和减速,在其向前运动过程中,每经过一个方格,将更新其坐 标为《,¥+1),在¥+1〈15的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、(8,8)其中的 一个,如果不是的话将继续更新其坐标,如果是的话通知控制器已经冲刺到目标,然后置返 航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返程探索,去搜寻更优的迷宫 路径;
[0065] 4)在微电脑鼠沿着Y轴反向运动过程中如果有多个坐标没有挡墙进入前方的运 动范围,微电脑鼠将存储此时坐标(X,Y),为了快速行走需要,舍弃了传统单一速度冲刺模 式,按照图5的速度和时间曲线进行加速和减速,在其向前运动过程中,每经过一个方格, 将更新其坐标为(X,Y-1),在确定Y-l>〇的前提下,判断其坐标是不是(7,7)、(7,8)、(8,7)、 (8,8)其中的一个,如果不是的话将继续更新其坐标,如果是的话通知控制器已经冲刺到目 标,然后置返航探索标志为1,冲刺标志为〇,微电脑鼠准备冲刺后的二次返程探索,去搜寻 更优的迷宫路径;
[0066] 5)在微电脑鼠沿着Υ轴向前运动过程中如果有挡墙进入前方的运动范围,并且 此时迷宫信息中左方有挡墙时,微电脑鼠将存储此时坐标(X,Υ),然后进入图6所示的曲 线运动轨迹,在右冲刺转弯时,微电脑鼠将首先前往直线走很短的距离DashTurn_R90_ Leading,此时R90_FrontWallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结 束后开始调整两个第一马达和第二马达速度为DashTurn_R90_VelXl和DashTurn_R90_ VelYl,此速度使微电脑鼠沿轨迹转过一段距离DashTUrn_R90_ArC 1,随后,微电脑鼠开始调 整速度为DashTurn_R90_VelX2和DashTurn_R90_VelY2,此速度使微电脑鼠沿轨迹转过一 段距离DashTurn_R90_Arc2,最后微电脑鼠再移动一段距离DashTurn_R90_Passing,完成 整个右转弯的轨迹曲线运动,此时将更新其坐标为(X+1,Y),在X+l〈15的前提下,判断其坐 标是不是(7, 7)、(7,8)、(8, 7)、(8,8)其中的一个,如果不是的话将继续更新其坐标,如果是 的话通知控制器已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备 冲刺后的二次返程探索,去搜寻更优的迷宫路径;
[0067] 6)在微电脑鼠沿着Y轴向前运动过程中如果有挡墙进入前方的运动范围,并且 此时迷宫信息中右方有挡墙时,微电脑鼠将存储此时坐标(Χ,γ),然后进入图7所示的曲 线运动轨迹,在左冲刺转弯时,微电脑鼠将首先前往直线走很短的距离DashTurn_L90_ Leading,此时L90_FrontWallRef开始工作,防止外界干扰开始做误差补偿,误差补偿结束 后开始调整两个马达X和马达Y速度为DashTurn_L90_Vein和DashTurn_L90_VelYl,此 速度使微电脑鼠沿轨迹转过一段距离DashT Urn_L90_ArCl,随后,微电脑鼠开始调整速度 为DashTurn_L90_VelX2和DashTurn_L90_VelY2,此速度使微电脑鼠沿轨迹转过一段距离 DashTurn_L90_Arc2,最后电子鼠再移动一段距离DashTurn_L90_Passing,完成整个左转弯 的轨迹曲线运动。此时将更新其坐标为(x-l,Y),在x-l>0的前提下,判断其坐标是不是(7, 7)、(7,8)、(8,7)、(8,8)其中的一个,如果不是将继续更新其坐标,如果是的话通知控制器 已经冲刺到目标,然后置返航探索标志为1,冲刺标志为0,微电脑鼠准备冲刺后的二次返 程探索,去搜寻更优的迷宫路径;
[0068] 7)当微电脑鼠冲刺到达(7,7)、(7,8)、(8,7)、(8,8)后会准备冲刺后的返程探索 以便搜寻更优的路径,控制器会调出其已经存储的迷宫信息,然后计算出可能存在的其它 最佳路径,然后返程开始进入其中认为最优的一条;
[0069] 8)在微电脑鼠进入迷宫返程探索时,并其导航的传感器5142、53、54、55和56将 工作,并把反射回来的光电信号送给单片机,经单片机判断后送给LM629芯片,由LM629芯 片运算后与单片机进行通讯,然后由控制器送控制信号给导航的第一高速直流电机和第二 高速直流电机进行确定:如果进入已经搜索的区域将进行快速前进,如果是未知返回区域 则采用正常速度搜索,并时刻更新其坐标(X,Y),并判断其坐标是不是(〇,〇),如果是的话 置返航探索标志为0,微电脑鼠进入冲刺阶段,并置冲刺标志为1 ;
[0070] 9)为了能够实现微电脑鼠准确的坐标计算功能,本发明在第一高速直流电机和第 二高速直流电机的轴上上加入了 512线的光码盘,时刻对微电脑鼠运行的距离进行计算并 根据迷宫挡墙和柱子对传感器反馈信息不同的特点引入了补偿,使得微电脑鼠的冲刺坐标 计算不会出现错误;
[0071] 10)为了能够减少光源对微电脑鼠冲刺的干扰,本发明加入了光电传感器S7,此传 感器会在微电脑鼠冲刺阶段对周围的异常光源进行读取,并自动送给控制器做实时补偿, 消除了外界光源对冲刺的干扰。
[0072] 综上所述的,本发明揭示的新型微电脑鼠快速冲刺自动控制系统,为了提高运算 速度,保证新型微电脑鼠快速冲刺自动控制系统的稳定性和可靠性,本发明在处理器单元 的单片机中引入LM629芯片,形成基于单片机+LM629的双核处理器,此处理器单元充分考 虑电池在这个系统的作用,把新型微电脑鼠快速冲刺自动控制系统中工作量最大的两轴伺 服系统交给LM629芯片处理,充分发挥LM629芯片数据处理速度较快的特点,而迷宫读取模 块、坐标定位模块、在线输出模块、数据存储模块以及I/O控制模块交给单片机控制,这样 就实现了单片机与LM629芯片的分工,把单片机从繁重的工作量中解脱出来,抗干扰能力 大大增强。
[0073] 本发明新型微电脑鼠快速冲刺自动控制系统具有的有益效果是:
[0074] 1 :在运动过程中,充分考虑了电池在这个系统中的作用,基于单片机+LM629的处 理器单元时刻都在对微电脑鼠的运行状态进行监测和运算,避免了大电流的产生,并且时 刻显示锂离子电池的S0C,有利于了解电池的能量状态,当状态较低时,可以在冲刺前提前 换掉电池,从而减少了电池对高速冲刺的误干扰;
[0075] 2 :由LM629芯片处理微电脑鼠高速冲刺时的两只电机的伺服控制,使得控制比较 简单,大大提高了运算速度,解决了单片机软件运行较慢的瓶颈,缩短了开发周期短,并且 系统可移植能力强;
[0076] 3:本发明基本实现全贴片元器件材料,实现了单板控制,不仅降低了微电脑鼠的 体积,而且也降低了其重心,有利于其快速冲刺;
[0077] 4:本发明实现了微电脑鼠的速度大小和方向的独立控制,有利于提高微电脑鼠小 车的稳定性和动态性能;
[0078] 5 :为了提高运算速度和精度,本微电脑鼠采用了国际上使用最多的红外发射器 0PE5594A和红外接收器接收器TSL262,使得运算精度大大提高,有利于提高高速冲刺时对 前面迷宫挡墙的探知;
[0079] 6 :由于本控制器采用LM629芯片处理大量的数据与算法,并充分考虑了周围的干 扰源,并把单片机从繁重的工作量中解脱出来,抗干扰能力大大增强;
[0080] 7:在微电脑鼠快速冲刺过程中,控制器会对电机的转矩进行在线辨识并利用电机 力矩与电流的关系进行补偿,减少了电机转矩抖动对微电脑鼠快速冲刺的影响;
[0081] 8 :由于微电脑鼠的速度和方向独立控制,使得微电脑鼠更容易实现曲线轨迹的转 动;
[0082] 9:由于具有存储功能,这使得微电脑鼠可以轻易调取已经探索好的迷宫信息,可 以优化二次冲刺的路径,降低冲刺时间;
[0083] 10 :由于采用的单片机是工业级的C8051F120,在满足实用性的同时,其内核就是 传统的8051的内核,使得编程者可以很好的二次开发。
[0084] 以上所述的仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本 发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的 技术领域,均同理包括在本发明的专利保护范围内。

Claims (7)

1. 一种新型微电脑鼠快速冲刺自动控制系统,其特征在于,包括处理器单元、第一控制 器、第二控制器、第一高速直流电机、第二高速直流电机以及微电脑鼠,所述的处理器单元 发出控制信号至所述的第一控制器和第二控制器,由所述的第一控制器分别控制第二高速 直流电机和第一高速直流电机,通过第一高速直流电机和第二高速直流电机的驱动信号经 过信号处理器合成之后,由所述的第一高速直流电机控制微电脑鼠的速度,所述的第二高 速直流电机控制微电脑鼠的方向,其中,所述的处理器单元为一双核处理器,包括单片机和 LM629芯片, 其中,所述的处理器单元以LM629芯片为处理核心,所述的处理器单元还包括设于单 片机和LM629芯片的上位机系统和运动控制系统,所述的上位机系统包括迷宫读取模块、 坐标定位模块以及在线输出模块,所述的运动控制系统包括伺服控制模块、数据存储模块 以及I/O控制模块,其中,单片机用于控制迷宫读取模块、坐标定位模块、在线输出模块、数 据存储模块以及I/O控制模块,LM629芯片用于控制伺服控制模块,且单片机和LM629芯片 之间实时进行数据交换和调用, 在电源打开状态下,微电脑鼠先进入自锁状态,然后把微电脑鼠放在迷宫起始点,微电 脑鼠靠前方、左右侧面蔽障传感器根据实际导航环境传输参数给处理器单元中的单片机, 单片机处理后与LM629芯片通讯,然后由LM629芯片处理两个独立电机的伺服控制,并把处 理数据通讯给单片机,由单片机继续处理后续的运行状态。
2. 根据权利要求1所述的新型微电脑鼠快速冲刺自动控制系统,其特征在于,所述的 快速冲刺自动控制系统还包括电池,所述的电池为锂离子电池。
3. 根据权利要求1所述的新型微电脑鼠快速冲刺自动控制系统,其特征在于,所述的 伺服控制模块还包括转换模块,所述的转换模块包括模拟数字转换器及数字模拟转换器。
4. 根据权利要求1所述的新型微电脑鼠快速冲刺自动控制系统,其特征在于,所述的 伺服控制模块还包括编码器模块,所述的编码器模块用于检测微电脑鼠实际转速,判断是 否符合速度要求,是否过快或过慢,并发出控制信号。
5. 根据权利要求2所述的新型微电脑鼠快速冲刺自动控制系统,其特征在于,所述的 伺服控制模块还包括电流模块,所述的电流模块用于调整电池的供电功率达到微电脑鼠需 要的范围。
6. 根据权利要求4所述的新型微电脑鼠快速冲刺自动控制系统,其特征在于,所述的 伺服控制模块还包括速度模块,所述的速度模块与编码器模块通讯连接,当编码器模块检 测微电脑鼠实际转速过快或过慢,速度模块根据编码器模块检测的结果来调节微电脑鼠实 际转速。
7. 根据权利要求1所述的新型微电脑鼠快速冲刺自动控制系统,其特征在于,所述的 伺服控制模块还包括坐标模块,所述的坐标模块用于检测微电脑鼠的坐标位置,接到控制 器发出的冲刺命令后,会沿着起点开始快速向终点冲刺。
CN201210354024.8A 2012-09-21 2012-09-21 新型微电脑鼠快速冲刺自动控制系统 CN102841620B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210354024.8A CN102841620B (zh) 2012-09-21 2012-09-21 新型微电脑鼠快速冲刺自动控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210354024.8A CN102841620B (zh) 2012-09-21 2012-09-21 新型微电脑鼠快速冲刺自动控制系统

Publications (2)

Publication Number Publication Date
CN102841620A CN102841620A (zh) 2012-12-26
CN102841620B true CN102841620B (zh) 2014-10-29

Family

ID=47369088

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210354024.8A CN102841620B (zh) 2012-09-21 2012-09-21 新型微电脑鼠快速冲刺自动控制系统

Country Status (1)

Country Link
CN (1) CN102841620B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103472835B (zh) * 2013-09-16 2017-01-04 苏州工业园区职业技术学院 基于双核四轮微电脑鼠快速冲刺控制器

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102841618B (zh) * 2012-09-21 2014-10-29 苏州工业园区职业技术学院 新型微电脑鼠快速探索自动控制系统
CN103472834B (zh) * 2013-09-16 2017-03-22 苏州工业园区职业技术学院 基于双核两轮微电脑鼠超快速冲刺控制器
CN103529835A (zh) * 2013-09-24 2014-01-22 苏州工业园区职业技术学院 基于双核四轮极速微电脑鼠连转冲刺系统
CN103529833A (zh) * 2013-09-24 2014-01-22 苏州工业园区职业技术学院 基于双核四轮极速微电脑鼠对角线冲刺系统
CN103529832A (zh) * 2013-09-24 2014-01-22 苏州工业园区职业技术学院 基于双核四轮高速微电脑鼠对角线冲刺系统
CN103529834A (zh) * 2013-09-24 2014-01-22 苏州工业园区职业技术学院 基于arm9四轮快速微电脑鼠对角线冲刺系统
CN103529840A (zh) * 2013-10-10 2014-01-22 苏州工业园区职业技术学院 一种两轮微电脑鼠双核控制器高速连转冲刺伺服系统
CN103529846B (zh) * 2013-10-18 2016-08-17 江苏若博机器人科技有限公司 基于双核四轮高速微电脑鼠连转冲刺伺服系统
CN103869816A (zh) * 2014-04-01 2014-06-18 吉林大学 基于stm32控制的双直流电机电脑鼠系统

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102841618A (zh) * 2012-09-21 2012-12-26 苏州工业园区职业技术学院 新型微电脑鼠快速探索自动控制系统
CN202838024U (zh) * 2012-09-21 2013-03-27 苏州工业园区职业技术学院 新型微电脑鼠快速冲刺自动控制系统

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102841618A (zh) * 2012-09-21 2012-12-26 苏州工业园区职业技术学院 新型微电脑鼠快速探索自动控制系统
CN202838024U (zh) * 2012-09-21 2013-03-27 苏州工业园区职业技术学院 新型微电脑鼠快速冲刺自动控制系统

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
张筱云等.微电脑鼠伺服控制器的设计与研究.《微电子》.2011,第44卷(第12期),第79-82页.
微电脑鼠伺服控制器的设计与研究;张筱云等;《微电子》;20111231;第44卷(第12期);第79-82页 *
电脑鼠模糊PID控制算法研究;薛艳;《中国优秀硕士论文全文数据库电子期刊》;20110315;第51-60页 *
薛艳.电脑鼠模糊PID控制算法研究.《中国优秀硕士论文全文数据库电子期刊》.2011,第51-60页.

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103472835B (zh) * 2013-09-16 2017-01-04 苏州工业园区职业技术学院 基于双核四轮微电脑鼠快速冲刺控制器

Also Published As

Publication number Publication date
CN102841620A (zh) 2012-12-26

Similar Documents

Publication Publication Date Title
CN107200020B (zh) 一种基于混杂理论的无人驾驶汽车自主转向控制系统和方法
Juang et al. Design and control of a two-wheel self-balancing robot using the arduino microcontroller board
CN101791800B (zh) 一种双轮差动式机器人运动控制方法
CN104199465B (zh) 一种高集成化高精度平板自跟踪天线伺服控制系统
CN107167141A (zh) 基于双一线激光雷达的机器人自主导航系统
CN103592944A (zh) 一种超市购物机器人及其行进路径规划方法
CN101592951B (zh) 分布式仿人机器人通用控制系统
CN102393744B (zh) 一种无人驾驶汽车的导航方法
Engin et al. Path planning of line follower robot
CN106054896A (zh) 一种智能导航机器人小车系统
CN103753534A (zh) 一种移动机器人控制器及其控制方法
CN108153145A (zh) 一种基于pid和滤波算法的列车速度自动控制方法
CN108609014B (zh) 智能车辆的横向控制方法及装置
CN103760908A (zh) 一种巡视器闭环跟踪控制方法
CN107883962A (zh) 一种多旋翼无人机在三维环境下的动态航路规划方法
CN101231797A (zh) 硬件在环智能小车教学科研实验平台
CN104597905A (zh) 磁导航agv的路径跟踪方法
CN106020197B (zh) 一种基于势能场的机器人路径跟踪算法
CN107479558A (zh) 基于车辆运动模型的无人车辆野外路径规划方法
CN105511475A (zh) 一种基于运动模式判断的无人车纵向控制方法
CN205193589U (zh) 基于多传感器的智能循迹小车控制系统
CN105643589A (zh) 一种自主排障式智能车系统
CN106772434B (zh) 一种基于TegraX1雷达数据的无人车障碍物检测方法
CN105033996B (zh) 基于手推示教式五轴水平关节机器人的控制系统
CN103092174A (zh) 工业机器人无线示教控制器

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
C14 Grant of patent or utility model
CB03 Change of inventor or designer information

Inventor after: Zhang Haoming

Inventor before: Zhang Haoming

Inventor before: Wang Yinghai

Inventor before: Zhang Xiaoyun

TR01 Transfer of patent right

Effective date of registration: 20160322

Address after: 215021 Suzhou Industrial Park, Jiangsu, if waterway No. 1

Patentee after: Zhang Haoming

Address before: 215021 Suzhou Industrial Park, Jiangsu, if waterway No. 1

Patentee before: Suzhou Industrial Park Institute of Vocational Technology

COR Change of bibliographic data
C41 Transfer of patent application or patent right or utility model
TR01 Transfer of patent right

Effective date of registration: 20160630

Address after: 211106, Jiangsu, Nanjing, Jiangning economic and Technological Development Zone, No. 19 Su source Avenue, Kowloon lake international enterprise headquarters park, block C4, first floor

Patentee after: Jiangsu Robobor Bobot Technology Co., Ltd.

Address before: 215021 Suzhou Industrial Park, Jiangsu, if waterway No. 1

Patentee before: Zhang Haoming

C41 Transfer of patent application or patent right or utility model