CN202615240U - 运动物体自动跟踪系统及应用该系统的小车和升降晾衣架 - Google Patents

Abstract

本实用新型公开了一种运动物体自动跟踪系统和设有该系统的小车和升降晾衣架。本实用新型运动物体自动跟踪系统包括超声波传感器模块、单片机处理模块、电源模块、电机驱动模块和电机；超声波传感器模块的输出端与单片机处理模块的输入端相连；单片机处理模块的输出端与电机驱动模块相连；电机驱动模块与电机相连；电源模块分别与单片机处理模块和电机相连。本实用新型运动物体自动跟踪系统具有跟踪和导向双重功能，结构简单，使用方便。

Description

运动物体自动跟踪系统及应用该系统的小车和升降晾衣架

技术领域

本实用新型涉及一种运动物体自动跟踪系统，具体涉及一种导盲避障的跟踪系统及应用该系统的小车和升降晾衣架。

背景技术

传统的盲人出行一般采用辅助工具拐杖，有些智能工具是导向犬和动物犬。但是这些工具都有一些弊端，比如，拐杖掉了，怎么办？周围有移动的物体靠近，盲人都不能及时的做出反应；还有导向犬只能导向，却不能跟踪盲人，盲人想转弯，它却直接向无障反向前进；还有动物犬，每天要给它们喂食，清洗，还要牵着，还有时候不按照盲人的意向行走。

发明内容

本实用新型的目的是为了克服传统辅助工具和一些智能工具的缺陷，提供一种既能导向又能跟踪的运动物体自动追踪系统。

为了达到上述目的，本实用新型提供了一种运动物体自动跟踪系统，包括超声波传感器模块、单片机处理模块、电源模块、电机驱动模块和电机；超声波传感器模块的输出端与单片机处理模块的输入端相连；单片机处理模块的输出端与电机驱动模块相连；电机驱动模块与电机相连；电源模块分别与单片机处理模块和电机相连；超声波传感器模块采集运动物体的信号，并传送给单片机处理模块；单片机处理模块接收运动物体的信号后，确定运动物体的位置，输出指令至电机驱动模块；电机驱动模块控制电机带动自动跟踪系统跟踪运动物体。

对本实用新型的进一步改进在于：超声波传感器模块包括6个超声波传感器；6个超声波传感器以自动跟踪系统为中心，分别向周围6个不同的方位进行超声波发送和回波接收；超声波的频率为40kHz。单片机处理模块接收运动物体的信号后，通过定位控制算法确定运动物体的位置。单片机处理模块采用STC12C5410AD单片机。电机驱动模块上设有隔离电路。

本实用新型还提供了一种小车，该小车上设有上述自动跟踪系统，并通过该系统的电机驱动小车运动。小车上还设有摄像头和无线通讯模块；摄像头的输出端与无线通讯模块相连。小车上还设有避障模块；避障模块为超声波传感器；避障模块与单片机处理模块相连。

本实用新型还提供了一种升降晾衣架，该升降晾衣架上设有上述自动跟踪系统，并通过该系统的电机驱动升降晾衣架运动。

本实用新型相比现有技术具有以下优点：采用超声波传感器进行运动物体识别，通过以一点为中心的多方位采集距离，距离数据通过单片机进行精确的定位控制算法确定目标的位置，然后控制跟踪特定的目标。本实用新型自动跟踪控制系统能自动根据反馈信息调节速度和转弯等各种目标跟踪功能，同时采用驱动模块能增加负载能力。将该系统装于小车上，进行自动跟踪，并可通过摄像头用于侦察，探险等工作，也可通过加载避障模块对一定周围环境障碍物体进行规避；应用于购物车上，不用顾客推拉，就能跟在实时顾客后面或前面，解放人们的双手；应用于升降式晾衣架上，只要人在衣架的正前方停留一段时间（0.5s以上），智能衣架直接跟踪到人面前，当人离开后，智能衣架恢复到原来的位置。本实用新型运动物体自动跟踪系统具有跟踪和导向双重功能，结构简单，使用方便。

附图说明

图1为本实用新型运动物体自动跟踪系统的结构框图；

图2为图1中超声波传感器模块的识别方向；

图3为图1中超声波传感器模块对运动物体的识别原理示意图；

图4为本实用新型运动物体自动跟踪系统的跟踪逻辑图；

图5为本实用新型运动物体自动跟踪系统的程序框图；

图6为本实用新型小车用于跟踪避障的结构示意图。

图中，1-超声波传感器模块，2-单片机处理模块，3-电机驱动模块，4-电源模块，5-电机，6-小车，7-避障模块，8-运动物体，9-障碍物，a-超声波传感器的长度，o-自动跟踪系统的点位中心。

具体实施方式

下面结合附图对本实用新型运动物体自动跟踪系统进行详细说明。

