WO2017197729A1 - Tracking system and tracking method - Google Patents

Tracking system and tracking method Download PDF

Info

Publication number
WO2017197729A1
WO2017197729A1 PCT/CN2016/087654 CN2016087654W WO2017197729A1 WO 2017197729 A1 WO2017197729 A1 WO 2017197729A1 CN 2016087654 W CN2016087654 W CN 2016087654W WO 2017197729 A1 WO2017197729 A1 WO 2017197729A1
Authority
WO
WIPO (PCT)
Prior art keywords
tracking
current
target
speed
motion speed
Prior art date
Application number
PCT/CN2016/087654
Other languages
French (fr)
Chinese (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 西安斯凯智能科技有限公司
Publication of WO2017197729A1 publication Critical patent/WO2017197729A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0094Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots involving pointing a payload, e.g. camera, weapon, sensor, towards a fixed or moving target

Definitions

  • the present invention relates to the field of tracking, and in particular to a tracking system and a tracking method.
  • the tracking device can be an aerial robot - a drone, a robot on the ground, or a smart car.
  • the UAVs currently on the market basically use computer vision to achieve tracking, and the tracking angle and tracking distance of the UAV are determined by collecting and tracking the image of the target and processing the image.
  • image processing requires a large amount of calculation, there is a problem of time lag to some extent, and image processing is not accurate enough when calculating distance information.
  • image processing is not accurate enough when calculating distance information.
  • An object of the present invention is to overcome the above problems and to provide a tracking system and a tracking method capable of achieving high-precision target tracking.
  • the present invention provides a tracking system for controlling a mobile tracking end to track a moving target end, including:
  • a distance determining unit configured to determine a current relative distance of the tracking end relative to the target end
  • An angle determining unit configured to determine a current relative angle of the tracking end with respect to the target end
  • a target end speed acquiring unit configured to acquire a current target moving speed of the target end
  • a controller configured to adjust a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, so that the tracking end is opposite to the
  • the target end is basically maintained at a preset relative distance and a preset relative angle degree.
  • controller is configured to adjust the current tracking motion speed of the tracking end no later than adjusting the current tracking motion posture of the tracking end.
  • controller is configured to adjust the current tracking motion speed of the tracking end before adjusting the current tracking motion posture of the tracking end.
  • controller is configured to adjust the current tracking motion speed of the tracking end with the current target motion speed of the target end as a target.
  • controller is configured to adjust the current tracking motion speed of the tracking end to the current target motion speed immediately following the target end.
  • the tracking system further includes:
  • An image collection device disposed at the tracking end for acquiring a tracking image including the target end;
  • An image processing unit configured to process the tracking image to obtain a location of the target end in the tracking image
  • the angle determining unit is configured to determine the current relative angle of the tracking end relative to the target end according to a position of the target end in the tracking image.
  • the tracking image is only used to determine the current relative angle.
  • the tracking system further includes:
  • a second radio frequency device disposed at the target end.
  • the distance determining unit is configured to determine the current relative distance according to a radio frequency signal transmitted between the first and second radio frequency devices;
  • the radio frequency signal is an ultra-wideband radio frequency signal.
  • first and second radio frequency devices are used for data and instruction transmission of the tracking end and the target end.
  • the tracking system further includes:
  • a first positioning device disposed at the tracking end for determining a current tracking position of the tracking end
  • a second positioning device disposed at the target end for determining a current target position of the target end
  • the distance determining unit is configured to be based on the current tracking position and the current target Position to determine the current relative distance.
  • the target end speed acquisition unit includes a speed sensor or an acceleration sensor disposed at the target end.
  • the tracking end is a drone, a ground robot or a smart car.
  • the present invention provides a tracking method for controlling a moving tracking end to track a moving target end, including the following steps:
  • adjusting the current tracking motion speed and the current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed are performed no later than adjusting the tracking end
  • the current tracking motion speed of the tracking end is adjusted while the motion posture is being tracked.
  • adjusting the current tracking motion speed and the current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed are to adjust the current tracking motion of the tracking end
  • the current tracking motion speed of the tracking end is adjusted before the gesture.
  • adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, that is, the current target motion speed of the target end The current tracking motion speed of the tracking end is adjusted for the target.
  • the scheme of the invention additionally introduces the motion speed of the target end as the control parameter of the controller, so that the tracking end can follow the speed change of the target end in time when tracking the target end, so that the tracking end and the target end always maintain a substantially consistent speed, avoiding Sudden increase in speed due to the target end Or the tracking end caused by the reduction requires a larger speed change due to inertia to adapt to the speed change of the target end, so that the tracking end can respond to the movement of the target end in a more timely manner, reducing the lag time.
  • the present invention even when the target end is outside the shooting range of the camera or is blocked by other objects, the relative distance and/or relative angle of the tracking end with respect to the target end cannot be determined, the present invention
  • the scheme introduces the motion speed of the target end as the control parameter of the controller, and the motion speed of the target end can be obtained by non-image processing, so that the controller can closely follow the speed of the target end by controlling the tracking end, so that the Within acceptable distances.
  • the present invention achieves accurate tracking of the target end by a combination of three parameters of distance, angle and speed.
  • FIG. 1 is a block diagram showing the general structure of a tracking system in accordance with the present invention.
  • FIG. 2 is a schematic structural diagram of a tracking system according to an embodiment of the present invention.
  • FIG. 3 is a schematic structural diagram of a tracking system according to another embodiment of the present invention.
  • FIG. 4 is a schematic structural diagram of a tracking system according to another embodiment of the present invention.
  • FIG. 5 is a flow chart of a tracking method in accordance with another embodiment of the present invention.
  • FIG. 1 is a block diagram showing the structure of a tracking system 100 in accordance with one embodiment of the present invention.
  • 2 is a logic control diagram of a tracking system in accordance with one embodiment of the present invention.
  • the present invention provides a tracking system 100 for controlling a moving tracking end 11 to track a moving target end 12.
  • the tracking system 100 may include a distance determining unit 1, an angle determining unit 2, a target end speed acquiring unit 3, and a controller 4.
  • the distance determining unit 1 is configured to determine a current relative distance of the tracking end 11 relative to the target end 12, and the angle determining unit 2 is configured to determine a current relative angle of the tracking end 11 with respect to the target end 12, a target end
  • the speed acquisition unit 3 is configured to acquire the current target motion speed of the target end 12.
  • the controller 4 is configured to, according to the current relative distance, the Adjusting a current tracking motion speed and a current tracking motion posture of the tracking end 11 with a current relative angle and the current target motion speed such that the tracking end 11 remains substantially at a preset relative distance with respect to the target end 12 Preset relative angle.
  • the position and the attitude of the tracking end are adjusted based on the relative distance and the relative angle of the tracking end with respect to the target end.
  • the solution of the present invention additionally introduces the motion speed of the target end as the control parameter of the controller, so that the tracking end 11 can track the speed change of the target end in time when tracking the target end 12, so that the tracking end 11 and the target end 12 always maintain a substantially uniform speed, thus avoiding the sudden increase or decrease of the speed of the target end 12
  • the tracking end 11 requires a larger speed change due to inertia to accommodate the speed change at the target end.
  • the tracking end 11 can respond to the movement of the target end 12 in a more timely manner, reducing the lag time.
  • the solution of the present invention additionally introduces the motion speed of the target end 12 as the control parameter of the controller 4, and the motion speed of the target end 12 can be obtained by non-image processing, so that the controller 4 can control the tracking end. 11 closely follows the speed of the target end 12 such that they are within an acceptable distance range.
  • the present invention achieves accurate tracking of the target end by a combination of three parameters of distance, angle and speed.
  • the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 no later than adjusting the current tracking motion attitude of the tracking end 11 such that the tracking end The response to the target 12 is moved more timely, thereby reducing the lag time.
  • the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 before adjusting the current tracking motion posture of the tracking end 11, so that the tracking end 11 responds to the target end 12 moves more timely, thereby reducing lag time.
  • the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 with the current target motion speed of the target end 12 as a target.
  • the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 to the current target motion speed immediately following the target end 12.
  • the tracking system 100 may further include an image acquisition device 5 and an image processing unit 6 disposed at the tracking end 11.
  • the image capture device 5 is configured to acquire a tracking image including the target end 12
  • the image processing unit 6 is configured to process the tracking image to acquire the position of the target end 12 in the tracking image.
  • the angle determining unit 2 is configured to determine the current relative angle of the tracking end 11 relative to the target end 12 based on the position of the target end 12 in the tracking image.
  • the image acquisition device 5 can be, for example, a camera.
  • the image capturing device 5 such as a camera can be installed at a single-axis pan/tilt, and the single-axis pan/tilt is installed at the tracking end 11, and the three-dimensional angle between the camera and the target end 12 is set in advance, so that the target end 12 is Always at the center of the camera's shooting.
  • the tracking picture is taken by the camera, and the position of the target end 12 in the tracking image is determined, and then compared with the previous frame image to obtain the pixel displacement of the x and y directions generated by the target end 12 in the tracking image.
  • the change is such that the offset angle of the target end 12 due to the movement is derived from the pixel change.
  • the offset angle for example, left and right, up and down
  • the tracking image may only be used to determine the current relative angle. That is, the distance determining unit 1 may not determine the current relative distance of the tracking end 11 with respect to the target end 12 based on the tracking image. Since the present invention does not need to determine the distance by the tracking image, the amount of calculation is greatly reduced, thereby solving the problem in the prior art that a large amount of calculation is required due to image processing, and there is a time lag to some extent.
  • non-image processing methods may also be used to obtain the current relative angles required, such as a radar detection method, a GPS positioning method, or a radio frequency detection method.
  • the tracking system 100 may further include a first radio frequency device 7 disposed at the tracking end 11; A second radio frequency device 8 is provided at the target end 12.
  • the distance determining unit 1 may be configured to determine the current relative distance according to a radio frequency signal transmitted between the first radio frequency device 7 and the second radio frequency device 8.
  • the radio frequency signal is an ultra wideband (UWB) radio frequency (UWB) radio frequency signal.
  • the first radio frequency device 7 and the second radio frequency device 8 can transmit radio frequency signals and record the transmission and reception time of the radio frequency signals, and the distance determining unit 1 can pass the radio frequency signals on the first radio frequency device 7
  • the transfer time between the second RF device 8 and the second RF device 8 is used to calculate the distance between the two.
  • FIG. 3 shows a tracking system according to another embodiment of the present invention, which differs from FIG. 2 in that the first radio frequency device 7 and the second radio frequency device 8 can also be used only for the tracking end 11 and the The data and instruction transmission of the target end 12 is described.
  • the first radio frequency device 7 and the second radio frequency device 8 implement transmission of data and instructions by radio frequency signals transmitted between them.
  • the radio frequency signal is a UWB (Ultra Wideband) radio frequency signal.
  • the target end speed acquisition unit 3 in FIG. 1 can be implemented by the speed sensor 15 provided at the target end 12 in FIG. 2 to obtain the current target movement speed of the target end 12.
  • the current target speed of motion measured by the speed sensor 15 may be communicated to the controller 4 via radio frequency communication between the first radio frequency device 7 and the second radio frequency device 8.
  • the current target moving speed of the target end 12 can also be obtained by an acceleration sensor.
  • the tracking system 100 can further include a first positioning device 9 disposed at the tracking end 11 and a second positioning device 10 disposed at the target end 12.
  • the first positioning device 9 is used to determine the current tracking position of the tracking end 11, and the second positioning device 10 is used to determine the current target position of the target end 12.
  • the distance determining unit 1 may determine the current relative distance according to the current tracking position and the current target position.
  • the positioning device may be a GPS or a Beidou positioning module.
  • the current target moving speed of the target end 12 can also be calculated based on the change in the current target position of the target end 12 measured by the second positioning device 10.
  • the speed can also be detected by setting a speed sensor at the target end 12, similar to the embodiment of FIG.
  • a wireless communication device such as the radio frequency device shown in FIG. 2 may be provided at the target end 12 and the tracking end 11, respectively, to allow the target terminal 12 to be The positioning information or speed information of the target end 12 is transmitted to the tracking end 11.
  • the tracking end 11 may be a drone, a ground robot or a smart car.
  • the control system may further include a control terminal 13, which may have Bluetooth, WIFI, and terminal App 14.
  • the Bluetooth is used to communicate with the target terminal 12.
  • the Bluetooth receives an instruction from the terminal App 14 and transmits the command to the second radio frequency device 8 of the target terminal 12.
  • the WIFI is used to communicate with the tracking end 11, and the WIFI receives the video sent by the tracking end 11 and sends an instruction of the terminal App 14 to the controller 4 of the tracking end 11.
  • the terminal App14 is configured to display video, instruction information, and the like, where the instruction information includes a preset tracking end.
  • FIG. 5 is a flow chart of a tracking method in accordance with another embodiment of the present invention. As shown in FIG. 5, the present invention provides a tracking method for controlling a moving tracking end to track a moving target end, including the following steps:
  • the position and the attitude of the tracking end are adjusted based on the relative distance and the relative angle of the tracking end with respect to the target end.
  • the solution of the present invention additionally introduces the motion speed of the target end as the control parameter of the controller, so that the tracking end When tracking the target end, it can follow the speed change of the target end in time, so that the tracking end and the target end always maintain a substantially consistent speed, thus avoiding the tracking end due to the inertia of the target end due to the sudden increase or decrease of the speed of the target end. A large speed change to accommodate the speed change at the target end.
  • the tracking end can respond to the movement of the target end in a more timely manner, reducing the lag time.
  • the solution of the present invention ensures accurate tracking of the target end by a combination of three parameters of distance, angle and speed.
  • adjusting the current tracking motion speed and the current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed are not later than adjusting the tracking end. Adjusting the current tracking motion speed of the tracking end when the current motion posture is currently tracked.
  • the current tracking motion speed and the current tracking motion of the tracking end are adjusted according to the current relative distance, the current relative angle, and the current target motion speed.
  • the attitude is to adjust the current tracking motion speed of the tracking end before adjusting the current tracking motion posture of the tracking end.
  • adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, that is, the current target of the target end The speed of motion is a target to adjust the current tracking motion speed of the tracking end.
  • S104 adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, where the current tracking of the tracking end is performed
  • the speed of movement is adjusted to follow the current target speed of motion of the target end.

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Studio Devices (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A tracking system (100) and a tracking method, relating to the tracking field. The tracking system (100) for controlling a mobile tracking terminal (11) to track a moving target terminal (12), comprises: a distance determination unit (1), for determining the current relative distance of the tracking terminal (11) with respect to the target terminal (12) (S101); an angle determination unit (2), for determining the current relative angle of the tracking terminal (11) with respect to the target terminal (12) (S102); a target terminal speed acquisition unit (3), for acquiring the current target movement speed of the target terminal (12) (S103); a controller (4), for regulating, according to the current relative distance, the current relative angle and the current target movement speed, the current tracking movement speed and the current tracking movement gesture of the tracking terminal (11), such that the tracking terminal (11) substantially maintains the preset relative distance and the preset relative angle with respect to the target terminal (12) (S104). With speed, the tracking terminal (11) can move in a more timely fashion responding to the target terminal (12), reducing lag time; and the tracking terminal (11) reduces, due to maintaining a speed consistent with the target terminal (12), inertia caused by the sudden increase or decrease in speed, achieving precise tracking.

Description

一种跟踪系统及跟踪方法Tracking system and tracking method 技术领域Technical field
本发明涉及跟踪领域,特别是涉及一种跟踪系统及跟踪方法。The present invention relates to the field of tracking, and in particular to a tracking system and a tracking method.
背景技术Background technique
近年来,目标定位和跟踪技术一直是各种智能设备或装置的研究热点和难点。跟踪装置可以是空中机器人—无人机、地面上的机器人或智能车等。In recent years, target location and tracking technology has been a research hotspot and difficulty of various smart devices or devices. The tracking device can be an aerial robot - a drone, a robot on the ground, or a smart car.
以无人机为例,目前市面上的无人机基本上采用计算机视觉来实现跟踪,通过采集跟踪目标的图像并对图像进行处理来确定无人机的跟踪角度和跟踪距离。在采用上述方式进行跟踪时,由于图像处理需要大量的计算,在一定程度上存在时间滞后问题,而且在计算距离信息时图像处理不够精确。此外,还发现,现有的无人机在跟踪目标时,如果跟踪目标出现速度的突然变化,则无人机会产生更大幅度的速度变化来确保按照预定跟踪速度和角度进行跟踪。Taking the UAV as an example, the UAVs currently on the market basically use computer vision to achieve tracking, and the tracking angle and tracking distance of the UAV are determined by collecting and tracking the image of the target and processing the image. When tracking is performed in the above manner, since image processing requires a large amount of calculation, there is a problem of time lag to some extent, and image processing is not accurate enough when calculating distance information. In addition, it has been found that when the existing drone is tracking the target, if the tracking target suddenly changes in speed, the unmanned person will generate a larger speed change to ensure tracking according to the predetermined tracking speed and angle.
此外,在采用计算机视觉方式来跟踪目标时,一旦出现跟踪目标不在摄像头的拍摄范围内或者被其他物体遮挡住的情况时,则无法实现有效跟踪。In addition, when the computer vision is used to track the target, effective tracking cannot be achieved once the tracking target is not within the shooting range of the camera or blocked by other objects.
发明内容Summary of the invention
本发明的一个目的是为了克服上述问题,提供一种能够实现高精度目标跟踪的跟踪系统及跟踪方法。An object of the present invention is to overcome the above problems and to provide a tracking system and a tracking method capable of achieving high-precision target tracking.
特别地,本发明提供了一种跟踪系统,用于控制一移动的跟踪端跟踪一移动的目标端,包括:In particular, the present invention provides a tracking system for controlling a mobile tracking end to track a moving target end, including:
距离确定单元,用于确定所述跟踪端相对于所述目标端的当前相对距离;a distance determining unit, configured to determine a current relative distance of the tracking end relative to the target end;
角度确定单元,用于确定所述跟踪端相对于所述目标端的当前相对角度;An angle determining unit, configured to determine a current relative angle of the tracking end with respect to the target end;
目标端速度获取单元,用于获取所述目标端的当前目标运动速度;和a target end speed acquiring unit, configured to acquire a current target moving speed of the target end; and
控制器,用于根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,以使得所述跟踪端相对于所述目标端基本保持为预设相对距离和预设相对角 度。a controller, configured to adjust a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, so that the tracking end is opposite to the The target end is basically maintained at a preset relative distance and a preset relative angle degree.
进一步地,所述控制器配置成在不迟于调节所述跟踪端的所述当前跟踪运动姿态时调节所述跟踪端的所述当前跟踪运动速度。Further, the controller is configured to adjust the current tracking motion speed of the tracking end no later than adjusting the current tracking motion posture of the tracking end.
进一步地,所述控制器配置成调节所述跟踪端的所述当前跟踪运动姿态之前调节所述跟踪端的所述当前跟踪运动速度。Further, the controller is configured to adjust the current tracking motion speed of the tracking end before adjusting the current tracking motion posture of the tracking end.
进一步地,所述控制器配置成以所述目标端的所述当前目标运动速度为目标来调节所述跟踪端的所述当前跟踪运动速度。Further, the controller is configured to adjust the current tracking motion speed of the tracking end with the current target motion speed of the target end as a target.
进一步地,所述控制器配置成将所述跟踪端的所述当前跟踪运动速度调节成紧随所述目标端的所述当前目标运动速度。Further, the controller is configured to adjust the current tracking motion speed of the tracking end to the current target motion speed immediately following the target end.
进一步地,所述的跟踪系统,还包括:Further, the tracking system further includes:
布置在所述跟踪端处的图像采集装置,用于获取包含所述目标端的跟踪图像;An image collection device disposed at the tracking end for acquiring a tracking image including the target end;
图像处理单元,用于对所述跟踪图像进行处理,以获取所述目标端在所述跟踪图像中的位置;An image processing unit, configured to process the tracking image to obtain a location of the target end in the tracking image;
其中,所述角度确定单元配置成根据所述目标端在所述跟踪图像中的位置确定所述跟踪端相对于所述目标端的所述当前相对角度。The angle determining unit is configured to determine the current relative angle of the tracking end relative to the target end according to a position of the target end in the tracking image.
进一步地,所述跟踪图像仅用于确定所述当前相对角度。Further, the tracking image is only used to determine the current relative angle.
进一步地,所述的跟踪系统,还包括:Further, the tracking system further includes:
设置在所述跟踪端处的第一射频装置;和a first radio frequency device disposed at the tracking end; and
设置在所述目标端处的第二射频装置。A second radio frequency device disposed at the target end.
进一步地,所述距离确定单元配置成根据所述第一和第二射频装置之间传输的射频信号来确定所述当前相对距离;Further, the distance determining unit is configured to determine the current relative distance according to a radio frequency signal transmitted between the first and second radio frequency devices;
可选地,所述射频信号为超宽带射频信号。Optionally, the radio frequency signal is an ultra-wideband radio frequency signal.
进一步地,所述第一和第二射频装置用于所述跟踪端与所述目标端的数据和指令传输。Further, the first and second radio frequency devices are used for data and instruction transmission of the tracking end and the target end.
进一步地,所述的跟踪系统,还包括:Further, the tracking system further includes:
设置在所述跟踪端处的第一定位装置,用于确定所述跟踪端的当前跟踪位置;a first positioning device disposed at the tracking end for determining a current tracking position of the tracking end;
设置在所述目标端处的第二定位装置,用于确定所述目标端的当前目标位置;a second positioning device disposed at the target end for determining a current target position of the target end;
其中,所述距离确定单元配置成根据所述当前跟踪位置和所述当前目标 位置来确定所述当前相对距离。Wherein the distance determining unit is configured to be based on the current tracking position and the current target Position to determine the current relative distance.
进一步地,所述目标端速度获取单元包括布置在所述目标端处的速度传感器或加速度传感器。Further, the target end speed acquisition unit includes a speed sensor or an acceleration sensor disposed at the target end.
进一步地,所述跟踪端为无人机、地面机器人或智能车。Further, the tracking end is a drone, a ground robot or a smart car.
特别地,本发明提供了一种跟踪方法,用于控制一移动的跟踪端跟踪一移动的目标端,包括如下步骤:In particular, the present invention provides a tracking method for controlling a moving tracking end to track a moving target end, including the following steps:
确定所述跟踪端相对于所述目标端的当前相对距离;Determining a current relative distance of the tracking end relative to the target end;
确定所述跟踪端相对于所述目标端的当前相对角度;Determining a current relative angle of the tracking end with respect to the target end;
获取所述目标端的当前目标运动速度;Obtaining a current target moving speed of the target end;
根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,以使得所述跟踪端相对于所述目标端基本保持为预设相对距离和预设相对角度。Adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, so that the tracking end is substantially maintained relative to the target end Preset relative distance and preset relative angle.
进一步地,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是在不迟于调节所述跟踪端的所述当前跟踪运动姿态时调节所述跟踪端的所述当前跟踪运动速度。Further, adjusting the current tracking motion speed and the current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed are performed no later than adjusting the tracking end The current tracking motion speed of the tracking end is adjusted while the motion posture is being tracked.
进一步地,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是在调节所述跟踪端的所述当前跟踪运动姿态之前调节所述跟踪端的所述当前跟踪运动速度。Further, adjusting the current tracking motion speed and the current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed are to adjust the current tracking motion of the tracking end The current tracking motion speed of the tracking end is adjusted before the gesture.
进一步地,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是以所述目标端的所述当前目标运动速度为目标来调节所述跟踪端的所述当前跟踪运动速度。Further, adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, that is, the current target motion speed of the target end The current tracking motion speed of the tracking end is adjusted for the target.
进一步地,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是将所述跟踪端的所述当前跟踪运动速度调节成紧随所述目标端的所述当前目标运动速度。Further, adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, where the current tracking motion speed of the tracking end is Adjusted to the current target speed of motion immediately following the target end.
本发明的方案由于额外引入了目标端的运动速度作为控制器的控制参数,使得跟踪端在跟踪目标端时能够及时跟随目标端的速度变化,从而使得跟踪端与目标端始终保持基本一致的速度,避免了因目标端的速度突然增大 或减小而造成的跟踪端由于惯性需要更大幅度的速度变化来适应目标端的速度变化,使得跟踪端能够更及时地响应目标端的移动,减少了滞后时间。此外,按照本发明的方案,即使在目标端处在摄像头的拍摄范围之外或者被其他物体遮挡住的情况下,无法确定跟踪端相对于目标端的相对距离和/或相对角度时,本发明的方案由于额外引入了目标端的运动速度作为控制器的控制参数,而目标端的运动速度可以采用非图像处理的方式获得,这样控制器可以通过控制跟踪端紧密跟随目标端的速度,从而使得它们之间处于可接受的距离范围内。这样,一旦摄像头能够重新获取到目标端的图像时,则可以继续进行精确跟踪。由此,本发明是通过距离、角度及速度这三个参数的结合实现了对目标端的精确跟踪。The scheme of the invention additionally introduces the motion speed of the target end as the control parameter of the controller, so that the tracking end can follow the speed change of the target end in time when tracking the target end, so that the tracking end and the target end always maintain a substantially consistent speed, avoiding Sudden increase in speed due to the target end Or the tracking end caused by the reduction requires a larger speed change due to inertia to adapt to the speed change of the target end, so that the tracking end can respond to the movement of the target end in a more timely manner, reducing the lag time. Further, according to the aspect of the present invention, even when the target end is outside the shooting range of the camera or is blocked by other objects, the relative distance and/or relative angle of the tracking end with respect to the target end cannot be determined, the present invention The scheme introduces the motion speed of the target end as the control parameter of the controller, and the motion speed of the target end can be obtained by non-image processing, so that the controller can closely follow the speed of the target end by controlling the tracking end, so that the Within acceptable distances. In this way, once the camera is able to reacquire the image of the target, then accurate tracking can continue. Thus, the present invention achieves accurate tracking of the target end by a combination of three parameters of distance, angle and speed.
根据下文结合附图对本发明具体实施例的详细描述,本领域技术人员将会更加明了本发明的上述以及其他目的、优点和特征。The above as well as other objects, advantages and features of the present invention will become apparent to those skilled in the <
附图说明DRAWINGS
后文将参照附图以示例性而非限制性的方式详细描述本发明的一些具体实施例。附图中相同的附图标记标示了相同或类似的部件或部分。本领域技术人员应该理解,这些附图未必是按比例绘制的。附图中:Some specific embodiments of the present invention are described in detail below by way of example, and not limitation. The same reference numbers in the drawings identify the same or similar parts. Those skilled in the art should understand that the drawings are not necessarily drawn to scale. In the figure:
图1是根据本发明的跟踪系统的一般性结构框图;Figure 1 is a block diagram showing the general structure of a tracking system in accordance with the present invention;
图2是根据本发明一个实施例的跟踪系统的结构示意图;2 is a schematic structural diagram of a tracking system according to an embodiment of the present invention;
图3是根据本发明另一个实施例的跟踪系统的结构示意图;3 is a schematic structural diagram of a tracking system according to another embodiment of the present invention;
图4是根据本发明另一个实施例的跟踪系统的结构示意图;4 is a schematic structural diagram of a tracking system according to another embodiment of the present invention;
图5是根据本发明另一个实施例的跟踪方法的流程图。FIG. 5 is a flow chart of a tracking method in accordance with another embodiment of the present invention.
具体实施方式detailed description
图1是根据本发明一个实施例的跟踪系统100的结构框图。图2是根据本发明一个实施例的跟踪系统的逻辑控制图。如图1和图2所示,本发明提供了一种跟踪系统100,其用于控制一移动的跟踪端11跟踪一移动的目标端12。该跟踪系统100可包括:距离确定单元1、角度确定单元2、目标端速度获取单元3和控制器4。距离确定单元1用于确定所述跟踪端11相对于所述目标端12的当前相对距离,角度确定单元2用于确定所述跟踪端11相对于所述目标端12的当前相对角度,目标端速度获取单元3用于获取所述目标端12的当前目标运动速度。控制器4用于根据所述当前相对距离、所述 当前相对角度和所述当前目标运动速度来调节所述跟踪端11的当前跟踪运动速度和当前跟踪运动姿态,以使得所述跟踪端11相对于所述目标端12基本保持为预设相对距离和预设相对角度。1 is a block diagram showing the structure of a tracking system 100 in accordance with one embodiment of the present invention. 2 is a logic control diagram of a tracking system in accordance with one embodiment of the present invention. As shown in Figures 1 and 2, the present invention provides a tracking system 100 for controlling a moving tracking end 11 to track a moving target end 12. The tracking system 100 may include a distance determining unit 1, an angle determining unit 2, a target end speed acquiring unit 3, and a controller 4. The distance determining unit 1 is configured to determine a current relative distance of the tracking end 11 relative to the target end 12, and the angle determining unit 2 is configured to determine a current relative angle of the tracking end 11 with respect to the target end 12, a target end The speed acquisition unit 3 is configured to acquire the current target motion speed of the target end 12. The controller 4 is configured to, according to the current relative distance, the Adjusting a current tracking motion speed and a current tracking motion posture of the tracking end 11 with a current relative angle and the current target motion speed such that the tracking end 11 remains substantially at a preset relative distance with respect to the target end 12 Preset relative angle.
相比于现有技术中仅基于跟踪端相对于目标端的相对距离和相对角度来调节跟踪端的位置和姿态,本发明的方案由于额外引入了目标端的运动速度作为控制器的控制参数,使得跟踪端11在跟踪目标端12时能够及时跟随目标端的速度变化,从而使得跟踪端11与目标端12始终保持基本一致的速度,这样就避免了因目标端12的速度突然增大或减小而造成的跟踪端11由于惯性需要更大幅度的速度变化来适应目标端的速度变化。这样,按照本发明的方案,跟踪端11能够更及时地响应目标端12的移动,减少了滞后时间。此外,按照本发明的方案,即使在某些情况下,例如目标端处在摄像头的拍摄范围之外或者被其他物体遮挡住的情况下,无法确定跟踪端相对于目标端的相对距离和/或相对角度时,本发明的方案由于额外引入了目标端12的运动速度作为控制器4的控制参数,而目标端12的运动速度可以采用非图像处理的方式获得,这样控制器4可以通过控制跟踪端11紧密跟随目标端12的速度,从而使得它们之间处于可接受的距离范围内。这样,一旦摄像头能够重新获取到目标端12的图像时,则可以继续进行精确跟踪。由此,本发明是通过距离、角度及速度这三个参数的结合实现了对目标端的精确跟踪。Compared with the prior art, the position and the attitude of the tracking end are adjusted based on the relative distance and the relative angle of the tracking end with respect to the target end. The solution of the present invention additionally introduces the motion speed of the target end as the control parameter of the controller, so that the tracking end 11 can track the speed change of the target end in time when tracking the target end 12, so that the tracking end 11 and the target end 12 always maintain a substantially uniform speed, thus avoiding the sudden increase or decrease of the speed of the target end 12 The tracking end 11 requires a larger speed change due to inertia to accommodate the speed change at the target end. Thus, according to the solution of the present invention, the tracking end 11 can respond to the movement of the target end 12 in a more timely manner, reducing the lag time. Furthermore, according to the solution of the present invention, even in some cases, such as when the target end is outside the shooting range of the camera or blocked by other objects, the relative distance and/or relative position of the tracking end with respect to the target end cannot be determined. At an angle, the solution of the present invention additionally introduces the motion speed of the target end 12 as the control parameter of the controller 4, and the motion speed of the target end 12 can be obtained by non-image processing, so that the controller 4 can control the tracking end. 11 closely follows the speed of the target end 12 such that they are within an acceptable distance range. Thus, once the camera is able to reacquire the image of the target 12, accurate tracking can continue. Thus, the present invention achieves accurate tracking of the target end by a combination of three parameters of distance, angle and speed.
在一个实施例中,所述控制器4可以配置成在不迟于调节所述跟踪端11的所述当前跟踪运动姿态时调节所述跟踪端11的所述当前跟踪运动速度,从而使得跟踪端11响应目标端12移动更加及时,由此减少了滞后时间。In an embodiment, the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 no later than adjusting the current tracking motion attitude of the tracking end 11 such that the tracking end The response to the target 12 is moved more timely, thereby reducing the lag time.
在一个实施例中,所述控制器4可以配置成调节所述跟踪端11的所述当前跟踪运动姿态之前调节所述跟踪端11的所述当前跟踪运动速度,从而使得跟踪端11响应目标端12移动更加及时,由此减少了滞后时间。In an embodiment, the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 before adjusting the current tracking motion posture of the tracking end 11, so that the tracking end 11 responds to the target end 12 moves more timely, thereby reducing lag time.
在一个实施例中,所述控制器4可以配置成以所述目标端12的所述当前目标运动速度为目标来调节所述跟踪端11的所述当前跟踪运动速度。In one embodiment, the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 with the current target motion speed of the target end 12 as a target.
在一个实施例中,所述控制器4可以配置成将所述跟踪端11的所述当前跟踪运动速度调节成紧随所述目标端12的所述当前目标运动速度。In one embodiment, the controller 4 may be configured to adjust the current tracking motion speed of the tracking end 11 to the current target motion speed immediately following the target end 12.
参见图2,为了确定所述跟踪端11相对于所述目标端12的当前相对角度,所述跟踪系统100还可以包括布置在所述跟踪端11处的图像采集装置5和图像处理单元6。图像采集装置5用于获取包含所述目标端12的跟踪图像, 图像处理单元6用于对所述跟踪图像进行处理,以获取所述目标端12在所述跟踪图像中的位置。所述角度确定单元2配置成根据所述目标端12在所述跟踪图像中的位置确定所述跟踪端11相对于所述目标端12的所述当前相对角度。该图像采集装置5例如可以是摄像头。Referring to FIG. 2, in order to determine the current relative angle of the tracking end 11 relative to the target end 12, the tracking system 100 may further include an image acquisition device 5 and an image processing unit 6 disposed at the tracking end 11. The image capture device 5 is configured to acquire a tracking image including the target end 12, The image processing unit 6 is configured to process the tracking image to acquire the position of the target end 12 in the tracking image. The angle determining unit 2 is configured to determine the current relative angle of the tracking end 11 relative to the target end 12 based on the position of the target end 12 in the tracking image. The image acquisition device 5 can be, for example, a camera.
在具体实施时,该图像采集装置5如摄像头可以安装在一个单轴云台处,单轴云台安装在跟踪端11处,事先设定好摄像头与目标端12的三维角度,使得目标端12始终处于摄像头拍摄的中心点。目标端12移动时,通过摄像头拍摄跟踪图片,并确定目标端12在跟踪图像中的位置,然后跟上一帧图像相比较来获得目标端12在跟踪图像中产生的x和y方向的像素位移变化,从而根据像素变化得出目标端12因移动造成的偏移角度。根据偏移角度调节跟踪端11的姿态(例如左右、上下)以使得目标端12再次处于摄像头拍摄的跟踪图像的中心点,即通过调节跟踪端11的姿态来保证所述跟踪端11相对于所述目标端12的所述当前相对角度保持为所述预设相对角度。In a specific implementation, the image capturing device 5 such as a camera can be installed at a single-axis pan/tilt, and the single-axis pan/tilt is installed at the tracking end 11, and the three-dimensional angle between the camera and the target end 12 is set in advance, so that the target end 12 is Always at the center of the camera's shooting. When the target end 12 moves, the tracking picture is taken by the camera, and the position of the target end 12 in the tracking image is determined, and then compared with the previous frame image to obtain the pixel displacement of the x and y directions generated by the target end 12 in the tracking image. The change is such that the offset angle of the target end 12 due to the movement is derived from the pixel change. Adjusting the attitude of the tracking end 11 according to the offset angle (for example, left and right, up and down) such that the target end 12 is again at the center point of the tracking image captured by the camera, that is, by adjusting the posture of the tracking end 11 to ensure that the tracking end 11 is opposite to the The current relative angle of the target end 12 is maintained at the preset relative angle.
进一步地,所述跟踪图像可以仅用于确定所述当前相对角度。也就是说,所述距离确定单元1可以并不基于所述跟踪图像来确定所述跟踪端11相对于所述目标端12的当前相对距离。由于本发明无需通过所述跟踪图像来确定距离,因此大大降低了计算量,由此解决了现有技术中由于图像处理需要大量的计算,在一定程度上存在时间滞后的问题。Further, the tracking image may only be used to determine the current relative angle. That is, the distance determining unit 1 may not determine the current relative distance of the tracking end 11 with respect to the target end 12 based on the tracking image. Since the present invention does not need to determine the distance by the tracking image, the amount of calculation is greatly reduced, thereby solving the problem in the prior art that a large amount of calculation is required due to image processing, and there is a time lag to some extent.
在其他实施例中,也可以采用其他非图像处理的方式来获取所需要的当前相对角度,如雷达探测方式、GPS定位方式或射频探测方式等。In other embodiments, other non-image processing methods may also be used to obtain the current relative angles required, such as a radar detection method, a GPS positioning method, or a radio frequency detection method.
如图2所示,为了确定所述跟踪端11相对于所述目标端12的当前相对距离,所述的跟踪系统100还可以包括设置在所述跟踪端11处的第一射频装置7;和设置在所述目标端12处的第二射频装置8。所述距离确定单元1可以配置成根据所述第一射频装置7和所述第二射频装置8之间传输的射频信号来确定所述当前相对距离。在一个实施例中,所述射频信号为超宽频(UWB,Ultra Wideband)射频信号。在实施时,所述第一射频装置7和所述第二射频装置8之间可以进行射频信号的传递并记录射频信号的发送接收时间,距离确定单元1可以通过射频信号在第一射频装置7和所述第二射频装置8之间的传递时间来计算两者之间的距离。As shown in FIG. 2, in order to determine the current relative distance of the tracking end 11 relative to the target end 12, the tracking system 100 may further include a first radio frequency device 7 disposed at the tracking end 11; A second radio frequency device 8 is provided at the target end 12. The distance determining unit 1 may be configured to determine the current relative distance according to a radio frequency signal transmitted between the first radio frequency device 7 and the second radio frequency device 8. In one embodiment, the radio frequency signal is an ultra wideband (UWB) radio frequency (UWB) radio frequency signal. In implementation, the first radio frequency device 7 and the second radio frequency device 8 can transmit radio frequency signals and record the transmission and reception time of the radio frequency signals, and the distance determining unit 1 can pass the radio frequency signals on the first radio frequency device 7 The transfer time between the second RF device 8 and the second RF device 8 is used to calculate the distance between the two.
图3示出了根据本发明另一个实施例的跟踪系统,其与图2的区别在于是所述第一射频装置7和第二射频装置8还可以仅用于所述跟踪端11与所 述目标端12的数据和指令传输。所述第一射频装置7和第二射频装置8通过它们之间传输的射频信号来实现数据和指令的传输。在实施时,所述射频信号为超宽频(UWB,Ultra Wideband)射频信号。3 shows a tracking system according to another embodiment of the present invention, which differs from FIG. 2 in that the first radio frequency device 7 and the second radio frequency device 8 can also be used only for the tracking end 11 and the The data and instruction transmission of the target end 12 is described. The first radio frequency device 7 and the second radio frequency device 8 implement transmission of data and instructions by radio frequency signals transmitted between them. In implementation, the radio frequency signal is a UWB (Ultra Wideband) radio frequency signal.
图1中的目标端速度获取单元3可以由图2中的设置在所述目标端12处的速度传感器15来实现,以获得所述目标端12的当前目标运动速度。速度传感器15所测得的当前目标运动速度可以经由所述第一射频装置7和第二射频装置8之间的射频通信传递至所述控制器4。具体实施时,在一个实施例中,所述目标端12的当前目标运动速度还可以通过加速度传感器获得。The target end speed acquisition unit 3 in FIG. 1 can be implemented by the speed sensor 15 provided at the target end 12 in FIG. 2 to obtain the current target movement speed of the target end 12. The current target speed of motion measured by the speed sensor 15 may be communicated to the controller 4 via radio frequency communication between the first radio frequency device 7 and the second radio frequency device 8. In a specific implementation, in an embodiment, the current target moving speed of the target end 12 can also be obtained by an acceleration sensor.
图4示出了根据本发明另一个实施例的跟踪系统,其与图2的区别在于是采用定位的方式来获取所述跟踪端11相对于所述目标端12的当前相对距离。如图4所示,所述的跟踪系统100还可以包括设置在所述跟踪端11处的第一定位装置9和设置在所述目标端12处的第二定位装置10。第一定位装置9用于确定所述跟踪端11的当前跟踪位置,第二定位装置10用于确定所述目标端12的当前目标位置。所述距离确定单元1可以根据所述当前跟踪位置和所述当前目标位置来确定所述当前相对距离。所述定位装置可以是GPS或北斗定位模块。4 illustrates a tracking system that differs from FIG. 2 in that positioning is used to obtain the current relative distance of the tracking end 11 relative to the target end 12, in accordance with another embodiment of the present invention. As shown in FIG. 4, the tracking system 100 can further include a first positioning device 9 disposed at the tracking end 11 and a second positioning device 10 disposed at the target end 12. The first positioning device 9 is used to determine the current tracking position of the tracking end 11, and the second positioning device 10 is used to determine the current target position of the target end 12. The distance determining unit 1 may determine the current relative distance according to the current tracking position and the current target position. The positioning device may be a GPS or a Beidou positioning module.
在图4的实施例中,还可以根据第二定位装置10所测得的所述目标端12的当前目标位置的变化来计算所述目标端12的当前目标运动速度。当然,在其他实施例中,也可以类似于图2的实施例,通过在目标端12处设置速度传感器来检测其速度。尽管未示出,在图4所示的实施例中,也可以在分别在目标端12和跟踪端11处设置无线通讯装置(例如图2中所示的射频装置),以允许从目标端12向跟踪端11传递目标端12的定位信息或速度信息。In the embodiment of FIG. 4, the current target moving speed of the target end 12 can also be calculated based on the change in the current target position of the target end 12 measured by the second positioning device 10. Of course, in other embodiments, the speed can also be detected by setting a speed sensor at the target end 12, similar to the embodiment of FIG. Although not shown, in the embodiment shown in FIG. 4, a wireless communication device (such as the radio frequency device shown in FIG. 2) may be provided at the target end 12 and the tracking end 11, respectively, to allow the target terminal 12 to be The positioning information or speed information of the target end 12 is transmitted to the tracking end 11.
在上述各个实施例中,所述跟踪端11可以为无人机、地面机器人或智能车。In each of the above embodiments, the tracking end 11 may be a drone, a ground robot or a smart car.
在一个实施例中,参见图2,所述控制系统还可以包括控制端13,所述控制端13可以具有蓝牙、WIFI和终端App 14。所述蓝牙用于与所述目标端12通信。所述蓝牙接收终端App 14的指令并将该指令发送给目标端12的第二射频装置8。所述WIFI用于与所述跟踪端11通信,所述WIFI接收跟踪端11发来的视频且发送终端App 14的指令给所述跟踪端11的控制器4。所述终端App14用于显示视频、指令信息等,其中,指令信息包括预设跟踪端 11的跟踪范围、图像采集装置5的拍摄角度、悬停、起飞、降落等等。In an embodiment, referring to FIG. 2, the control system may further include a control terminal 13, which may have Bluetooth, WIFI, and terminal App 14. The Bluetooth is used to communicate with the target terminal 12. The Bluetooth receives an instruction from the terminal App 14 and transmits the command to the second radio frequency device 8 of the target terminal 12. The WIFI is used to communicate with the tracking end 11, and the WIFI receives the video sent by the tracking end 11 and sends an instruction of the terminal App 14 to the controller 4 of the tracking end 11. The terminal App14 is configured to display video, instruction information, and the like, where the instruction information includes a preset tracking end. The tracking range of 11, the shooting angle of the image capture device 5, hovering, takeoff, landing, and the like.
图5是根据本发明另一个实施例的跟踪方法的流程图。如图5所示,本发明提供了一种跟踪方法,用于控制一移动的跟踪端跟踪一移动的目标端,包括如下步骤:FIG. 5 is a flow chart of a tracking method in accordance with another embodiment of the present invention. As shown in FIG. 5, the present invention provides a tracking method for controlling a moving tracking end to track a moving target end, including the following steps:
S101,确定所述跟踪端相对于所述目标端的当前相对距离;S101. Determine a current relative distance of the tracking end with respect to the target end.
S102,确定所述跟踪端相对于所述目标端的当前相对角度;S102. Determine a current relative angle of the tracking end with respect to the target end.
S103,获取所述目标端的当前目标运动速度;S103. Acquire a current target motion speed of the target end.
S104,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,以使得所述跟踪端相对于所述目标端基本保持为预设相对距离和预设相对角度。S104. Adjust a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, so that the tracking end is basically opposite to the target end. Keep the preset relative distance and the preset relative angle.
相比于现有技术中仅基于跟踪端相对于目标端的相对距离和相对角度来调节跟踪端的位置和姿态,本发明的方案由于额外引入了目标端的运动速度作为控制器的控制参数,使得跟踪端在跟踪目标端时能够及时跟随目标端的速度变化,从而使得跟踪端与目标端始终保持基本一致的速度,这样就避免了因目标端的速度突然增大或减小而造成的跟踪端由于惯性需要更大幅度的速度变化来适应目标端的速度变化。这样,按照本发明的方案,跟踪端能够更及时地响应目标端的移动,减少了滞后时间。此外,按照本发明的方案,即使在某些情况下,例如目标端处在摄像头的拍摄范围之外或者被其他物体遮挡住的情况下,无法确定跟踪端相对于目标端的相对距离和/或相对角度时,本发明的方案由于额外引入了目标端的运动速度作为控制器的控制参数,而目标端的运动速度可以采用非图像处理的方式获得,这样控制器可以通过控制跟踪端紧密跟随目标端的速度,从而使得它们之间处于可接受的距离范围内。这样,一旦摄像头能够重新获取到目标端的图像时,则可以继续进行精确跟踪。由此,本发明是通过距离、角度及速度这三个参数的结合实现了对目标端的精确跟踪。Compared with the prior art, the position and the attitude of the tracking end are adjusted based on the relative distance and the relative angle of the tracking end with respect to the target end. The solution of the present invention additionally introduces the motion speed of the target end as the control parameter of the controller, so that the tracking end When tracking the target end, it can follow the speed change of the target end in time, so that the tracking end and the target end always maintain a substantially consistent speed, thus avoiding the tracking end due to the inertia of the target end due to the sudden increase or decrease of the speed of the target end. A large speed change to accommodate the speed change at the target end. Thus, according to the solution of the present invention, the tracking end can respond to the movement of the target end in a more timely manner, reducing the lag time. Furthermore, according to the solution of the present invention, even in some cases, such as when the target end is outside the shooting range of the camera or blocked by other objects, the relative distance and/or relative position of the tracking end with respect to the target end cannot be determined. At the angle, the solution of the present invention additionally introduces the motion speed of the target end as the control parameter of the controller, and the motion speed of the target end can be obtained by non-image processing, so that the controller can closely follow the speed of the target end by controlling the tracking end. Thereby making them within an acceptable distance range. In this way, once the camera is able to reacquire the image of the target, then accurate tracking can continue. Thus, the present invention achieves accurate tracking of the target end by a combination of three parameters of distance, angle and speed.
进一步地,S104中根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是在不迟于调节所述跟踪端的所述当前跟踪运动姿态时调节所述跟踪端的所述当前跟踪运动速度。Further, in S104, adjusting the current tracking motion speed and the current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed are not later than adjusting the tracking end. Adjusting the current tracking motion speed of the tracking end when the current motion posture is currently tracked.
进一步地,S104中根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动 姿态,是在调节所述跟踪端的所述当前跟踪运动姿态之前调节所述跟踪端的所述当前跟踪运动速度。Further, in S104, the current tracking motion speed and the current tracking motion of the tracking end are adjusted according to the current relative distance, the current relative angle, and the current target motion speed. The attitude is to adjust the current tracking motion speed of the tracking end before adjusting the current tracking motion posture of the tracking end.
进一步地,S104中根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是以所述目标端的所述当前目标运动速度为目标来调节所述跟踪端的所述当前跟踪运动速度。Further, in S104, adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, that is, the current target of the target end The speed of motion is a target to adjust the current tracking motion speed of the tracking end.
进一步地,S104中根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是将所述跟踪端的所述当前跟踪运动速度调节成紧随所述目标端的所述当前目标运动速度。Further, in S104, adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, where the current tracking of the tracking end is performed The speed of movement is adjusted to follow the current target speed of motion of the target end.
至此,本领域技术人员应认识到,虽然本文已详尽示出和描述了本发明的多个示例性实施例,但是,在不脱离本发明精神和范围的情况下,仍可根据本发明公开的内容直接确定或推导出符合本发明原理的许多其他变型或修改。因此,本发明的范围应被理解和认定为覆盖了所有这些其他变型或修改。 In this regard, it will be appreciated by those skilled in the <RTIgt;the</RTI> <RTIgt; </ RTI> <RTIgt; </ RTI> <RTIgt; </ RTI> <RTIgt; The content directly determines or derives many other variations or modifications consistent with the principles of the invention. Therefore, the scope of the invention should be understood and construed as covering all such other modifications or modifications.

Claims (18)

  1. 一种跟踪系统,用于控制一移动的跟踪端跟踪一移动的目标端,包括:A tracking system for controlling a moving tracking end to track a moving target end, including:
    距离确定单元,用于确定所述跟踪端相对于所述目标端的当前相对距离;a distance determining unit, configured to determine a current relative distance of the tracking end relative to the target end;
    角度确定单元,用于确定所述跟踪端相对于所述目标端的当前相对角度;An angle determining unit, configured to determine a current relative angle of the tracking end with respect to the target end;
    目标端速度获取单元,用于获取所述目标端的当前目标运动速度;和a target end speed acquiring unit, configured to acquire a current target moving speed of the target end; and
    控制器,用于根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,以使得所述跟踪端相对于所述目标端基本保持为预设相对距离和预设相对角度。a controller, configured to adjust a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, so that the tracking end is opposite to the The target end is basically maintained at a preset relative distance and a preset relative angle.
  2. 根据权利要求1所述的跟踪系统,其中,所述控制器配置成在不迟于调节所述跟踪端的所述当前跟踪运动姿态时调节所述跟踪端的所述当前跟踪运动速度。The tracking system of claim 1, wherein the controller is configured to adjust the current tracking motion speed of the tracking end no later than adjusting the current tracking motion pose of the tracking end.
  3. 根据权利要求1所述的跟踪系统,其中,所述控制器配置成调节所述跟踪端的所述当前跟踪运动姿态之前调节所述跟踪端的所述当前跟踪运动速度。The tracking system of claim 1 wherein said controller is configured to adjust said current tracking motion speed of said tracking end prior to adjusting said current tracking motion pose of said tracking end.
  4. 根据权利要求2或3所述的跟踪系统,其中,所述控制器配置成以所述目标端的所述当前目标运动速度为目标来调节所述跟踪端的所述当前跟踪运动速度。The tracking system of claim 2 or 3, wherein the controller is configured to adjust the current tracking motion speed of the tracking end with the current target motion speed of the target end as a target.
  5. 根据权利要求2-4中任一项所述的跟踪系统,其中,所述控制器配置成将所述跟踪端的所述当前跟踪运动速度调节成紧随所述目标端的所述当前目标运动速度。A tracking system according to any of claims 2-4, wherein the controller is configured to adjust the current tracking motion speed of the tracking end to the current target motion speed immediately following the target end.
  6. 根据权利要求1-5中任一项所述的跟踪系统,其中,还包括:The tracking system according to any one of claims 1 to 5, further comprising:
    布置在所述跟踪端处的图像采集装置,用于获取包含所述目标端的跟踪图像;An image collection device disposed at the tracking end for acquiring a tracking image including the target end;
    图像处理单元,用于对所述跟踪图像进行处理,以获取所述目标端在所述跟踪图像中的位置;An image processing unit, configured to process the tracking image to obtain a location of the target end in the tracking image;
    其中,所述角度确定单元配置成根据所述目标端在所述跟踪图像中的位置确定所述跟踪端相对于所述目标端的所述当前相对角度。 The angle determining unit is configured to determine the current relative angle of the tracking end relative to the target end according to a position of the target end in the tracking image.
  7. 根据权利要求6所述的跟踪系统,其中,所述跟踪图像仅用于确定所述当前相对角度。The tracking system of claim 6 wherein said tracking image is only used to determine said current relative angle.
  8. 根据权利要求1-7中任一项所述的跟踪系统,还包括:The tracking system according to any one of claims 1 to 7, further comprising:
    设置在所述跟踪端处的第一射频装置;和a first radio frequency device disposed at the tracking end; and
    设置在所述目标端处的第二射频装置。A second radio frequency device disposed at the target end.
  9. 根据权利要求8所述的跟踪系统,其中,所述距离确定单元配置成根据所述第一和第二射频装置之间传输的射频信号来确定所述当前相对距离;The tracking system according to claim 8, wherein the distance determining unit is configured to determine the current relative distance according to a radio frequency signal transmitted between the first and second radio frequency devices;
    可选地,所述射频信号为超宽带射频信号。Optionally, the radio frequency signal is an ultra-wideband radio frequency signal.
  10. 根据权利要求8或9所述的跟踪系统,其中,所述第一和第二射频装置用于所述跟踪端与所述目标端的数据和指令传输。A tracking system according to claim 8 or claim 9, wherein said first and second radio frequency devices are used for data and instruction transmissions of said tracking end and said target end.
  11. 根据权利要求1-7中任一项所述的跟踪系统,还包括:The tracking system according to any one of claims 1 to 7, further comprising:
    设置在所述跟踪端处的第一定位装置,用于确定所述跟踪端的当前跟踪位置;a first positioning device disposed at the tracking end for determining a current tracking position of the tracking end;
    设置在所述目标端处的第二定位装置,用于确定所述目标端的当前目标位置;a second positioning device disposed at the target end for determining a current target position of the target end;
    其中,所述距离确定单元配置成根据所述当前跟踪位置和所述当前目标位置来确定所述当前相对距离。Wherein the distance determining unit is configured to determine the current relative distance according to the current tracking position and the current target position.
  12. 根据权利要求1-11中任一项所述的跟踪系统,其中,所述目标端速度获取单元包括布置在所述目标端处的速度传感器或加速度传感器。The tracking system according to any one of claims 1 to 11, wherein the target end speed acquisition unit includes a speed sensor or an acceleration sensor disposed at the target end.
  13. 根据权利要求1-12中任一项所述的跟踪系统,其中,所述跟踪端为无人机、地面机器人或智能车。The tracking system according to any one of claims 1 to 12, wherein the tracking end is a drone, a ground robot or a smart car.
  14. 一种跟踪方法,用于控制一移动的跟踪端跟踪一移动的目标端,包括如下步骤:A tracking method for controlling a moving tracking end to track a moving target end includes the following steps:
    确定所述跟踪端相对于所述目标端的当前相对距离;Determining a current relative distance of the tracking end relative to the target end;
    确定所述跟踪端相对于所述目标端的当前相对角度;Determining a current relative angle of the tracking end with respect to the target end;
    获取所述目标端的当前目标运动速度;Obtaining a current target moving speed of the target end;
    根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,以使得所述跟踪端相对于所述目标端基本保持为预设相对距离和预设相对角度。Adjusting a current tracking motion speed and a current tracking motion posture of the tracking end according to the current relative distance, the current relative angle, and the current target motion speed, so that the tracking end is substantially maintained relative to the target end Preset relative distance and preset relative angle.
  15. 根据权利要求14所述的跟踪方法,其中,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪 运动速度和当前跟踪运动姿态,是在不迟于调节所述跟踪端的所述当前跟踪运动姿态时调节所述跟踪端的所述当前跟踪运动速度。The tracking method according to claim 14, wherein the current tracking of the tracking end is adjusted according to the current relative distance, the current relative angle, and the current target moving speed The motion speed and the current tracking motion attitude are such that the current tracking motion speed of the tracking end is adjusted no later than adjusting the current tracking motion posture of the tracking end.
  16. 根据权利要求14所述的跟踪方法,其中,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是在调节所述跟踪端的所述当前跟踪运动姿态之前调节所述跟踪端的所述当前跟踪运动速度。The tracking method according to claim 14, wherein the current tracking motion speed and the current tracking motion posture of the tracking end are adjusted according to the current relative distance, the current relative angle, and the current target motion speed, which are adjusted Adjusting the current tracking motion speed of the tracking end before the current tracking motion posture of the tracking end.
  17. 根据权利要求15或16所述的跟踪方法,其中,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是以所述目标端的所述当前目标运动速度为目标来调节所述跟踪端的所述当前跟踪运动速度。The tracking method according to claim 15 or 16, wherein the current tracking motion speed and the current tracking motion posture of the tracking end are adjusted according to the current relative distance, the current relative angle, and the current target motion speed, Adjusting the current tracking motion speed of the tracking end with the current target motion speed of the target end as a target.
  18. 根据权利要求15-17中任一项所述的跟踪方法,其中,根据所述当前相对距离、所述当前相对角度和所述当前目标运动速度来调节所述跟踪端的当前跟踪运动速度和当前跟踪运动姿态,是将所述跟踪端的所述当前跟踪运动速度调节成紧随所述目标端的所述当前目标运动速度。 The tracking method according to any one of claims 15-17, wherein the current tracking motion speed and current tracking of the tracking end are adjusted according to the current relative distance, the current relative angle, and the current target motion speed The motion posture is to adjust the current tracking motion speed of the tracking end to the current target motion speed immediately following the target end.
PCT/CN2016/087654 2016-05-16 2016-06-29 Tracking system and tracking method WO2017197729A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201610323428.9 2016-05-16
CN201610323428.9A CN106023251A (en) 2016-05-16 2016-05-16 Tracking system and tracking method

Publications (1)

Publication Number Publication Date
WO2017197729A1 true WO2017197729A1 (en) 2017-11-23

Family

ID=57098310

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2016/087654 WO2017197729A1 (en) 2016-05-16 2016-06-29 Tracking system and tracking method

Country Status (2)

Country Link
CN (1) CN106023251A (en)
WO (1) WO2017197729A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113341971A (en) * 2021-06-01 2021-09-03 阿尔特汽车技术股份有限公司 Automatic tracking walking golf cart and automatic tracking walking control method

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106483980B (en) * 2016-11-24 2019-05-31 腾讯科技(深圳)有限公司 A kind of unmanned plane follows the control method of flight, apparatus and system
CN106529500A (en) * 2016-11-28 2017-03-22 中控智慧科技股份有限公司 Information processing method and system
CN106843275B (en) * 2017-04-01 2020-03-27 成都通甲优博科技有限责任公司 Fixed-point flying method, device and system for unmanned aerial vehicle
WO2018205133A1 (en) * 2017-05-09 2018-11-15 Zepp Labs, Inc. Direction finding of wireless communication devices
CN107272732A (en) * 2017-06-12 2017-10-20 广东工业大学 Unmanned flight's device group system
CN107368066A (en) * 2017-06-13 2017-11-21 纳恩博(北京)科技有限公司 A kind of control method, equipment and system
CN107992068A (en) * 2017-11-29 2018-05-04 天津聚飞创新科技有限公司 Method for tracking target, device and aircraft
CN107807664A (en) * 2017-11-29 2018-03-16 天津聚飞创新科技有限公司 Method for tracking target, device and unmanned plane
CN108646787B (en) * 2018-04-12 2021-03-02 广州杰赛科技股份有限公司 Target tracking method and device and unmanned aerial vehicle
CN108680143A (en) * 2018-04-27 2018-10-19 南京拓威航空科技有限公司 Object localization method, device based on long-distance ranging and unmanned plane
CN109272527A (en) * 2018-09-03 2019-01-25 中国人民解放军国防科技大学 Tracking control method and device for random moving target in three-dimensional scene
CN109709954A (en) * 2018-12-21 2019-05-03 北京智行者科技有限公司 Vehicle follower method in road cleaning operation
CN109739267A (en) * 2018-12-21 2019-05-10 北京智行者科技有限公司 Follow the determination method in path
CN109976385A (en) * 2019-04-03 2019-07-05 成都永奉科技有限公司 A kind of Following Car control method based on acceleration
CN109945861B (en) * 2019-04-05 2023-11-14 长春光客科技有限公司 Alignment tracking device and method for unidirectional wireless optical communication between small unmanned aerial vehicle and ground
CN110131617A (en) * 2019-04-09 2019-08-16 广东艾罗照明科技股份有限公司 Intelligent object following spot light and its control method
CN109991386A (en) * 2019-04-17 2019-07-09 武汉理工大学 Unmanned boat and unmanned plane Collaborative Control monitoring method, apparatus and system
CN110191414A (en) * 2019-05-27 2019-08-30 段德山 Method for tracing and system based on terminal
CN110347166B (en) * 2019-08-13 2022-07-26 浙江吉利汽车研究院有限公司 Sensor control method for automatic driving system
WO2022000211A1 (en) * 2020-06-29 2022-01-06 深圳市大疆创新科技有限公司 Photography system control method, device, movable platform, and storage medium
CN112558637B (en) * 2020-12-11 2022-11-25 西安航光卫星测控技术有限公司 Method for avoiding air moving target by unmanned aerial vehicle in unmanned aerial vehicle cluster
CN115431266A (en) * 2022-08-24 2022-12-06 阿里巴巴达摩院(杭州)科技有限公司 Inspection method, inspection device and inspection robot
CN118068851A (en) * 2024-04-18 2024-05-24 中国科学院西安光学精密机械研究所 Intelligent sensing method for tracking aerial target

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104267743A (en) * 2014-07-22 2015-01-07 浙江工业大学 Shipborne camera shooting stabilized platform control method with active disturbance rejection control technology adopted
CN104853104A (en) * 2015-06-01 2015-08-19 深圳市微队信息技术有限公司 Method and system for automatically tracking and shooting moving object
CN105549614A (en) * 2015-12-17 2016-05-04 北京猎鹰无人机科技有限公司 Target tracking method of unmanned plane

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI388205B (en) * 2008-12-19 2013-03-01 Ind Tech Res Inst Method and apparatus for tracking objects
US9367067B2 (en) * 2013-03-15 2016-06-14 Ashley A Gilmore Digital tethering for tracking with autonomous aerial robot
CN104932548B (en) * 2015-05-29 2017-11-21 北京航空航天大学 A kind of unmanned plane directional aerial autotracking systems design method
CN105487552B (en) * 2016-01-07 2019-02-19 深圳一电航空技术有限公司 The method and device of unmanned plane track up

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104267743A (en) * 2014-07-22 2015-01-07 浙江工业大学 Shipborne camera shooting stabilized platform control method with active disturbance rejection control technology adopted
CN104853104A (en) * 2015-06-01 2015-08-19 深圳市微队信息技术有限公司 Method and system for automatically tracking and shooting moving object
CN105549614A (en) * 2015-12-17 2016-05-04 北京猎鹰无人机科技有限公司 Target tracking method of unmanned plane

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113341971A (en) * 2021-06-01 2021-09-03 阿尔特汽车技术股份有限公司 Automatic tracking walking golf cart and automatic tracking walking control method

Also Published As

Publication number Publication date
CN106023251A (en) 2016-10-12

Similar Documents

Publication Publication Date Title
WO2017197729A1 (en) Tracking system and tracking method
US11604479B2 (en) Methods and system for vision-based landing
CN112567201B (en) Distance measuring method and device
US9977434B2 (en) Automatic tracking mode for controlling an unmanned aerial vehicle
CN110494360B (en) System and method for providing autonomous photography and photography
CN108399642B (en) General target following method and system fusing rotor unmanned aerial vehicle IMU data
JP4587166B2 (en) Moving body tracking system, photographing apparatus, and photographing method
EP3627269A1 (en) Target tracking method and apparatus, mobile device and storage medium
US10322819B2 (en) Autonomous system for taking moving images from a drone, with target tracking and improved target location
WO2018227350A1 (en) Control method for homeward voyage of unmanned aerial vehicle, unmanned aerial vehicle and machine-readable storage medium
CN105245846A (en) Multi-unmanned aerial vehicle cooperative tracking type shooting system and shooting method
WO2016138687A1 (en) Control system, terminal and airborne flight control system of multi-rotor craft
WO2018210078A1 (en) Distance measurement method for unmanned aerial vehicle, and unmanned aerial vehicle
CN105487552A (en) Unmanned aerial vehicle tracking shooting method and device
CN105182992A (en) Unmanned aerial vehicle control method and device
WO2021127888A1 (en) Control method, smart glasses, mobile platform, gimbal, control system, and computer-readable storage medium
US20190168870A1 (en) System and method for tracking targets
WO2019051832A1 (en) Movable object control method, device and system
CN108776491A (en) Unmanned plane multiple target monitoring system and monitoring method based on dynamic image identification
WO2017201698A1 (en) Method and apparatus for tracking target
WO2018059295A1 (en) Control method, device, and system for multirotor aerial vehicle
WO2020233682A1 (en) Autonomous circling photographing method and apparatus and unmanned aerial vehicle
WO2020062024A1 (en) Distance measurement method and device based on unmanned aerial vehicle and unmanned aerial vehicle
KR101876829B1 (en) Induction control system for indoor flight control of small drones
CN108225316A (en) The acquisition methods and apparatus and system of attitude of carrier information

Legal Events

Date Code Title Description
NENP Non-entry into the national phase

Ref country code: DE

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 16902109

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 16902109

Country of ref document: EP

Kind code of ref document: A1