一种可自动跟随移动终端行走的小车的制作方法
【技术领域】
[0001]本发明涉及自动控制技术，具体涉及一种可自动跟随移动终端行走的小车。
【背景技术】
[0002]每当搬运行李、货物或装备时，人们总是大汗淋漓，或者被所搬运的物品占着手而不方便做其他事情；对于老年人来说，提着东西还容易劳累。此时人们恨不得这些物品能像跟尾狗一样忠诚地跟随着自己，走到哪，它就跟到哪，不会跟错人也不会走失，时刻跟在后面。
[0003]目前已经有很多关于智能跟踪的技术，但是这些技术都还不成熟，它们大多是使用简单的传感器，不能跟随着特定的人。以Five Elements Robotics推出的Budgee机器人为例，这是一款专门针对老年人和残疾人的轻量级助力机器人。Budgee的最高速度为每小时3.9公里左右，如果主人的行进速度太快，它就会用消息推送的方式提醒主人慢一些。国外已研宄出类似的产品“高尔夫球童自动跟随车”，如CaddyTrek推出的电动高尔夫轮式机器人已经能够取代部分劳动力，用于带着打球装备跟随运动员走；但运动员身上需要佩带着特定的超音波发射器，这类跟随车或机器人还容易发出噪音和被外界干扰，且有一定安全隐患，产品也相当昂贵。
【发明内容】
[0004]为解决现有智能跟踪技术所存在的技术问题，本发明提供一种可自动跟随移动终端行走的小车，该小车通过蓝牙与移动终端(如安卓手机)连接，移动终端将自身的电子磁罗盘方位信息通过蓝牙发送给小车，小车接收到移动终端的电子磁罗盘方位信息后，再与小车自身携带的电子磁罗盘方位信息比较，然后根据比较结果计算转向的角度，最终由舵机控制小车的转向；此外超声波测距模块测量小车与移动终端之间的距离差，直流减速电机根据距离差控制小车行走速度，以此实现小车跟随移动终端行走的功能。
[0005]本发明采用的技术方案如下:可自动跟随移动终端行走的小车，包括主控芯片，以及分别与主控芯片连接的用于测量小车方位信息的电子罗盘模块、用于将移动终端方位信息发送给主控芯片的蓝牙模块、用于测量小车与移动终端之间距离差的超声波测距传感器、用于根据所述距离差控制小车前进或后退的直流减速电机及用于控制小车转向角度的舵机；所述主控芯片根据小车、移动终端方位信息差值计算小车转向角度，并将计算结果输出给舵机的驱动电路。
[0006]与现有技术相比，本发明具有如下优点及技术效果:
[0007]1、小车通过超声波测量小车与移动终端之间的距离差，由电子罗盘模块获得方位信息后对移动终端的方位信息与小车的方位信息进行比较处理，并计算出小车转向的角度，采用舵机控制小车转向的角度，实时性高，易于实现，成本低廉。可以连接主流安卓系统，在智能手机一统天下的时代，用户带着手机去到哪里，小车就跟到哪里，方便使用。
[0008]2、小车可以制作成行李箱、超市的购物车以及老人的备忘箱等外形，人们不仅可以更加轻松地购物，还可以享受保姆式跟随小车带来的许多乐趣。所以，本发明智能跟随小车具有很高的市场价值和应用前景。
【附图说明】
[0009]图1为本发明的模块结构图；
[0010]图2为直流减速电机的驱动电路图；
[0011]图3为舵机的基准信号波形图；
[0012]图4为舵机的驱动电路；
[0013]图5为蓝牙模块的电路图；
[0014]图6为电子罗盘模块的电路图；
[0015]图7为小车的电源主电路图；
[0016]图8是本发明的自动跟随流程图。
【具体实施方式】
[0017]下面结合实施例及附图对本发明作进一步详细的描述，但本发明的实施方式不局限于此。
[0018]实施例
[0019]参见图1，本发明可自动跟随移动终端行走的小车包括STM32F103主控芯片、电子罗盘模块、蓝牙模块、超声波测距传感器、直流减速电机、舵机及LCD显示屏。电子罗盘模块与主控芯片通过IIC(PB8、PB9)方式通信连接，IXD显示屏与主控芯片通过SPI通信方式连接，蓝牙模块与主控芯片通过USART方式连接通信，直流减速电机、舵机则是通过GP1直接连接主控芯片。
[0020]主控芯片用于根据小车及移动终端的方位信息计算小车转向的角度值，并把计算结果输出给舵机的驱动电路，最终由舵机控制小车的转向。直流减速电机根据超声波测距传感器测得的小车与移动终端之间的距离，控制小车前进或后退。
[0021]主控芯片以Cortex_M3为内核，最高工作主频可达72M，内置高速存储器(高达512K字节的闪存和64K字节的SRAM)，采用哈佛结构，2.0-3.6V供电电压，具有丰富的外设，2通道12位D/Α转换器，12通道DMA控制器，多达11个定时器，支持IIC、USART、SP1、CAN和USB等各种通讯协议。
[0022]如图2所示，直流减速电机的驱动电路采用集成芯片BTN7971B，它带有一个P沟道的高边MOSFET、一个N沟道的低边MOSFET和一个驱动芯片U15B。P沟道高边开关省去了电荷泵的需求，因而减小了 EMI (电磁干扰)。BTN7971B集成的驱动芯片具有逻辑电平输入、电流诊断、斜率调节、死区时间产生和过温、过压、欠压、过流及短路保护的功能，通态电阻典型值为16m Ω，驱动电流可达43A。
[0023]本实施例采用两片BTN7971B构成一个全桥驱动电路，图2中PWMl引脚拉高，PWM2引脚拉低，直流减速电机全速前进，进而驱动小车全速前进；相反，若PWMl拉低，PWM2拉高，则小车在直流减速电机的驱动下全速后退。此外，小车的速度通过调节PWMl引脚的占空比来实现小车所需要的速度；BTN7971B芯片VSS与GND端之间接104uF电容，起到滤除电源尖脉冲作用。
[0024]舵机一般而言都有最大旋转角度(比如180度)，它与普通直流电机的区别主要在于:普通直流电机是一圈圈转动的，舵机只能在最大旋转角度内转动，不能一圈圈地转；舵机还能够反馈转动的角度信息。舵机的基准信号周期一般为20ms，如图3所示。舵机采用可变宽度的脉冲信号来进行控制，脉冲信号的参数有最小值、最大值和脉冲频率，一般而言最小脉冲为1ms，最大脉冲为2ms。小车基准信号定义的位置为舵机最大旋转角度的中间位置。不同舵机