参见图1，本实用新型运动物体自动跟踪系统包括超声波传感器模块1、单片机处理模块2、电源模块4、电机驱动模块3和电机5。超声波传感器模块1采用6个一收一发频率为40kHz的超生波传感器，并且做成模块化的、与单片机处理模块2相兼容的、控制和测量于一体的超声波模块。只需要提供一个短期的10uS的脉冲触发信号。该模块内部将发出8个40kHz周期电平并检测回波。一旦检测到有回波信号则输出回响信号。回响信号是一个脉冲的宽度成正比的距离对象，通过发射信号到收到的回响信号时间间隔可以计算到距离。结合图2，总框表示系统的简略框图，正六边形的各边代表超声波传感器的位置。该超声波传感器模块1通过以一点为中心的多方位采集距离，将采集得到数据送给单片机处理模块2。该超声波传感器模块1可以提供2cm~450cm的非接触式距离探测功能，测距精度可达3mm，能够探测以o为中心半径为3m的圆圈范围。可设定运动物体的识别宽度≥1cm，运动速度为5cm－10cm/s，跟踪时运动物体的距离为a×1.732+2mm。

参见图3、图4和图5，单片机处理模块2采用5V的STC12C5410AD单片机，对超声波传感器模块1将运动物体8的多方位(形成的6个通道)的测量信号转化为相应的距离，再利用精确的点位算法确定运动物体8的二维坐标，并且实时测量来确定运动物体的行为方式。将确定的运动物体的二维坐标转化为运动物体跟踪方式，将信号传给电机驱动模块3的控制脚。并且实时通过测量的数据来及时的更改小车的运动方式，使其该系统反应灵敏。电机驱动模块3控制电机5带动自动跟踪系统跟踪运动物体8。

电源模块4采用5号电池组装供电，避免电缆连接使其无法出行的情况，和避免3.3V系统需要电源芯片减压，减少成本和解决应用领域的一些技术问题。采用5号电池组装两端输出的电源模块4，一端为9.6V，一端为5.8V，9.6V为全部电池串联起来的，5.8V为部分电池串联起来的，用5.8V给单片机处理模块2供电，9.6V给电机5供电。

电机驱动模块3的电路采用低压大电流隔离驱动，用小型继电器来隔离，用三极管来做功放电路，采用二极管IN4148来保护电路。该驱动模块耐压值大，可达40V（建议不要长期使用），驱动电机的驱动电流是一般市场上的驱动模块1.5~2倍，驱动（负重大）能力强，并且有隔离电路，使其与单片机的兼容性好。

        参见图6，该自动跟踪系统应用于小车6时，小车6后方设有避障模块7，避障模块7采用超声波传感器。设定对运动物体8保持一定的距离，通过单片机处理模块2指令电机驱动模块3，从而带动小车6对运动物体8（人）进行跟踪导向，同时通过避障模块7躲避障碍物9。

本实用新型自动跟踪系统还可以应用于家具，如智能衣架，只要人移动至衣架的正前方停留一段时间（0.5s以上），智能衣架直接跟踪到人面前，当人离开后，智能衣架恢复到原来的位置。可以做成智能升降晾衣架，当人要到达阳台晾衣服，晾衣架自动减低，直到人离开后衣架自动回到原点，取晾衣架上的衣服，操作一样。不仅减去拿架杆向上举费力动作，还省去衣架费用和防止衣服上的水顺着架杆和人手弄湿衣服等麻烦。

        还可以应用于商场智能购物车，不用顾客推拉，就能跟在实时顾客后面或前面，解放人们的双手。

Claims (8)

1.一种运动物体自动跟踪系统，其特征在于：包括超声波传感器模块、单片机处理模块、电源模块、电机驱动模块和电机；所述超声波传感器模块的输出端与单片机处理模块的输入端相连；所述单片机处理模块的输出端与所述电机驱动模块相连；所述电机驱动模块与所述电机相连；所述电源模块分别与所述单片机处理模块和电机相连。

2.根据权利要求1所述的运动物体自动跟踪系统，其特征在于：所述超声波传感器模块包括6个以自动跟踪系统为中心，分别向周围6个不同的方位进行超声波发送和回波接收的超声波传感器；所述超声波的频率为40kHz。

3.根据权利要求1或2所述的运动物体自动跟踪系统，其特征在于：所述单片机处理模块采用STC12C5410AD单片机。

4.根据权利要求1或2所述的运动物体自动跟踪系统，其特征在于：所述电机驱动模块上设有隔离电路。

5.一种设有权利要求1或2任一所述自动跟踪系统的小车，其特征在于：所述自动跟踪系统设于小车上，并通过电机带动所述小车运动。

6.根据权利要求5所述的小车，其特征在于：所述小车上设有摄像头和无线通讯模块；所述摄像头的输出端与所述无线通讯模块相连。

7.根据权利要求5所述的小车，其特征在于：所述小车上还设有避障模块；所述避障模块为超声波传感器；所述避障模块与所述单片机处理模块相连。

8.一种设有权利要求1或2所述的自动跟踪系统的升降晾衣架，其特征在于：所述自动跟踪系统设于升降晾衣架上，并通过所述电机带动所述升降晾衣架运动。

Images