WO2023029005A1 - Field of view control method for detection device, detection device, and mobile platform - Google Patents

Field of view control method for detection device, detection device, and mobile platform Download PDF

Info

Publication number
WO2023029005A1
WO2023029005A1 PCT/CN2021/116540 CN2021116540W WO2023029005A1 WO 2023029005 A1 WO2023029005 A1 WO 2023029005A1 CN 2021116540 W CN2021116540 W CN 2021116540W WO 2023029005 A1 WO2023029005 A1 WO 2023029005A1
Authority
WO
WIPO (PCT)
Prior art keywords
optical element
phase difference
detection device
rotational speed
field
Prior art date
Application number
PCT/CN2021/116540
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 深圳市大疆创新科技有限公司
Priority to PCT/CN2021/116540 priority Critical patent/WO2023029005A1/en
Publication of WO2023029005A1 publication Critical patent/WO2023029005A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/08Systems determining position data of a target for measuring distance only
    • G01S17/10Systems determining position data of a target for measuring distance only using transmission of interrupted, pulse-modulated waves

Definitions

  • the present application relates to the field of detection devices, and in particular to a method for controlling the field of view of a detection device, a detection device and a movable platform.
  • detection devices are widely used in various fields, for example, the field of automatic driving.
  • the detection device usually has a large scanning field of view, and can scan to obtain more point cloud information.
  • Embodiments of the present application provide a method for controlling a field of view of a detection device, a detection device, and a movable platform, aiming at improving the application range and reliability of the detection device and improving user experience.
  • the embodiment of the present application provides a method for controlling the field of view of a detection device, including:
  • the target phase difference adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
  • the embodiment of the present application also provides a detection device, including:
  • the scanning module is arranged on the optical path of the light pulse sequence emitted by the light source, the scanning module includes a first optical element and a second optical element, and the first optical element and the second optical element are used to change the The propagation direction of the light pulse sequence, so that the detection device scans according to the first field of view direction and/or the second field of view direction;
  • One or more processors working individually or jointly, for executing the computer program and implementing the following steps when executing the computer program:
  • the target phase difference adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
  • the embodiment of the present application also provides a mobile platform, including:
  • a power system is provided on the platform body and is used to provide moving power for the movable platform;
  • the detection device as described above is provided on the platform body and is used to detect external environment information.
  • the embodiment of the present application also provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor implements the above-mentioned The steps of the method for controlling the field of view of the detection device.
  • An embodiment of the present application provides a method for controlling the field of view of a detection device, by obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device, and then adjusting the first optical element according to the target phase difference
  • the motion parameters of an optical element and/or the motion parameters of the second optical element enable the detection device to scan the corresponding field of view position or field of view area in the direction of the first field of view, so that the detection device can scan in the field of view desired by the user. Scanning the position of the field or the area of the field of view greatly improves the application range and reliability of the detection device.
  • Fig. 1 is a schematic diagram of a scene implementing the field of view control method of the detection device provided by the embodiment of the present application;
  • Fig. 2 is a schematic flowchart of the steps of a field of view control method of a detection device provided in an embodiment of the present application;
  • Fig. 3 is a schematic diagram of the scanning range of the detection device in the second field of view direction in the embodiment of the present application;
  • Fig. 4 is a schematic flowchart of the sub-steps of the field of view control method of the detection device in Fig. 2;
  • Fig. 5 is a point cloud distribution diagram output by the detection device in the embodiment of the present application.
  • Fig. 6 is a waveform diagram in which the phase difference between the first optical element and the second optical element in the embodiment of the present application changes periodically according to the phase difference variation range;
  • Fig. 7 is another waveform diagram in which the phase difference between the first optical element and the second optical element in the embodiment of the present application changes periodically according to the phase difference variation range;
  • Fig. 8 is another point cloud distribution diagram output by the detection device in the embodiment of the present application.
  • Fig. 9 is another point cloud distribution diagram output by the detection device in the embodiment of the present application.
  • Fig. 10 is another point cloud distribution diagram output by the detection device in the embodiment of the present application.
  • Fig. 11 is a representation curve of the mapping relationship between the phase difference and the feedback control moment
  • Fig. 12 is a schematic structural block diagram of a detection device provided by an embodiment of the present application.
  • Fig. 13 is a schematic block diagram of a structure of a mobile platform provided by an embodiment of the present application.
  • the inventors of the present application found that the current detection devices usually have a larger scanning field of view, and can scan to obtain more point cloud information, but in some scenarios, only a certain position or a certain area needs to be scanned, and If a large-scale scan is performed, there will be some unnecessary point clouds, which is not convenient for subsequent processing, and the detection device needs to be replaced, which is not good for the user experience.
  • the inventors of the present application improved the field of view control method of the detection device, the detection device and the movable platform, so that the detection device can scan at the position or area of the field of view desired by the user, greatly improving the The application range and reliability of the detection device are improved.
  • the method for controlling the field of view of the detection device may be applied to the detection device, and may also be applied to a movable platform, which is not specifically limited in this embodiment of the present application.
  • the detection device is used to detect external environmental information, such as distance information, orientation information, reflection intensity information, speed information, etc. of environmental targets.
  • the detection device can be applied to space scene simulation, automatic obstacle avoidance system, 3D imaging system, 3D modeling system, Remote sensing systems, surveying and mapping systems, navigation systems, etc.
  • Fig. 1 is a schematic diagram of a scene implementing the field of view control method of the detection device provided by the embodiment of the present application.
  • the movable platform 100 includes a platform body 110, a power system 120, a detection device 130 and a control system (not shown in Figure 1), the power system 120 and the detection device 130 are arranged on the platform body 110, and the power system 120 Used to provide moving power for the movable platform, the detection device 130 is used to detect the external environment information of the environment where the movable platform is located.
  • the detecting device 130 may include electronic equipment such as radar and ranging equipment, such as lidar or laser ranging equipment. Wherein, the detection device 130 can detect the distance from the detection object to the detection device 130 by measuring the light propagation time between the detection device 130 and the detection object, that is, the time-of-flight (TOF). Alternatively, the detection device 130 can also detect the distance from the detection object to the detection device 130 by other technologies, such as a distance measurement method based on phase shift (phase shift) measurement, or a distance measurement method based on frequency shift (frequency shift) measurement. This is not limited.
  • TOF time-of-flight
  • the detection device 130 includes a light source and a scanning module, the light source is used to emit a sequence of light pulses, such as a sequence of laser pulses.
  • the scanning module is arranged on the optical path of the light pulse sequence emitted by the light source, and is used to change the propagation direction of the light pulse sequence so that the detection device 130 scans according to the first field of view direction and/or the second field of view direction.
  • the scanning module includes a first optical element and a second optical element, and the first optical element and the second optical element are used to change the propagation direction of the light pulse sequence, so that the detection device follows the direction of the first field of view and/or Scanning is performed in the second field of view direction.
  • the first field of view direction and the second field of view direction of the detection device are related to the installation position of the detection device, the first field of view direction may be a vertical field of view direction, and the second field of view direction may be a horizontal field of view direction, or, The first field of view direction may be a horizontal field of view direction, and the second field of view direction may be a vertical field of view direction.
  • the scanning module further includes a first drive mechanism and a second drive mechanism, the first drive mechanism is connected to the first optical element for driving the first optical element to rotate, the second drive mechanism is connected to the second optical element, Used to drive the rotation of the second optical element.
  • the first optical element may include a prism
  • the second optical element may include a reflector
  • the prism is used to change the propagation direction of the light pulse sequence emitted by the light source, so that the light pulse sequence reaches the reflector, and the reflector performs the optical pulse sequence reflection, so that the detection device scans according to the direction of the first field of view and/or the direction of the second field of view.
  • the control of the first driving mechanism and the second driving mechanism may be continuous or stepwise.
  • the first driving mechanism drives the prism to rotate, it may rotate continuously, and may stop after each rotation of one step, and then rotate by one step, and repeat.
  • the second driving mechanism drives the mirror to rotate, it may rotate continuously, or it may stop after rotating one step each time, and then rotate another step.
  • the step-size driving method is conducive to more precise control of the attitude of the optical components, which in turn helps to form a more regular and evenly arranged point cloud, but the continuous driving method is better than the step-size driving method.
  • the driving method is more conducive to fast scanning, and is more suitable for some application scenarios that require scanning speed.
  • the power system 120 may include one or more propellers 121 , one or more motors 122 corresponding to the one or more propellers, and one or more electronic governors (referred to as ESCs for short).
  • the motor 122 is connected between the electronic governor and the propeller 121, and the motor 122 and the propeller 121 are arranged on the platform body 110 of the movable platform 100; the electronic governor is used to receive the driving signal generated by the control system, and according to the driving signal The driving current is provided to the motor 122 to control the rotation speed of the motor 122 .
  • the motor 122 is used to drive the propeller 121 to rotate, so as to provide power for the movement of the movable platform 100, and the power enables the movable platform 100 to realize the movement of one or more degrees of freedom.
  • the movable platform 100 is rotatable about one or more axes of rotation.
  • the above-mentioned rotation axes may include a roll axis, a yaw axis and a pitch axis.
  • the motor 122 may be a DC motor or an AC motor.
  • the motor 122 may be a brushless motor or a brushed motor.
  • the control system may include a controller and a sensing system.
  • the sensing system is used to measure the attitude information of the movable platform, that is, the position information and status information of the movable platform 100 in space, such as three-dimensional position, three-dimensional angle, three-dimensional velocity, three-dimensional acceleration and three-dimensional angular velocity.
  • the sensing system may include, for example, at least one of sensors such as a gyroscope, an ultrasonic sensor, an electronic compass, an inertial measurement unit (Inertial Measurement Unit, IMU), a visual sensor, a global navigation satellite system, and a barometer.
  • the global navigation satellite system may be the Global Positioning System (GPS).
  • the controller is used to control the movement of the movable platform 100, for example, the movement of the movable platform 100 may be controlled according to the attitude information measured by the sensor system. It should be understood that the controller may control the movable platform 100 according to pre-programmed instructions.
  • the controller acquires the target phase difference between the first optical element and the second optical element of the scanning module in the detection device 130; according to the target phase difference, adjust the motion parameters of the first optical element and/or the second optical element The motion parameters of the second optical element, so that the detection device scans the corresponding field of view position or field of view area in the first field of view direction, so that the detection device can scan at the field of view position or field of view area desired by the user, very
  • the application range and reliability of the detection device are greatly improved.
  • the movable platform 100 includes unmanned aerial vehicles and cloud platform vehicles.
  • the man-machine can also be a combination of a rotary-wing drone and a fixed-wing drone, which is not limited here.
  • the movable platform 100 may also include vehicles and boats that can carry people, and the detection device 130 may scan the desired field of view position or field of view area around the vehicle or boat.
  • FIG. 2 is a schematic flowchart of steps of a method for controlling a field of view of a detection device provided in an embodiment of the present application.
  • the field of view control method of the detection device can be applied to the detection device or a movable platform to improve the application range and reliability of the detection device.
  • the field of view control method of the detection device includes steps S101 to S102.
  • Step S101 obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device;
  • Step S102 adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element according to the target phase difference, so that the detection device scans the corresponding field of view position or field of view area in the first field of view direction.
  • the detection device is provided with a first scanning mode and/or a second scanning mode, the first scanning mode instructs the detection device to scan at a corresponding position of the field of view in the direction of the first field of view, and the second scanning mode instructs the detection
  • the device scans the viewing field area in the first viewing field direction, and the first scanning mode and the second scanning mode can be switched mutually.
  • the scanning range of the detection device in the direction of the second field of view in the first scanning mode is the same as the scanning range of the detection device in the direction of the second field of view in the second scanning mode, and/or, the detection device is in the first scanning mode.
  • the position or area of the field of view scanned in the direction of the field of view can be adjusted, and/or, the area of the field of view scanned by the detection device in the direction of the first field of view includes The field of view position to scan.
  • the motion parameters of the first optical element and/or the motion parameters of the second optical element are adjusted, so that the detection device is in the first scanning mode.
  • the first optical element and the second optical element rotate according to the same rotational speed and direction while maintaining the target phase difference, so that the position of the field of view corresponding to the target phase difference of the detection device in the direction of the first field of view to scan.
  • the motion parameter includes a rotational speed and/or a rotation direction, and the rotation direction may be counterclockwise or clockwise.
  • the corresponding relationship between the target phase difference and the position of the field of view is related to the reflection angle of the second optical element, and the phase difference between the first optical element and the second optical element being zero corresponds to the field of view in the direction of the first field of view Location dependent.
  • the reflection angle of the second optical element as 45°
  • the position of the field of view corresponding to zero phase difference is the upper edge of the scanning range in the direction of the first field of view (ie +22.5°) as an example
  • the target phase difference and the position of the field of view The correspondence between can be:
  • represents the target phase difference between the first optical element and the second optical element
  • View position represents the field of view position corresponding to the target phase difference ⁇ in the first field of view direction
  • FOV vertical represents the position of the detection device in the first field of view direction the scan range on.
  • the scanning range of the detection device in the direction of the second field of view may be as shown in FIG. 3 , that is, the detection device scans in a 360° horizontal direction.
  • the first mode switching instruction is obtained, wherein the first mode switching instruction is used to instruct the detection device to switch the scanning mode to the first scanning mode; the phase difference in the first mode switching instruction is determined as the first optical element and The target phase difference between the second optical elements; or, when the first mode switching instruction is obtained, determining the current phase difference between the first optical element and the second optical element as the target phase difference; according to the target phase difference, The motion parameters of the first optical element and/or the motion parameters of the second optical element are adjusted so that the detection device is in the first scanning mode.
  • the scanning mode of the detection device can be quickly switched to the first scanning mode, so that the detection device scans at the position of the field of view corresponding to the target phase difference.
  • the first mode switching instruction when the first mode switching instruction is acquired, if the first mode switching instruction does not carry phase difference information, the first The current phase difference between the optical element and the second optical element is determined as the target phase difference. At this time, it is not necessary to adjust the motion parameters of the first optical element and the motion parameters of the second optical element.
  • the field of view position corresponding to the target phase difference in the field direction is scanned.
  • the phase difference in the first mode switching instruction can be determined as the target phase difference between the first optical element and the second optical element.
  • the motion parameters of the first optical element and/or the motion parameters of the second optical element can enable the detection device to scan at the position of the field of view corresponding to the target phase difference in the direction of the first field of view.
  • the second optical element determines whether the first mode switching command is carried phase difference information. If the first mode switching command carries phase difference information, the phase difference in the first mode switching command can be determined as the target phase difference.
  • the target phase difference between the second optical element at this time, by adjusting the motion parameters of the first optical element and/or the motion parameters of the second optical element, the target phase difference correspondence of the detection device in the first field of view direction can be realized The position of the field of view is scanned.
  • adjusting the motion parameters of the first optical element and/or the motion parameters of the second optical element so that the detection device is in the first scanning mode may be as follows: adjusting the motion parameters of the first optical element And/or the motion parameter of the second optical element; when the phase difference between the first optical element and the second optical element reaches the target phase difference, control the first optical element to rotate according to the current motion parameter of the second optical element, or , controlling the second optical element to rotate according to the current motion parameters of the first optical element, so that the first optical element and the second optical element rotate according to the same rotational speed and direction.
  • the way to adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element so that the detection device is in the first scanning mode may be: control the first optical element and the second optical element The optical element stops rotating, and then adjusts the phase difference between the first optical element and the second optical element; when the phase difference between the first optical element and the second optical element reaches the target phase difference, control the first optical element and the second optical element The second optical element rotates according to a preset rotation speed and a preset direction while maintaining a target phase difference.
  • step S102 specifically includes: sub-steps S1021 to S1022.
  • Sub-step S1021 acquiring the target rotational speed difference between the first optical element and the second optical element
  • Sub-step S1022 adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element according to the target phase difference and the target rotational speed difference, so that the detection device is in the second scanning mode.
  • the phase difference between the first optical element and the second optical element changes periodically starting from the target phase difference, so that the detection device scans the field of view area in the first field of view direction .
  • the motion parameters of the first optical element and/or the motion parameters of the second optical element are adjusted according to the target phase difference; when the first optical element and the second optical element rotate at the same speed and direction, and the second optical element
  • the phase difference between the first optical element and the second optical element reaches the target phase difference, according to the target rotational speed difference, the phase difference between the first optical element and the second optical element is controlled to change periodically starting from the target phase difference,
  • the detection device is made to scan the corresponding field of view area in the first field of view direction.
  • the manner of controlling the phase difference between the first optical element and the second optical element to change periodically starting from the target phase difference may be: according to the target rotational speed difference and the target phase difference, determine the phase Difference change range, wherein, the phase difference change range starts from the target phase difference; control the motion parameters of the first optical element and/or the motion parameters of the second optical element to change periodically, so that the phase difference is carried out according to the phase difference change range Periodic changes.
  • the detection device scans in the viewing field area corresponding to the phase difference variation range in the first viewing field direction.
  • the phase difference between the two optical elements can be better and precisely controlled to change periodically starting from the target phase difference, so as to accurately realize the corresponding field of view of the detection device in the direction of the first field of view
  • the scanning of the area improves the reliability of the detection device.
  • the method of controlling the motion parameters of the first optical element and/or the motion parameters of the second optical element to change periodically so that the phase difference changes periodically according to the phase difference variation range may be as follows: obtaining a synchronous rotational speed, wherein , when the first optical element and the second optical element rotate at a synchronous rotational speed, the phase difference between the first optical element and the second optical element is the same as the target phase difference; control the rotational speed of the first optical element and/or the second optical The rotational speed of the element changes periodically around the synchronous rotational speed, so that the phase difference between the first optical element and the second optical element changes periodically according to the phase difference variation range.
  • the phase difference can be precisely controlled to change periodically according to the range of the phase difference, so that the detection device can be accurately realized at the first
  • the scanning of the corresponding field of view area in the field of view direction improves the reliability of the detection device.
  • the motion parameter includes a rotational speed
  • the waveform in which the rotational speed of the first optical element and/or the rotational speed of the second optical element changes periodically includes one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
  • controlling the rotational speed of the first optical element and/or the rotational speed of the second optical element to periodically change around the synchronous rotational speed may include: controlling the rotational speed of the first optical element to periodically change around the synchronous rotational speed, and Control the second optical element to rotate at a constant speed according to the rotation direction of the first optical element and the synchronous rotational speed; or control the rotational speed of the second optical element to periodically change around the synchronous rotational speed, and control the first optical element to follow the second optical
  • the rotation direction of the element and the synchronous rotational speed rotate at a constant speed, or the rotational speed of the first optical element is controlled to periodically change around the synchronous rotational speed, and the rotational speed of the second optical element is controlled to periodically vary around the synchronous rotational speed.
  • the way to determine the range of phase difference variation can be: obtain the point cloud frame rate of the detection device, and determine the duration of a cycle according to the point cloud frame rate; according to the duration and the target The rotation speed difference is to determine the first phase difference; and to determine the variation range of the phase difference according to the first phase difference and the target phase difference.
  • the first optical element and The second optical element corresponds to the upper edge of the scanning range of the detection device in the direction of the first field of view (i.e. + 22.5°) at 0 phase.
  • the detection device is at The scanning range of the field of view position corresponding to the target phase difference ⁇ in the first field of view direction is:
  • ⁇ max is the first phase difference
  • the point cloud frame rate is 10Hz
  • the first parallax direction is the vertical field of view direction
  • the second field of view direction is the horizontal field of view direction
  • the scanning range of the vertical field of view is 45 degrees
  • the target phase difference ⁇ ⁇ /2
  • the variable range of the target speed difference ⁇ V is 300rpm, and it changes sinusoidally, with a period of 0.1s as an example.
  • the point cloud distribution map output by the detection device can be shown in Figure 5.
  • the phase difference between the first optical element and the second optical element changes periodically according to the phase difference variation range
  • the corresponding waveform may include one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
  • the phase difference between the first optical element and the second optical element changes periodically according to the range of the phase difference.
  • the corresponding waveform can be shown in Figure 6.
  • the waveform is a triangle wave.
  • the phase difference with the second optical element starts from the target phase difference ⁇ to the first phase difference ⁇ max , and after reaching the first phase difference ⁇ max , it then moves from the first phase difference ⁇ max to the target phase difference ⁇ Decrease until returning to the target phase difference ⁇ .
  • the manner of determining the variation range of the phase difference may be: according to the first phase difference and the target phase difference, determining the second phase difference, wherein the target phase difference is the first phase difference
  • the phase difference at the midpoint between the second phase difference and the phase difference change range is determined according to the first phase difference, the second phase difference and the target phase difference.
  • the phase difference between the first optical element and the second optical element changes periodically according to the range of the phase difference.
  • the corresponding waveform can be shown in Figure 7.
  • the waveform is a sine wave.
  • the phase difference with the second optical element starts from the target phase difference ⁇ to the first phase difference ⁇ max , and after reaching the first phase difference ⁇ max , it then moves from the first phase difference ⁇ max to the target phase difference ⁇ Decrease until it returns to the target phase difference ⁇ , then continue to decrease from the target phase difference ⁇ to the second phase difference ⁇ 1 , and then go from the second phase difference ⁇ 1 to the target phase difference after reaching the second phase difference ⁇ 1 ⁇ is increased until returning to the target phase difference ⁇ .
  • the second mode switching instruction is obtained, wherein the second mode switching instruction is used to instruct the detection device to switch the scanning mode to the second scanning mode; the rotational speed difference in the second mode switching instruction is determined as the target rotational speed difference , and determine the current phase difference between the first optical element and the second optical element as the target phase difference; according to the target rotational speed difference and the target phase difference, control the phase difference between the first optical element and the second optical element to the target The phase difference is periodically changed as the starting point.
  • the second mode switching instruction the scanning mode of the detection device can be quickly switched to the second scanning mode.
  • the distance between the first optical element and the second optical element is The current phase difference is determined as the target phase difference, and according to the target speed difference in the second mode switching command, the motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference
  • the periodic change is performed according to the change range of the phase difference, so that the detection device is in the second scanning mode.
  • the second mode switching instruction is obtained, wherein the second mode switching instruction is used to instruct the detection device to switch the scanning mode to the second scanning mode; the rotational speed difference in the second mode switching instruction is determined as the target rotational speed difference , and determine the phase difference in the second mode switching instruction as the target phase difference; according to the target phase difference and the target rotational speed difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the detection device In second scan mode.
  • the scanning mode of the detection device can be quickly switched to the second scanning mode.
  • the second mode switching instruction when the second mode switching instruction is obtained, if the detection device is in the first scanning mode, and the second mode switching instruction carries phase difference information, the phase difference between the first optical element and the second optical element
  • the current phase difference is determined as the target phase difference, and according to the target rotational speed difference in the second mode switching command, the motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference follows The changing range of the phase difference changes periodically, so that the detecting device is in the second scanning mode.
  • the inventors of the present application found that there are mainly two ways to implement the current detection device.
  • the first way is that multiple sets of transmitters and receivers are rotated as a whole to realize scanning.
  • the second way is that multiple sets of transmitters and receivers are fixed and cooperate with scanning.
  • the rotation of the module realizes the scanning.
  • the number of transmitters and receivers of the former is often much larger than that of the latter, and mainstream products can reach tens or hundreds, which is expensive. Compared with the former, the production and assembly complexity of the latter is greatly reduced, and the cost advantage is obvious. Under the condition of several transmitters and receivers with scanning modules, the point cloud effect of dozens or hundreds of transmitters and receivers of the former can be realized.
  • the optical components in the scanning module need to be rotated at high speed.
  • the high-speed rotation of the optical components will cause vibration and noise, which will affect the reliability of the detection device.
  • high-speed rotation will also generate high power consumption, which will affect the use of the detection device.
  • the rotational speed of the optical element is reduced, the distribution of the point cloud collected by the detection device will be sparse in the middle and dense in the two sides, and the detection effect of the detection device will not be good.
  • the inventors of the present application provided the detection device with a third scanning mode.
  • the rotational speed of the first optical element changes periodically around the first rotational speed and/or the second optical element
  • the rotating speed of the rotating speed changes periodically around the second rotating speed as the center, and the first rotating speed and the second rotating speed are smaller than the preset rotating speed threshold, and the preset rotating speed threshold can be set based on actual conditions, and is not specifically limited here.
  • the acquisition of the detection device caused by reducing the rotational speed of the optical element can be solved.
  • the obtained point cloud distribution has the problem of being sparse in the middle and dense on both sides, so as to ensure the balance of point cloud distribution and point cloud density.
  • Fig. 8 is a point cloud distribution diagram when both the first optical element and the second optical element rotate at a speed v1 greater than or equal to 13000rpm, and the number of transmitters and receivers is 4, as shown in Fig. 8, the points The cloud distribution is relatively uniform.
  • Figure 9 shows the point cloud distribution diagram when the first optical element and the second optical element rotate at a rotational speed of v2 , and the number of emitters and receivers is 4, as shown in Figure 9. It shows that the point cloud distribution has a problem of being sparse in the middle and dense on both sides.
  • Figure 10 is the point cloud effect diagram when the second optical element rotates at a constant speed of speed v2 , the first optical element changes periodically around the speed v3 , and the number of transmitters and receivers is 4, as shown in Figure 10 As shown, the point cloud distribution is uniform and dense, which is very similar to the point cloud distribution diagram shown in Figure 8.
  • the third mode switching instruction is obtained, and according to the third mode switching instruction, the detection device is controlled to be in the third scanning mode.
  • the rotational speed of the first optical element changes periodically around the first rotational speed and/or the rotational speed of the second optical element changes periodically around the second rotational speed, the first rotational speed and the second rotational speed
  • the second rotational speed is less than the preset rotational speed threshold, and the preset rotational speed threshold can be set based on actual conditions, and is not specifically limited here.
  • the first rotation speed, the first rotation angle of the first optical element, the second rotation speed and the second rotation angle of the second optical element satisfy the preset constraint condition, and when the preset constraint condition is satisfied
  • the scanning patterns of the detection device in each frame are consistent, and the preset constraints can be set based on actual conditions, which are not specifically limited here.
  • the preset constraints are:
  • V 1 M 1 *N*60
  • V 2 M 2 *N*60
  • N is the frame rate of the detection device
  • M 1 , M 2 and n are integers, optional, n is 1, V 1 is the first rotation speed, V 2 is the second rotation speed, ⁇ 1 is the first rotation angle, ⁇ 2 is the second rotation angle.
  • the manner of controlling the detection device to be in the third scanning mode may include: controlling the first optical element to rotate at a first rotational speed at a constant speed, and controlling the rotational speed of the second optical element to periodically change around the second rotational speed; or controlling The second optical element rotates at a constant speed at the second rotational speed, and controls the rotational speed of the first optical element to periodically change around the first rotational speed; or controls the rotational speed of the first optical element to periodically change around the first rotational speed, and The rotational speed of the second optical element is controlled to change periodically around the second rotational speed.
  • the waveform in which the rotating speed changes periodically may include one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
  • the manner of controlling the rotational speed of the first optical element may include: acquiring a feedback control parameter of the rotational speed of the first optical element; performing feedback control on the rotational speed of the first optical element according to the feedback control parameter of the rotational speed of the first optical element .
  • the feedback control parameters of the rotational speed of the first optical element include the expected phase difference between the first optical element and the second optical element, the current rotation angle of the first optical element, the current rotational speed of the first optical element, and the second rotation angle.
  • the expected phase difference between the first optical element and the second optical element, the current rotation angle of the first optical element, the current rotational speed of the first optical element, and the second rotation angle of the second optical element are acquired.
  • the way of acquiring the expected phase difference may include: acquiring the current feedback control moment of the first optical element in the current period; determining the first A desired phase difference between the optical element and the second optical element.
  • the mapping relationship between the preset phase difference and the feedback control moment is based on the maximum scanning range of the detection device in the direction of the first field of view, the number of emitters, the included angle of emission, the point cloud frame rate, the first rotational speed and The second rotation speed is determined, and the mapping relationship between the phase difference and the feedback control time can be set based on actual conditions, which is not specifically limited in this embodiment.
  • the mapping relationship between the phase difference and the feedback control moment can be represented by a curve as shown in FIG. 11. The curve shown in FIG. When the scanning speed in the center of the field of view is fast, the speed is reduced, so that the uniform arrangement of the point cloud can be achieved.
  • the way of feedback controlling the rotational speed of the first optical element may include: determining the reference rotational speed of the first optical element according to the second rotation angle; Angle and expected phase difference, determine the reference rotation angle of the first optical element; determine the compensation reference rotation speed of the first optical element according to the current rotation angle and the reference rotation angle; according to the reference rotation speed, the compensation reference rotation speed and the current rotation speed of the first optical element , to perform feedback control on the current rotational speed of the first optical element.
  • the method of determining the reference rotation speed of the first optical element according to the second rotation angle can be exemplarily given, that is, the corresponding current reference moment can be obtained according to the second rotation angle, and according to the current reference moment and the first optical element
  • the rotational speed of the element and the time mapping relationship can determine the reference rotational speed of the first optical element.
  • the manner of controlling the second optical element to periodically change around the second rotational speed may refer to the specific process of controlling the first optical element to periodically change around the first rotational speed, which will not be repeated here.
  • the detection device after the detection device is started, it may enter the third scanning mode by default. For example, after the detection device is started, it automatically triggers the third mode switching instruction, and controls the detection device to enter the third scanning mode according to the third mode switching instruction.
  • the first scanning mode or the second scanning mode may also be entered by default, which is not specifically limited in this embodiment.
  • FIG. 12 is a schematic block diagram of a detection device provided by an embodiment of the present application.
  • the detection device 200 includes a scanning module 210, a memory 220 and one or more processors 230, and the scanning module 210, the memory 220 and one or more processors 230 are connected through a bus 240, and the bus 240 is, for example, It is the I2C (Inter-integrated Circuit) bus.
  • I2C Inter-integrated Circuit
  • the scanning module 200 is arranged on the optical path of the light pulse sequence emitted by the light source, the scanning module 200 includes a first optical element and a second optical element, the first optical element and the second optical The element is used to change the propagation direction of the light pulse sequence, so that the detection device 200 scans according to the first field of view direction and/or the second field of view direction.
  • the memory 220 can be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk or a mobile hard disk, etc., and the memory 220 is used to store computer programs.
  • ROM Read-Only Memory
  • the memory 220 is used to store computer programs.
  • the processor 230 may be a micro-controller unit (Micro-controller Unit, MCU), a central processing unit (Central Processing Unit, CPU), or a digital signal processor (Digital Signal Processor, DSP), etc.
  • MCU Micro-controller Unit
  • CPU Central Processing Unit
  • DSP Digital Signal Processor
  • processors 230 work individually or jointly to execute the computer program and implement the following steps when executing the computer program:
  • the target phase difference adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
  • the processor adjusts the motion parameter of the first optical element and/or the motion parameter of the second optical element according to the target phase difference, it is configured to:
  • the first optical element and the second optical element rotate according to the same rotation speed and direction while maintaining the target phase difference, so that the detection device rotates in the direction of the first field of view
  • the position of the field of view corresponding to the phase difference of the target is scanned.
  • the processor when obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device, the processor is used to:
  • the phase difference in the first mode switching instruction is determined as a target phase difference between the first optical element and the second optical element.
  • the processor when obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device, the processor is used to:
  • the current phase difference between the first optical element and the second optical element is determined as the target phase difference, wherein the first mode switching instruction is used to indicate The detection device switches the scanning mode to the first scanning mode.
  • the processor adjusts the motion parameter of the first optical element and/or the motion parameter of the second optical element according to the target phase difference, it is configured to:
  • the phase difference between the first optical element and the second optical element changes periodically starting from the target phase difference, so that the detection device The field of view area in the field of view direction is scanned.
  • the processor when the processor adjusts the motion parameter of the first optical element and/or the motion parameter of the second optical element according to the target phase difference and the target rotational speed difference, it is configured to implement :
  • the target rotational speed difference is used to control the phase difference to periodically change with the target phase difference as a starting point.
  • the processor controls the phase difference to periodically change with the target phase difference as a starting point according to the target rotational speed difference, it is used to realize:
  • the motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference is periodically changed according to the phase difference variation range.
  • the processor controls the motion parameters of the first optical element and/or the motion parameters of the second optical element to periodically change, so that the phase difference varies according to the phase difference range
  • the processor controls the motion parameters of the first optical element and/or the motion parameters of the second optical element to periodically change, so that the phase difference varies according to the phase difference range
  • the rotational speed of the first optical element and/or the rotational speed of the second optical element are controlled to periodically change around the synchronous rotational speed, so that the phase difference is periodically changed according to the phase difference variation range.
  • the detection device scans in the field of view area corresponding to the phase difference variation range in the first field of view direction.
  • the motion parameter includes a rotational speed
  • the waveform in which the rotational speed changes periodically includes one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
  • the processor when the processor realizes determining the variation range of the phase difference according to the target rotational speed difference and the target phase difference, it is used to realize:
  • the processor when the processor realizes determining the variation range of the phase difference according to the first phase difference and the target phase difference, it is configured to:
  • the target phase difference is a phase difference at a midpoint between the first phase difference and the second phase difference ;
  • the phase difference variation range is determined according to the first phase difference, the second phase difference and the target phase difference.
  • processor is also used to implement the following steps:
  • the rotational speed difference in the second mode switching command is determined as the target rotational speed difference.
  • processor is also used to implement the following steps:
  • the detection device is provided with a first scanning mode and/or a second scanning mode, the first scanning mode instructs the detection device to scan at a corresponding field of view position in the direction of the first field of view, the The second scanning mode instructs the detecting device to scan the field of view area in the first field of view direction.
  • the scanning range of the detection device in the second field of view direction in the first scanning mode is the same as the scanning range of the detection device in the second field of view direction in the second scanning mode; and /or,
  • the position or area of the field of view that the detection device scans in the first field of view direction can be adjusted; and/or,
  • the field of view area includes the field of view position.
  • processor is also used to implement the following steps:
  • the rotational speed of the first optical element changes periodically around the first rotational speed and/or the rotational speed of the second optical element changes periodically around the second rotational speed.
  • the first rotational speed, the first rotational angle of the first optical element, the second rotational speed, and the second rotational angle of the second optical element satisfy a predetermined Set constraints.
  • the processor realizes controlling the detection device to be in the third scanning mode, it is used to realize:
  • the rotational speed of the first optical element is controlled to periodically change around the first rotational speed
  • the rotational speed of the second optical element is controlled to be periodically varied around the second rotational speed
  • the processor when the processor realizes controlling the rotational speed of the first optical element, it is configured to realize:
  • Feedback control is performed on the rotational speed of the first optical element according to the feedback control parameter.
  • the processor obtains the feedback control parameter of the rotational speed of the first optical element, it is configured to:
  • the processor when the processor performs feedback control on the rotational speed of the first optical element according to the feedback control parameter, it is configured to:
  • Feedback control is performed on the current rotational speed of the first optical element according to the reference rotational speed, the compensation reference rotational speed and the current rotational speed.
  • the processor when the processor obtains the desired phase difference between the first optical element and the second optical element, it is configured to:
  • An expected phase difference between the first optical element and the second optical element is determined according to the current feedback control time and a preset mapping relationship between the phase difference and the feedback control time.
  • the mapping relationship is based on the maximum scanning range of the detection device in the direction of the first field of view, the number of emitters, the included angle of emission, the point cloud frame rate, the first rotational speed and the second Speed is determined.
  • the first optical element includes a prism
  • the second optical element includes a mirror
  • FIG. 13 is a schematic structural block diagram of a mobile platform provided by an embodiment of the present application.
  • the movable platform 300 includes a platform body 310 , a power system 320 and a detection device 330 .
  • the power system 320 is set on the platform body 310 and is used to provide mobile power for the movable platform 300
  • the detection device 330 is set on the platform body 310 and is used to detect the external environment information of the environment where the movable platform 300 is located.
  • the detection device 330 may be the detection device 200 in FIG. 12 .
  • the embodiment of the present application also provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, the computer program includes program instructions, and the processor executes the program instructions to implement the above-mentioned embodiment.
  • the computer-readable storage medium may be an internal storage unit of the detection device or the movable platform described in any of the foregoing embodiments, such as a hard disk or a memory of the detection device or the movable platform.
  • the computer-readable storage medium can also be an external storage device of the detection device or the removable platform, such as a plug-in hard disk equipped on the detection device or the removable platform, a smart memory card (Smart Media Card, SMC) , Secure Digital (Secure Digital, SD) card, flash memory card (Flash Card), etc.

Landscapes

  • Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

A field of view control method for a detection device, comprising: obtaining a target phase difference between a first optical element and a second optical element of a scanning module in the detection device (S101); and adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference, so that the detection device scans a corresponding field of view position or field of view area in a first field of view direction (S102). The field of view control method can improve the application range of the detection device.

Description

探测装置的视场控制方法、探测装置及可移动平台Method for controlling field of view of detection device, detection device and movable platform 技术领域technical field
本申请涉及探测装置领域,尤其涉及一种探测装置的视场控制方法、探测装置及可移动平台。The present application relates to the field of detection devices, and in particular to a method for controlling the field of view of a detection device, a detection device and a movable platform.
背景技术Background technique
随着探测装置技术的不断发展,探测装置被广泛的应用于各个领域,例如,自动驾驶领域。目前,探测装置通常具有较大的扫描视场,可以扫描得到较多的点云信息,但在一些场景下,只需要对某个位置或某个区域进行扫描,而若进行大范围的扫描,会存在一些不必要的点云,不便于后续处理,用户体验也不好。With the continuous development of detection device technology, detection devices are widely used in various fields, for example, the field of automatic driving. At present, the detection device usually has a large scanning field of view, and can scan to obtain more point cloud information. However, in some scenarios, it is only necessary to scan a certain position or a certain area, and if a large-scale scan is performed, There will be some unnecessary point clouds, which are not convenient for subsequent processing, and the user experience is not good.
发明内容Contents of the invention
本申请实施例提供了一种探测装置的视场控制方法、探测装置及可移动平台,旨在提高探测装置的应用范围和可靠性,以提高用户体验。Embodiments of the present application provide a method for controlling a field of view of a detection device, a detection device, and a movable platform, aiming at improving the application range and reliability of the detection device and improving user experience.
第一方面,本申请实施例提供了一种探测装置的视场控制方法,包括:In the first aspect, the embodiment of the present application provides a method for controlling the field of view of a detection device, including:
获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差;Acquiring the target phase difference between the first optical element and the second optical element of the scanning module in the detection device;
根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置在第一视场方向上的对应视场位置或视场区域进行扫描。According to the target phase difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
第二方面,本申请实施例还提供了一种探测装置,包括:In the second aspect, the embodiment of the present application also provides a detection device, including:
扫描模组,设于光源发射出的光脉冲序列的光路上,所述扫描模组包括第一光学元件和第二光学元件,所述第一光学元件和所述第二光学元件用于改变所述光脉冲序列的传播方向,以使所述探测装置按照第一视场方向和/或第二视场方向进行扫描;The scanning module is arranged on the optical path of the light pulse sequence emitted by the light source, the scanning module includes a first optical element and a second optical element, and the first optical element and the second optical element are used to change the The propagation direction of the light pulse sequence, so that the detection device scans according to the first field of view direction and/or the second field of view direction;
存储器,用于存储计算机程序;memory for storing computer programs;
一个或多个处理器,单独地或共同地工作,用于执行所述计算机程序并在执行所述计算机程序时实现以下步骤:One or more processors, working individually or jointly, for executing the computer program and implementing the following steps when executing the computer program:
获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差;Acquiring the target phase difference between the first optical element and the second optical element of the scanning module in the detection device;
根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置在第一视场方向上的对应视场位置或视场区域进行扫描。According to the target phase difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
第三方面,本申请实施例还提供了一种可移动平台,包括:In the third aspect, the embodiment of the present application also provides a mobile platform, including:
平台本体;Platform ontology;
动力系统,设于所述平台本体上,用于为所述可移动平台提供移动动力;A power system is provided on the platform body and is used to provide moving power for the movable platform;
如上所述的探测装置,设于所述平台本体上,用于探测外部环境信息。The detection device as described above is provided on the platform body and is used to detect external environment information.
第四方面,本申请实施例还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如上所述的探测装置的视场控制方法的步骤。In a fourth aspect, the embodiment of the present application also provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor implements the above-mentioned The steps of the method for controlling the field of view of the detection device.
本申请实施例提供了一种探测装置的视场控制方法,通过获取探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差,然后根据该目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置在第一视场方向上的对应视场位置或视场区域进行扫描,使得探测装置可以在用户想要的视场位置或视场区域进行扫描,极大地提高了探测装置的应用范围和可靠性。An embodiment of the present application provides a method for controlling the field of view of a detection device, by obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device, and then adjusting the first optical element according to the target phase difference The motion parameters of an optical element and/or the motion parameters of the second optical element enable the detection device to scan the corresponding field of view position or field of view area in the direction of the first field of view, so that the detection device can scan in the field of view desired by the user. Scanning the position of the field or the area of the field of view greatly improves the application range and reliability of the detection device.
应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本申请。It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the application.
附图说明Description of drawings
为了更清楚地说明本申请实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to illustrate the technical solutions of the embodiments of the present application more clearly, the drawings that need to be used in the description of the embodiments will be briefly introduced below. Obviously, the drawings in the following description are some embodiments of the present application. Ordinary technicians can also obtain other drawings based on these drawings on the premise of not paying creative work.
图1是实施本申请实施例提供的探测装置的视场控制方法的一场景示意图;Fig. 1 is a schematic diagram of a scene implementing the field of view control method of the detection device provided by the embodiment of the present application;
图2是本申请实施例提供的一种探测装置的视场控制方法的步骤示意流程图;Fig. 2 is a schematic flowchart of the steps of a field of view control method of a detection device provided in an embodiment of the present application;
图3是本申请实施例中的探测装置在第二视场方向上的扫描范围的示意图;Fig. 3 is a schematic diagram of the scanning range of the detection device in the second field of view direction in the embodiment of the present application;
图4是图2中的探测装置的视场控制方法的子步骤示意流程图;Fig. 4 is a schematic flowchart of the sub-steps of the field of view control method of the detection device in Fig. 2;
图5是本申请实施例中的探测装置输出的一点云分布图;Fig. 5 is a point cloud distribution diagram output by the detection device in the embodiment of the present application;
图6是本申请实施例中的第一光学元件与第二光学元件之间的相位差按照相位差变化范围进行周期性变化的一波形图;Fig. 6 is a waveform diagram in which the phase difference between the first optical element and the second optical element in the embodiment of the present application changes periodically according to the phase difference variation range;
图7是本申请实施例中的第一光学元件与第二光学元件之间的相位差按照相位差变化范围进行周期性变化的另一波形图;Fig. 7 is another waveform diagram in which the phase difference between the first optical element and the second optical element in the embodiment of the present application changes periodically according to the phase difference variation range;
图8是本申请实施例中的探测装置输出的另一点云分布图;Fig. 8 is another point cloud distribution diagram output by the detection device in the embodiment of the present application;
图9是本申请实施例中的探测装置输出的又一点云分布图;Fig. 9 is another point cloud distribution diagram output by the detection device in the embodiment of the present application;
图10是本申请实施例中的探测装置输出的再一点云分布图;Fig. 10 is another point cloud distribution diagram output by the detection device in the embodiment of the present application;
图11是相位差与反馈控制时刻之间的映射关系的一表示曲线;Fig. 11 is a representation curve of the mapping relationship between the phase difference and the feedback control moment;
图12是本申请实施例提供的一种探测装置的结构示意性框图;Fig. 12 is a schematic structural block diagram of a detection device provided by an embodiment of the present application;
图13是本申请实施例提供的一种可移动平台的结构示意性框图。Fig. 13 is a schematic block diagram of a structure of a mobile platform provided by an embodiment of the present application.
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The following will clearly and completely describe the technical solutions in the embodiments of the present application with reference to the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of them. Based on the embodiments in this application, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the scope of protection of this application.
附图中所示的流程图仅是示例说明,不是必须包括所有的内容和操作/步骤,也不是必须按所描述的顺序执行。例如,有的操作/步骤还可以分解、组合或部分合并,因此实际执行的顺序有可能根据实际情况改变。The flow charts shown in the drawings are just illustrations, and do not necessarily include all contents and operations/steps, nor must they be performed in the order described. For example, some operations/steps can be decomposed, combined or partly combined, so the actual order of execution may be changed according to the actual situation.
本申请的发明人发现,目前的探测装置通常具有较大的扫描视场,可以扫描得到较多的点云信息,但在一些场景下,只需要对某个位置或某个区域进行扫描,而若进行大范围的扫描,会存在一些不必要的点云,不便于后续处理,需要更换探测装置,用户体验不好。The inventors of the present application found that the current detection devices usually have a larger scanning field of view, and can scan to obtain more point cloud information, but in some scenarios, only a certain position or a certain area needs to be scanned, and If a large-scale scan is performed, there will be some unnecessary point clouds, which is not convenient for subsequent processing, and the detection device needs to be replaced, which is not good for the user experience.
为解决上述问题,本申请的发明人对探测装置的视场控制方法、探测装置及可移动平台进行了改进,使得探测装置可以在用户想要的视场位置或视场区域进行扫描,极大地提高了探测装置的应用范围和可靠性。In order to solve the above problems, the inventors of the present application improved the field of view control method of the detection device, the detection device and the movable platform, so that the detection device can scan at the position or area of the field of view desired by the user, greatly improving the The application range and reliability of the detection device are improved.
下面结合附图,对本申请的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。Some implementations of the present application will be described in detail below in conjunction with the accompanying drawings. In the case of no conflict, the following embodiments and features in the embodiments can be combined with each other.
探测装置的视场控制方法可以应用于探测装置,也可以应用于可移动平台,本申请实施例对此不做具体限定。探测装置用于探测外部环境信息,比如环境目标的距离信息、方位信息、反射强度信息、速度信息等,探测装置可以应用于空间场景模拟、自动避障系统、三维成像系统、三维建模系统、遥感系统、测绘系统、导航系统等场合。The method for controlling the field of view of the detection device may be applied to the detection device, and may also be applied to a movable platform, which is not specifically limited in this embodiment of the present application. The detection device is used to detect external environmental information, such as distance information, orientation information, reflection intensity information, speed information, etc. of environmental targets. The detection device can be applied to space scene simulation, automatic obstacle avoidance system, 3D imaging system, 3D modeling system, Remote sensing systems, surveying and mapping systems, navigation systems, etc.
请参阅图1,图1是实施本申请实施例提供的探测装置的视场控制方法的 一场景示意图。如图1所示,可移动平台100包括平台本体110、动力系统120、探测装置130和控制系统(图1未示出),动力系统120和探测装置130设于平台本体110上,动力系统120用于为可移动平台提供移动动力,探测装置130用于探测可移动平台所处环境的外部环境信息。Please refer to Fig. 1. Fig. 1 is a schematic diagram of a scene implementing the field of view control method of the detection device provided by the embodiment of the present application. As shown in Figure 1, the movable platform 100 includes a platform body 110, a power system 120, a detection device 130 and a control system (not shown in Figure 1), the power system 120 and the detection device 130 are arranged on the platform body 110, and the power system 120 Used to provide moving power for the movable platform, the detection device 130 is used to detect the external environment information of the environment where the movable platform is located.
示例性的,探测装置130可以包括雷达、测距设备等电子设备,比如激光雷达或者激光测距设备。其中,探测装置130可以通过测量探测装置130和探测物之间光传播的时间,即光飞行时间(Time-of-Flight,TOF),以探测探测物到探测装置130的距离。或者,探测装置130也可以通过其他技术来探测探测物到探测装置130的距离,例如基于相位移动(phase shift)测量的测距方法,或者基于频率移动(frequency shift)测量的测距方法,在此不做限制。Exemplarily, the detecting device 130 may include electronic equipment such as radar and ranging equipment, such as lidar or laser ranging equipment. Wherein, the detection device 130 can detect the distance from the detection object to the detection device 130 by measuring the light propagation time between the detection device 130 and the detection object, that is, the time-of-flight (TOF). Alternatively, the detection device 130 can also detect the distance from the detection object to the detection device 130 by other technologies, such as a distance measurement method based on phase shift (phase shift) measurement, or a distance measurement method based on frequency shift (frequency shift) measurement. This is not limited.
在一实施例中,探测装置130包括光源和扫描模组,光源用于发射光脉冲序列,比如激光脉冲序列。扫描模组设于光源发射出的光脉冲序列的光路上,用于改变光脉冲序列的传播方向,以使探测装置130按照第一视场方向和/或第二视场方向进行扫描。In an embodiment, the detection device 130 includes a light source and a scanning module, the light source is used to emit a sequence of light pulses, such as a sequence of laser pulses. The scanning module is arranged on the optical path of the light pulse sequence emitted by the light source, and is used to change the propagation direction of the light pulse sequence so that the detection device 130 scans according to the first field of view direction and/or the second field of view direction.
示例性的,扫描模组包括第一光学元件和第二光学元件,第一光学元件和第二光学元件用于改变光脉冲序列的传播方向,以使探测装置按照第一视场方向和/或第二视场方向进行扫描。其中,探测装置的第一视场方向和第二视场方向与探测装置的安装位置有关,第一视场方向可以为垂直视场方向,第二视场方向可以为水平视场方向,或者,第一视场方向可以为水平视场方向,第二视场方向可以为垂直视场方向。Exemplarily, the scanning module includes a first optical element and a second optical element, and the first optical element and the second optical element are used to change the propagation direction of the light pulse sequence, so that the detection device follows the direction of the first field of view and/or Scanning is performed in the second field of view direction. Wherein, the first field of view direction and the second field of view direction of the detection device are related to the installation position of the detection device, the first field of view direction may be a vertical field of view direction, and the second field of view direction may be a horizontal field of view direction, or, The first field of view direction may be a horizontal field of view direction, and the second field of view direction may be a vertical field of view direction.
示例性的,扫描模组还包括第一驱动机构和第二驱动机构,第一驱动机构与第一光学元件连接,用于驱动第一光学元件旋转,第二驱动机构与第二光学元件连接,用于驱动第二光学元件旋转。其中,第一光学元件可以包括棱镜,第二光学元件可以包括反射镜,棱镜用于改变光源发射出的光脉冲序列的传播方向,以使光脉冲序列抵达反射镜,反射镜对光脉冲序列进行反射,以使探测装置按照第一视场方向和/或第二视场方向进行扫描。Exemplarily, the scanning module further includes a first drive mechanism and a second drive mechanism, the first drive mechanism is connected to the first optical element for driving the first optical element to rotate, the second drive mechanism is connected to the second optical element, Used to drive the rotation of the second optical element. Wherein, the first optical element may include a prism, and the second optical element may include a reflector, and the prism is used to change the propagation direction of the light pulse sequence emitted by the light source, so that the light pulse sequence reaches the reflector, and the reflector performs the optical pulse sequence reflection, so that the detection device scans according to the direction of the first field of view and/or the direction of the second field of view.
示例性的,第一驱动机构和第二驱动机构的控制可以是连续式的,也可以是步进式的。例如,第一驱动机构在驱动棱镜旋转时,可以是连续旋转,可以是每次旋转一个步长后停下,再旋转一个步长,以此重复。又例如,第二驱动机构在驱动反射镜旋转时,可以是连续旋转,也可以是每次旋转一个步长后停下,再旋转一个步长。步长式的驱动方式相比连续式的驱动方式有利于更精准控制光学元件的姿态,进而有助于形成一个更规则均匀排布的点云,但连续式 的驱动方式相比步长式的驱动方式更有利于实现快速扫描,更适用于一些对扫描速度有要求的应用场景。Exemplarily, the control of the first driving mechanism and the second driving mechanism may be continuous or stepwise. For example, when the first driving mechanism drives the prism to rotate, it may rotate continuously, and may stop after each rotation of one step, and then rotate by one step, and repeat. For another example, when the second driving mechanism drives the mirror to rotate, it may rotate continuously, or it may stop after rotating one step each time, and then rotate another step. Compared with the continuous driving method, the step-size driving method is conducive to more precise control of the attitude of the optical components, which in turn helps to form a more regular and evenly arranged point cloud, but the continuous driving method is better than the step-size driving method. The driving method is more conducive to fast scanning, and is more suitable for some application scenarios that require scanning speed.
其中,动力系统120可以包括一个或多个螺旋桨121、与一个或多个螺旋桨相对应的一个或多个电机122、一个或多个电子调速器(简称为电调)。其中,电机122连接在电子调速器与螺旋桨121之间,电机122和螺旋桨121设置在可移动平台100的平台本体110上;电子调速器用于接收控制系统产生的驱动信号,并根据驱动信号提供驱动电流给电机122,以控制电机122的转速。电机122用于驱动螺旋桨121旋转,从而为可移动平台100的移动提供动力,该动力使得可移动平台100能够实现一个或多个自由度的运动。在某些实施例中,可移动平台100可以围绕一个或多个旋转轴旋转。例如,上述旋转轴可以包括横滚轴、偏航轴和俯仰轴。应理解,电机122可以是直流电机,也可以交流电机。另外,电机122可以是无刷电机,也可以是有刷电机。Wherein, the power system 120 may include one or more propellers 121 , one or more motors 122 corresponding to the one or more propellers, and one or more electronic governors (referred to as ESCs for short). Wherein, the motor 122 is connected between the electronic governor and the propeller 121, and the motor 122 and the propeller 121 are arranged on the platform body 110 of the movable platform 100; the electronic governor is used to receive the driving signal generated by the control system, and according to the driving signal The driving current is provided to the motor 122 to control the rotation speed of the motor 122 . The motor 122 is used to drive the propeller 121 to rotate, so as to provide power for the movement of the movable platform 100, and the power enables the movable platform 100 to realize the movement of one or more degrees of freedom. In some embodiments, the movable platform 100 is rotatable about one or more axes of rotation. For example, the above-mentioned rotation axes may include a roll axis, a yaw axis and a pitch axis. It should be understood that the motor 122 may be a DC motor or an AC motor. In addition, the motor 122 may be a brushless motor or a brushed motor.
其中,控制系统可以包括控制器和传感系统。传感系统用于测量可移动平台的姿态信息,即可移动平台100在空间的位置信息和状态信息,例如,三维位置、三维角度、三维速度、三维加速度和三维角速度等。传感系统例如可以包括陀螺仪、超声传感器、电子罗盘、惯性测量单元(Inertial Measurement Unit,IMU)、视觉传感器、全球导航卫星系统和气压计等传感器中的至少一种。例如,全球导航卫星系统可以是全球定位系统(Global Positioning System,GPS)。控制器用于控制可移动平台100的移动,例如,可以根据传感系统测量的姿态信息控制可移动平台100的移动。应理解,控制器可以按照预先编好的程序指令对可移动平台100进行控制。Wherein, the control system may include a controller and a sensing system. The sensing system is used to measure the attitude information of the movable platform, that is, the position information and status information of the movable platform 100 in space, such as three-dimensional position, three-dimensional angle, three-dimensional velocity, three-dimensional acceleration and three-dimensional angular velocity. The sensing system may include, for example, at least one of sensors such as a gyroscope, an ultrasonic sensor, an electronic compass, an inertial measurement unit (Inertial Measurement Unit, IMU), a visual sensor, a global navigation satellite system, and a barometer. For example, the global navigation satellite system may be the Global Positioning System (GPS). The controller is used to control the movement of the movable platform 100, for example, the movement of the movable platform 100 may be controlled according to the attitude information measured by the sensor system. It should be understood that the controller may control the movable platform 100 according to pre-programmed instructions.
在一实施例中,控制器获取探测装置130中扫描模组的第一光学元件与第二光学元件之间的目标相位差;根据目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置在第一视场方向上的对应视场位置或视场区域进行扫描,使得探测装置可以在用户想要的视场位置或视场区域进行扫描,极大地提高了探测装置的应用范围和可靠性。In one embodiment, the controller acquires the target phase difference between the first optical element and the second optical element of the scanning module in the detection device 130; according to the target phase difference, adjust the motion parameters of the first optical element and/or the second optical element The motion parameters of the second optical element, so that the detection device scans the corresponding field of view position or field of view area in the first field of view direction, so that the detection device can scan at the field of view position or field of view area desired by the user, very The application range and reliability of the detection device are greatly improved.
其中,可移动平台100包括无人机和云台车、无人机包括旋翼型无人机,例如四旋翼无人机、六旋翼无人机、八旋翼无人机,也可以是固定翼无人机,还可以是旋翼型与固定翼无人机的组合,在此不作限定。应当可以理解的是,可移动平台100还可以包括可载人车辆、船只,探测装置130可以对车辆、船只四周用户想要的视场位置或视场区域进行扫描。Among them, the movable platform 100 includes unmanned aerial vehicles and cloud platform vehicles. The man-machine can also be a combination of a rotary-wing drone and a fixed-wing drone, which is not limited here. It should be understood that the movable platform 100 may also include vehicles and boats that can carry people, and the detection device 130 may scan the desired field of view position or field of view area around the vehicle or boat.
以下,将结合图1中的场景对本申请的实施例提供的探测装置的视场控制 方法进行详细介绍。需知,图1中的场景仅用于解释本申请实施例提供的探测装置的视场控制方法,但并不构成对本申请实施例提供的探测装置的视场控制方法应用场景的限定。Hereinafter, the method for controlling the field of view of the detection device provided by the embodiment of the present application will be described in detail in conjunction with the scene in Fig. 1 . It should be noted that the scene in Figure 1 is only used to explain the field of view control method of the detection device provided by the embodiment of the present application, but does not constitute a limitation on the application scene of the field of view control method of the detection device provided by the embodiment of the present application.
请参阅图2,图2是本申请实施例提供的一种探测装置的视场控制方法的步骤示意流程图。该探测装置的视场控制方法可以应用于探测装置或可移动平台中,以提高探测装置的应用范围和可靠性。Please refer to FIG. 2 . FIG. 2 is a schematic flowchart of steps of a method for controlling a field of view of a detection device provided in an embodiment of the present application. The field of view control method of the detection device can be applied to the detection device or a movable platform to improve the application range and reliability of the detection device.
如图2所示,该探测装置的视场控制方法包括步骤S101至步骤S102。As shown in FIG. 2 , the field of view control method of the detection device includes steps S101 to S102.
步骤S101、获取探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差;Step S101, obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device;
步骤S102、根据目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置在第一视场方向上的对应视场位置或视场区域进行扫描。Step S102 , adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element according to the target phase difference, so that the detection device scans the corresponding field of view position or field of view area in the first field of view direction.
在一实施例中,探测装置设有第一扫描模式和/或第二扫描模式,第一扫描模式指示探测装置在第一视场方向上的对应视场位置进行扫描,第二扫描模式指示探测装置在第一视场方向上的视场区域进行扫描,第一扫描模式与第二扫描模式之间可以相互切换。In one embodiment, the detection device is provided with a first scanning mode and/or a second scanning mode, the first scanning mode instructs the detection device to scan at a corresponding position of the field of view in the direction of the first field of view, and the second scanning mode instructs the detection The device scans the viewing field area in the first viewing field direction, and the first scanning mode and the second scanning mode can be switched mutually.
示例性的,第一扫描模式下探测装置在第二视场方向上的扫描范围与第二扫描模式下探测装置在第二视场方向上的扫描范围相同,和/或,探测装置在第一视场方向上进行扫描的视场位置或视场区域是能够被调节的,和/或,探测装置在第一视场方向上进行扫描的视场区域包括探测装置在第一视场方向上进行扫描的视场位置。Exemplarily, the scanning range of the detection device in the direction of the second field of view in the first scanning mode is the same as the scanning range of the detection device in the direction of the second field of view in the second scanning mode, and/or, the detection device is in the first scanning mode. The position or area of the field of view scanned in the direction of the field of view can be adjusted, and/or, the area of the field of view scanned by the detection device in the direction of the first field of view includes The field of view position to scan.
在一实施例中,根据目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置处于第一扫描模式。其中,在第一扫描模式下,第一光学元件和第二光学元件按照相同的转速和方向保持目标相位差进行旋转,使得探测装置在第一视场方向上的目标相位差对应的视场位置进行扫描。其中,该运动参数包括转速和/或旋转方向,该旋转方向可以为逆时针方向,与可以为顺时针方向。通过上述方案,可以实现探测装置第一视场方向上的任意视场位置的扫描,极大地提高了探测装置的应用范围和可靠性。In an embodiment, according to the target phase difference, the motion parameters of the first optical element and/or the motion parameters of the second optical element are adjusted, so that the detection device is in the first scanning mode. Wherein, in the first scanning mode, the first optical element and the second optical element rotate according to the same rotational speed and direction while maintaining the target phase difference, so that the position of the field of view corresponding to the target phase difference of the detection device in the direction of the first field of view to scan. Wherein, the motion parameter includes a rotational speed and/or a rotation direction, and the rotation direction may be counterclockwise or clockwise. Through the above solution, the scanning of any position of the field of view in the first field of view direction of the detection device can be realized, which greatly improves the application range and reliability of the detection device.
应理解,目标相位差与视场位置之间的对应关系与第二光学元件的反射角度,第一光学元件与第二光学元件之间的相位差为零对应第一视场方向上的视场位置相关。以第二光学元件的反射角度为45°,相位差为零对应的视场位置为第一视场方向上的扫描范围的上边缘(即+22.5°)为例,目标相位差与视场 位置之间的对应关系可以为:It should be understood that the corresponding relationship between the target phase difference and the position of the field of view is related to the reflection angle of the second optical element, and the phase difference between the first optical element and the second optical element being zero corresponds to the field of view in the direction of the first field of view Location dependent. Taking the reflection angle of the second optical element as 45°, and the position of the field of view corresponding to zero phase difference is the upper edge of the scanning range in the direction of the first field of view (ie +22.5°) as an example, the target phase difference and the position of the field of view The correspondence between can be:
Figure PCTCN2021116540-appb-000001
Figure PCTCN2021116540-appb-000001
其中,Δθ表示第一光学元件与第二光学元件之间的目标相位差,View position表示第一视场方向上目标相位差Δθ对应的视场位置,FOV vertical表示探测装置在第一视场方向上的扫描范围。 Among them, Δθ represents the target phase difference between the first optical element and the second optical element, View position represents the field of view position corresponding to the target phase difference Δθ in the first field of view direction, and FOV vertical represents the position of the detection device in the first field of view direction the scan range on.
示例性的,在第一视场方向为垂直视场方向,第二视场方向为水平视场方向的场景下,在第一光学元件与第二光学元件按照相同的转速和方向进行旋转时,探测装置在第二视场方向上的扫描范围可以如图3所示,即探测装置进行360°水平方向的扫描。Exemplarily, in a scenario where the first field of view direction is the vertical field of view direction and the second field of view direction is the horizontal field of view direction, when the first optical element and the second optical element rotate at the same speed and direction, The scanning range of the detection device in the direction of the second field of view may be as shown in FIG. 3 , that is, the detection device scans in a 360° horizontal direction.
示例性的,获取第一模式切换指令,其中,第一模式切换指令用于指示探测装置将扫描模式切换为第一扫描模式;将第一模式切换指令中的相位差确定为第一光学元件与第二光学元件之间的目标相位差;或者,当获取到第一模式切换指令时,将第一光学元件与第二光学元件之间的当前相位差确定为目标相位差;根据目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置处于第一扫描模式。通过第一模式切换指令,可以快速地将探测装置的扫描模式切换为第一扫描模式,以实现探测装置在目标相位差对应的视场位置进行扫描。Exemplarily, the first mode switching instruction is obtained, wherein the first mode switching instruction is used to instruct the detection device to switch the scanning mode to the first scanning mode; the phase difference in the first mode switching instruction is determined as the first optical element and The target phase difference between the second optical elements; or, when the first mode switching instruction is obtained, determining the current phase difference between the first optical element and the second optical element as the target phase difference; according to the target phase difference, The motion parameters of the first optical element and/or the motion parameters of the second optical element are adjusted so that the detection device is in the first scanning mode. Through the first mode switching instruction, the scanning mode of the detection device can be quickly switched to the first scanning mode, so that the detection device scans at the position of the field of view corresponding to the target phase difference.
例如,在第一光学元件和第二光学元件的转速和旋转方向相同的情况下,在获取到第一模式切换指令时,若第一模式切换指令未携带有相位差信息,则可以将第一光学元件与第二光学元件之间的当前相位差确定为目标相位差,此时可以不需要调整第一光学元件的运动参数和第二光学元件的运动参数,即可实现探测装置在第一视场方向上的目标相位差对应的视场位置进行扫描。For example, in the case that the rotational speed and rotation direction of the first optical element and the second optical element are the same, when the first mode switching instruction is acquired, if the first mode switching instruction does not carry phase difference information, the first The current phase difference between the optical element and the second optical element is determined as the target phase difference. At this time, it is not necessary to adjust the motion parameters of the first optical element and the motion parameters of the second optical element. The field of view position corresponding to the target phase difference in the field direction is scanned.
又例如,若第一模式切换指令携带有相位差信息,则可以将第一模式切换指令中的相位差确定为第一光学元件与第二光学元件之间的目标相位差,此时通过调整第一光学元件的运动参数和/或第二光学元件的运动参数,可以实现探测装置在第一视场方向上的目标相位差对应的视场位置进行扫描。For another example, if the first mode switching instruction carries phase difference information, then the phase difference in the first mode switching instruction can be determined as the target phase difference between the first optical element and the second optical element. The motion parameters of the first optical element and/or the motion parameters of the second optical element can enable the detection device to scan at the position of the field of view corresponding to the target phase difference in the direction of the first field of view.
再例如,在第一光学元件和第二光学元件的转速和旋转方向不同的情况下,在获取到第一模式切换指令时,若第一模式切换指令未携带有相位差信息,则可以将第一光学元件与第二光学元件之间的当前相位差确定为目标相位差,若第一模式切换指令携带有相位差信息,则可以将第一模式切换指令中的相位差确定为第一光学元件与第二光学元件之间的目标相位差,此时通过调整第一光 学元件的运动参数和/或第二光学元件的运动参数,可以实现探测装置在第一视场方向上的目标相位差对应的视场位置进行扫描。For another example, in the case that the rotational speed and rotation direction of the first optical element and the second optical element are different, when the first mode switching command is obtained, if the first mode switching command does not carry phase difference information, the second The current phase difference between an optical element and the second optical element is determined as the target phase difference. If the first mode switching command carries phase difference information, the phase difference in the first mode switching command can be determined as the target phase difference. The target phase difference between the second optical element, at this time, by adjusting the motion parameters of the first optical element and/or the motion parameters of the second optical element, the target phase difference correspondence of the detection device in the first field of view direction can be realized The position of the field of view is scanned.
示例性的,根据目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置处于第一扫描模式的方式可以为:调整第一光学元件的运动参数和/或第二光学元件的运动参数;在第一光学元件与第二光学元件之间的相位差达到目标相位差时,控制第一光学元件按照第二光学元件的当前运动参数进行旋转,或者,控制第二光学元件按照第一光学元件的当前运动参数进行旋转,使得第一光学元件和第二光学元件按照相同的转速和方向进行旋转。Exemplarily, according to the target phase difference, adjusting the motion parameters of the first optical element and/or the motion parameters of the second optical element so that the detection device is in the first scanning mode may be as follows: adjusting the motion parameters of the first optical element And/or the motion parameter of the second optical element; when the phase difference between the first optical element and the second optical element reaches the target phase difference, control the first optical element to rotate according to the current motion parameter of the second optical element, or , controlling the second optical element to rotate according to the current motion parameters of the first optical element, so that the first optical element and the second optical element rotate according to the same rotational speed and direction.
示例性的,根据目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置处于第一扫描模式的方式可以为:控制第一光学元件和第二光学元件停止旋转,之后调整第一光学元件与第二光学元件之间的相位差;在第一光学元件与第二光学元件之间的相位差达到目标相位差时,控制第一光学元件和第二光学元件按照预设转速和预设方向保持目标相位差进行旋转。Exemplarily, according to the target phase difference, the way to adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element so that the detection device is in the first scanning mode may be: control the first optical element and the second optical element The optical element stops rotating, and then adjusts the phase difference between the first optical element and the second optical element; when the phase difference between the first optical element and the second optical element reaches the target phase difference, control the first optical element and the second optical element The second optical element rotates according to a preset rotation speed and a preset direction while maintaining a target phase difference.
在一实施例中,如图4所示,步骤S102具体包括:子步骤S1021至S1022。In an embodiment, as shown in FIG. 4 , step S102 specifically includes: sub-steps S1021 to S1022.
子步骤S1021、获取第一光学元件与第二光学元件之间的目标转速差;Sub-step S1021, acquiring the target rotational speed difference between the first optical element and the second optical element;
子步骤S1022、根据目标相位差和目标转速差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置处于第二扫描模式。Sub-step S1022 , adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element according to the target phase difference and the target rotational speed difference, so that the detection device is in the second scanning mode.
其中,在第二扫描模式下,第一光学元件与第二光学元件之间的相位差以目标相位差为起点进行周期性变化,使得探测装置在第一视场方向上的视场区域进行扫描。Wherein, in the second scanning mode, the phase difference between the first optical element and the second optical element changes periodically starting from the target phase difference, so that the detection device scans the field of view area in the first field of view direction .
在一实施例中,根据目标相位差,调整第一光学元件的运动参数和/或第二光学元件的运动参数;在第一光学元件和第二光学元件按照相同的转速和方向旋转,且第一光学元件与第二光学元件之间的相位差达到目标相位差时,根据目标转速差,控制第一光学元件与第二光学元件之间的相位差以目标相位差为起点进行周期性变化,使得探测装置在第一视场方向上的对应视场区域进行扫描。通过上述方案,可以实现探测装置在第一视场方向上的任意视场区域的扫描,极大地提高了探测装置的应用范围。In one embodiment, the motion parameters of the first optical element and/or the motion parameters of the second optical element are adjusted according to the target phase difference; when the first optical element and the second optical element rotate at the same speed and direction, and the second optical element When the phase difference between the first optical element and the second optical element reaches the target phase difference, according to the target rotational speed difference, the phase difference between the first optical element and the second optical element is controlled to change periodically starting from the target phase difference, The detection device is made to scan the corresponding field of view area in the first field of view direction. Through the above solution, the scanning of any field of view area of the detection device in the first field of view direction can be realized, which greatly improves the application range of the detection device.
示例性的,根据目标转速差,控制第一光学元件与第二光学元件之间的相位差以目标相位差为起点进行周期性变化的方式可以为:根据目标转速差和目标相位差,确定相位差变化范围,其中,相位差变化范围以目标相位差为起点; 控制第一光学元件的运动参数和/或第二光学元件的运动参数进行周期性变化,以使相位差按照相位差变化范围进行周期性变化。其中,探测装置在第一视场方向上的相位差变化范围对应的视场区域内进行扫描。通过确定相位差变化范围,可以更好地精确控制两个光学元件之间的相位差以目标相位差为起点进行周期性变化,从而精确地实现探测装置在第一视场方向上的对应视场区域的扫描,提高探测装置的可靠性。Exemplarily, according to the target rotational speed difference, the manner of controlling the phase difference between the first optical element and the second optical element to change periodically starting from the target phase difference may be: according to the target rotational speed difference and the target phase difference, determine the phase Difference change range, wherein, the phase difference change range starts from the target phase difference; control the motion parameters of the first optical element and/or the motion parameters of the second optical element to change periodically, so that the phase difference is carried out according to the phase difference change range Periodic changes. Wherein, the detection device scans in the viewing field area corresponding to the phase difference variation range in the first viewing field direction. By determining the variation range of the phase difference, the phase difference between the two optical elements can be better and precisely controlled to change periodically starting from the target phase difference, so as to accurately realize the corresponding field of view of the detection device in the direction of the first field of view The scanning of the area improves the reliability of the detection device.
示例性的,控制第一光学元件的运动参数和/或第二光学元件的运动参数进行周期性变化,以使相位差按照相位差变化范围进行周期性变化的方式可以为:获取同步转速,其中,第一光学元件和第二光学元件按照同步转速进行旋转时,第一光学元件与第二光学元件之间的相位差与目标相位差相同;控制第一光学元件的转速和/或第二光学元件的转速以同步转速为中心进行周期性变化,以使第一光学元件与第二光学元件之间的相位差按照相位差变化范围进行周期性变化。通过控制第一光学元件和/或第二光学元件的转速以同步转速为中心进行周期性变化,可以精确地控制相位差按照相位差变化范围进行周期性变化,从而精确地实现探测装置在第一视场方向上的对应视场区域的扫描,提高探测装置的可靠性。Exemplarily, the method of controlling the motion parameters of the first optical element and/or the motion parameters of the second optical element to change periodically so that the phase difference changes periodically according to the phase difference variation range may be as follows: obtaining a synchronous rotational speed, wherein , when the first optical element and the second optical element rotate at a synchronous rotational speed, the phase difference between the first optical element and the second optical element is the same as the target phase difference; control the rotational speed of the first optical element and/or the second optical The rotational speed of the element changes periodically around the synchronous rotational speed, so that the phase difference between the first optical element and the second optical element changes periodically according to the phase difference variation range. By controlling the rotation speed of the first optical element and/or the second optical element to change periodically around the synchronous rotation speed, the phase difference can be precisely controlled to change periodically according to the range of the phase difference, so that the detection device can be accurately realized at the first The scanning of the corresponding field of view area in the field of view direction improves the reliability of the detection device.
其中,该运动参数包括转速,第一光学元件的转速和/或第二光学元件的转速进行周期性变化的波形包括以下之一:正弦波、余弦波、梯形波、三角波。Wherein, the motion parameter includes a rotational speed, and the waveform in which the rotational speed of the first optical element and/or the rotational speed of the second optical element changes periodically includes one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
示例性的,控制第一光学元件的转速和/或第二光学元件的转速以同步转速为中心进行周期性变化可以包括:控制第一光学元件的转速以同步转速为中心进行周期性变化,并控制第二光学元件按照第一光学元件的旋转方向和该同步转速进行匀速旋转;或者,控制第二光学元件的转速以同步转速为中心进行周期性变化,并控制第一光学元件按照第二光学元件的旋转方向和该同步转速进行匀速旋转,或者,控制第一光学元件的转速以同步转速为中心进行周期性变化,并控制第二光学元件的转速以同步转速为中心进行周期性变化。Exemplarily, controlling the rotational speed of the first optical element and/or the rotational speed of the second optical element to periodically change around the synchronous rotational speed may include: controlling the rotational speed of the first optical element to periodically change around the synchronous rotational speed, and Control the second optical element to rotate at a constant speed according to the rotation direction of the first optical element and the synchronous rotational speed; or control the rotational speed of the second optical element to periodically change around the synchronous rotational speed, and control the first optical element to follow the second optical The rotation direction of the element and the synchronous rotational speed rotate at a constant speed, or the rotational speed of the first optical element is controlled to periodically change around the synchronous rotational speed, and the rotational speed of the second optical element is controlled to periodically vary around the synchronous rotational speed.
示例性的,根据目标转速差和目标相位差,确定相位差变化范围的方式可以为:获取探测装置的点云帧率,并根据点云帧率确定一个周期的持续时长;根据持续时长和目标转速差,确定第一相位差;根据第一相位差和目标相位差,确定相位差变化范围。Exemplarily, according to the target rotational speed difference and the target phase difference, the way to determine the range of phase difference variation can be: obtain the point cloud frame rate of the detection device, and determine the duration of a cycle according to the point cloud frame rate; according to the duration and the target The rotation speed difference is to determine the first phase difference; and to determine the variation range of the phase difference according to the first phase difference and the target phase difference.
以探测装置在第一视场方向上的扫描范围为FOV vertical,第二光学元件的反射角为45°,探测装置的点云帧率为f,周期T为1/f,第一光学元件与第二光学元件在0相位时对应探测装置在第一视场方向上的扫描范围的上边缘(即﹢ 22.5°)例,当目标相位差为Δθ,且目标转速差为ΔV时,探测装置在第一视场方向上的目标相位差Δθ对应的视场位置的扫描范围为: Taking the scanning range of the detection device in the direction of the first field of view as FOV vertical , the reflection angle of the second optical element as 45°, the frame rate of the point cloud of the detection device as f, and the period T as 1/f, the first optical element and The second optical element corresponds to the upper edge of the scanning range of the detection device in the direction of the first field of view (i.e. + 22.5°) at 0 phase. For example, when the target phase difference is Δθ, and the target rotational speed difference is ΔV, the detection device is at The scanning range of the field of view position corresponding to the target phase difference Δθ in the first field of view direction is:
Figure PCTCN2021116540-appb-000002
Figure PCTCN2021116540-appb-000002
而探测装置在第一视场方向上的对应视场区域的扫描范围可以为:The scanning range of the corresponding field of view area of the detection device in the first field of view direction can be:
Figure PCTCN2021116540-appb-000003
Figure PCTCN2021116540-appb-000003
其中,Δθ max为第一相位差,且
Figure PCTCN2021116540-appb-000004
Among them, Δθ max is the first phase difference, and
Figure PCTCN2021116540-appb-000004
例如,以点云帧率为10Hz,第一视差方向为垂直视场方向,第二视场方向为水平视场方向,垂直视场的扫描范围为45度、目标相位差Δθ=π/2、目标转速差ΔV的变速范围为300rpm,且呈正弦变化,周期为0.1s为例,探测装置输出的点云分布图可以如图5所示,探测装置在垂直视场方向上的目标相位差Δθ=π/2对应的视场位置为0°,探测装置在垂直视场方向上的对应视场区域的扫描范围为18.9°。For example, if the point cloud frame rate is 10Hz, the first parallax direction is the vertical field of view direction, the second field of view direction is the horizontal field of view direction, the scanning range of the vertical field of view is 45 degrees, and the target phase difference Δθ=π/2, The variable range of the target speed difference ΔV is 300rpm, and it changes sinusoidally, with a period of 0.1s as an example. The point cloud distribution map output by the detection device can be shown in Figure 5. The target phase difference Δθ of the detection device in the direction of the vertical field of view The position of the field of view corresponding to =π/2 is 0°, and the scanning range of the corresponding field of view area of the detection device in the direction of the vertical field of view is 18.9°.
其中,第一光学元件与第二光学元件之间的相位差按照相位差变化范围进行周期性变化对应的波形可以包括以下之一:正弦波、余弦波、梯形波、三角波。例如,第一光学元件与第二光学元件之间的相位差按照相位差变化范围进行周期性变化对应的波形可以如图6所示,该波形为三角波,在一个周期T内,第一光学元件与第二光学元件之间的相位差以目标相位差Δθ为起点向第一相位差Δθ max进行增加,在达到第一相位差Δθ max后,再由第一相位差Δθ max向目标相位差Δθ进行减少,直至回到目标相位差Δθ。 Wherein, the phase difference between the first optical element and the second optical element changes periodically according to the phase difference variation range, and the corresponding waveform may include one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave. For example, the phase difference between the first optical element and the second optical element changes periodically according to the range of the phase difference. The corresponding waveform can be shown in Figure 6. The waveform is a triangle wave. The phase difference with the second optical element starts from the target phase difference Δθ to the first phase difference Δθ max , and after reaching the first phase difference Δθ max , it then moves from the first phase difference Δθ max to the target phase difference Δθ Decrease until returning to the target phase difference Δθ.
示例性的,根据第一相位差和目标相位差,确定相位差变化范围的方式可以为:根据第一相位差和目标相位差,确定第二相位差,其中,目标相位差为第一相位差与第二相位差之间的中点处的相位差;根据第一相位差、第二相位差和目标相位差,确定相位差变化范围。Exemplarily, according to the first phase difference and the target phase difference, the manner of determining the variation range of the phase difference may be: according to the first phase difference and the target phase difference, determining the second phase difference, wherein the target phase difference is the first phase difference The phase difference at the midpoint between the second phase difference and the phase difference change range is determined according to the first phase difference, the second phase difference and the target phase difference.
例如,第一光学元件与第二光学元件之间的相位差按照相位差变化范围进行周期性变化对应的波形可以如图7所示,该波形为正弦波,在一个周期T内第一光学元件与第二光学元件之间的相位差以目标相位差Δθ为起点向第一相位差Δθ max进行增加,在达到第一相位差Δθ max后,再由第一相位差Δθ max向目标相位差Δθ进行减少,直至回到目标相位差Δθ,然后由目标相位差Δθ继续向第二相位差Δθ 1进行减少,在达到第二相位差Δθ 1后,再由第二相位差Δθ 1向目标相位差Δθ进行增加,直至回到目标相位差Δθ。 For example, the phase difference between the first optical element and the second optical element changes periodically according to the range of the phase difference. The corresponding waveform can be shown in Figure 7. The waveform is a sine wave. The phase difference with the second optical element starts from the target phase difference Δθ to the first phase difference Δθ max , and after reaching the first phase difference Δθ max , it then moves from the first phase difference Δθ max to the target phase difference Δθ Decrease until it returns to the target phase difference Δθ, then continue to decrease from the target phase difference Δθ to the second phase difference Δθ 1 , and then go from the second phase difference Δθ 1 to the target phase difference after reaching the second phase difference Δθ 1 Δθ is increased until returning to the target phase difference Δθ.
在一实施例中,获取第二模式切换指令,其中,第二模式切换指令用于指 示探测装置将扫描模式切换为第二扫描模式;将第二模式切换指令中的转速差确定为目标转速差,并将第一光学元件与第二光学元件之间的当前相位差确定为目标相位差;根据目标转速差和目标相位差,控制第一光学元件与第二光学元件之间的相位差以目标相位差为起点进行周期性变化。通过获取第二模式切换指令,可以快速地将探测装置的扫描模式切换为第二扫描模式。In one embodiment, the second mode switching instruction is obtained, wherein the second mode switching instruction is used to instruct the detection device to switch the scanning mode to the second scanning mode; the rotational speed difference in the second mode switching instruction is determined as the target rotational speed difference , and determine the current phase difference between the first optical element and the second optical element as the target phase difference; according to the target rotational speed difference and the target phase difference, control the phase difference between the first optical element and the second optical element to the target The phase difference is periodically changed as the starting point. By acquiring the second mode switching instruction, the scanning mode of the detection device can be quickly switched to the second scanning mode.
示例性的,在获取到第二模式切换指令时,若探测装置处于第一扫描模式,且第二模式切换指令中未携带有相位差信息,则将第一光学元件与第二光学元件之间的当前相位差确定为目标相位差,并根据第二模式切换指令中的目标转速差,控制第一光学元件的运动参数和/或第二光学元件的运动参数进行周期性变化,以使相位差按照相位差变化范围进行周期性变化,使得探测装置处于第二扫描模式。Exemplarily, when the second mode switching command is obtained, if the detection device is in the first scanning mode and the phase difference information is not carried in the second mode switching command, the distance between the first optical element and the second optical element is The current phase difference is determined as the target phase difference, and according to the target speed difference in the second mode switching command, the motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference The periodic change is performed according to the change range of the phase difference, so that the detection device is in the second scanning mode.
在一实施例中,获取第二模式切换指令,其中,第二模式切换指令用于指示探测装置将扫描模式切换为第二扫描模式;将第二模式切换指令中的转速差确定为目标转速差,并将第二模式切换指令中的相位差确定为目标相位差;根据目标相位差和目标转速差,调整第一光学元件的运动参数和/或第二光学元件的运动参数,以使探测装置处于第二扫描模式。通过获取第二模式切换指令,可以快速地将探测装置的扫描模式切换为第二扫描模式。In one embodiment, the second mode switching instruction is obtained, wherein the second mode switching instruction is used to instruct the detection device to switch the scanning mode to the second scanning mode; the rotational speed difference in the second mode switching instruction is determined as the target rotational speed difference , and determine the phase difference in the second mode switching instruction as the target phase difference; according to the target phase difference and the target rotational speed difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the detection device In second scan mode. By acquiring the second mode switching instruction, the scanning mode of the detection device can be quickly switched to the second scanning mode.
示例性的,在获取到第二模式切换指令时,若探测装置处于第一扫描模式,且第二模式切换指令中携带有相位差信息,则将第一光学元件与第二光学元件之间的当前相位差确定为目标相位差,并根据第二模式切换指令中的目标转速差,控制第一光学元件的运动参数和/或第二光学元件的运动参数进行周期性变化,以使相位差按照相位差变化范围进行周期性变化,使得探测装置处于第二扫描模式。Exemplarily, when the second mode switching instruction is obtained, if the detection device is in the first scanning mode, and the second mode switching instruction carries phase difference information, the phase difference between the first optical element and the second optical element The current phase difference is determined as the target phase difference, and according to the target rotational speed difference in the second mode switching command, the motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference follows The changing range of the phase difference changes periodically, so that the detecting device is in the second scanning mode.
本申请的发明人发现目前的探测装置主要有两种实现方式,方式一是多组发射器及接收器作为一个整体进行旋转来实现扫描,方式二是多组发射器和接收器固定,配合扫描模组的旋转来实现扫描。前者的发射器和接收器的数量往往比后者多很多,主流产品能够达到数十上百个,成本高昂。后者相比前者生产装配复杂性大大降低,成本优势明显,在数个发射器和接收器搭配扫描模组的条件下就可以实现前者数十上百个发射器和接收器的点云效果。但需要扫描模组中的光学元件进行高速旋转,光学元件进行高速旋转会带来震动噪声,会影响探测装置的可靠性,此外,高速旋转也会产生较高的功耗,影响探测装置的使用寿命,而如果降低光学元件的转速,会使得探测装置采集到的点云分布 出现中间稀两边密的问题,探测装置的探测效果不好。The inventors of the present application found that there are mainly two ways to implement the current detection device. The first way is that multiple sets of transmitters and receivers are rotated as a whole to realize scanning. The second way is that multiple sets of transmitters and receivers are fixed and cooperate with scanning. The rotation of the module realizes the scanning. The number of transmitters and receivers of the former is often much larger than that of the latter, and mainstream products can reach tens or hundreds, which is expensive. Compared with the former, the production and assembly complexity of the latter is greatly reduced, and the cost advantage is obvious. Under the condition of several transmitters and receivers with scanning modules, the point cloud effect of dozens or hundreds of transmitters and receivers of the former can be realized. However, the optical components in the scanning module need to be rotated at high speed. The high-speed rotation of the optical components will cause vibration and noise, which will affect the reliability of the detection device. In addition, high-speed rotation will also generate high power consumption, which will affect the use of the detection device. However, if the rotational speed of the optical element is reduced, the distribution of the point cloud collected by the detection device will be sparse in the middle and dense in the two sides, and the detection effect of the detection device will not be good.
为解决上述问题,本申请的发明人给探测装置设有第三扫描模式,在第三扫描模式下,第一光学元件的转速以第一转速为中心呈周期性变化和/或第二光学元件的转速以第二转速为中心呈周期性变化,第一转速和第二转速小于预设转速阈值,预设转速阈值可以基于实际情况进行设置,在此不做具体限定。通过控制第一光学元件的转速以第一转速为中心呈周期性变化和/或第二光学元件的转速以第二转速为中心呈周期性变化,可以解决降低光学元件的转速导致的探测装置采集到的点云分布出现中间稀两边密的问题,保证点云分布的均衡性和点云密度。In order to solve the above problems, the inventors of the present application provided the detection device with a third scanning mode. In the third scanning mode, the rotational speed of the first optical element changes periodically around the first rotational speed and/or the second optical element The rotating speed of the rotating speed changes periodically around the second rotating speed as the center, and the first rotating speed and the second rotating speed are smaller than the preset rotating speed threshold, and the preset rotating speed threshold can be set based on actual conditions, and is not specifically limited here. By controlling the rotational speed of the first optical element to periodically change around the first rotational speed and/or the rotational speed of the second optical element to periodically change around the second rotational speed, the acquisition of the detection device caused by reducing the rotational speed of the optical element can be solved. The obtained point cloud distribution has the problem of being sparse in the middle and dense on both sides, so as to ensure the balance of point cloud distribution and point cloud density.
例如,图8为第一光学元件和第二光学元件均以大于或等于13000rpm的转速v 1进行旋转,且发射器和接收器数目为4时的点云分布图,如图8所示,点云分布较为均匀,图9为第一光学元件和第二光学元件的转速下降70%,以转速v 2进行旋转,且发射器和接收器数目为4时的点云分布图,如图9所示,点云分布出现中间稀两边密的问题。图10是采取第二光学元件以转速v 2进行匀速旋转,第一光学元件以转速v 3为中心呈周期性变化,且发射器和接收器数目为4时的点云效果图,如图10所示,点云分布均匀密集,与图8所示的点云分布图非常相近。 For example, Fig. 8 is a point cloud distribution diagram when both the first optical element and the second optical element rotate at a speed v1 greater than or equal to 13000rpm, and the number of transmitters and receivers is 4, as shown in Fig. 8, the points The cloud distribution is relatively uniform. Figure 9 shows the point cloud distribution diagram when the first optical element and the second optical element rotate at a rotational speed of v2 , and the number of emitters and receivers is 4, as shown in Figure 9. It shows that the point cloud distribution has a problem of being sparse in the middle and dense on both sides. Figure 10 is the point cloud effect diagram when the second optical element rotates at a constant speed of speed v2 , the first optical element changes periodically around the speed v3 , and the number of transmitters and receivers is 4, as shown in Figure 10 As shown, the point cloud distribution is uniform and dense, which is very similar to the point cloud distribution diagram shown in Figure 8.
在一实施例中,获取第三模式切换指令,并根据第三模式切换指令,控制探测装置处于第三扫描模式。其中,在第三扫描模式下,第一光学元件的转速以第一转速为中心呈周期性变化和/或第二光学元件的转速以第二转速为中心呈周期性变化,第一转速和第二转速小于预设转速阈值,预设转速阈值可以基于实际情况进行设置,在此不做具体限定。In an embodiment, the third mode switching instruction is obtained, and according to the third mode switching instruction, the detection device is controlled to be in the third scanning mode. Wherein, in the third scanning mode, the rotational speed of the first optical element changes periodically around the first rotational speed and/or the rotational speed of the second optical element changes periodically around the second rotational speed, the first rotational speed and the second rotational speed The second rotational speed is less than the preset rotational speed threshold, and the preset rotational speed threshold can be set based on actual conditions, and is not specifically limited here.
示例性的,在第三扫描模式下,第一转速、第一光学元件的第一旋转角度、第二转速和第二光学元件的第二旋转角度满足预设约束条件,在满足预设约束条件的情况下,探测装置在各帧的扫描图案一致,预设约束条件可以基于实际情况进行设置,在此不做具体限定。例如,预设约束条件为:Exemplarily, in the third scanning mode, the first rotation speed, the first rotation angle of the first optical element, the second rotation speed and the second rotation angle of the second optical element satisfy the preset constraint condition, and when the preset constraint condition is satisfied In the case of , the scanning patterns of the detection device in each frame are consistent, and the preset constraints can be set based on actual conditions, which are not specifically limited here. For example, the preset constraints are:
V 1=M 1*N*60 V 1 =M 1 *N*60
V 2=M 2*N*60 V 2 =M 2 *N*60
M 1-M 2=±n M 1 -M 2 =±n
θ 1=M 1*2π θ 1 =M 1 *2π
θ 2=M 2*2π θ 2 =M 2 *2π
其中,N为探测装置的帧频,M 1、M 2和n为整数,可选的,n为1,V 1为 第一转速,V 2为第二转速,θ 1为第一旋转角度,θ 2为第二旋转角度。 Wherein, N is the frame rate of the detection device, M 1 , M 2 and n are integers, optional, n is 1, V 1 is the first rotation speed, V 2 is the second rotation speed, θ 1 is the first rotation angle, θ 2 is the second rotation angle.
示例性的,控制探测装置处于第三扫描模式的方式可以包括:控制第一光学元件以第一转速匀速旋转,并控制第二光学元件的转速以第二转速为中心进行周期性变化;或者控制第二光学元件以第二转速匀速旋转,并控制第一光学元件的转速以第一转速为中心进行周期性变化;或者控制第一光学元件的转速以第一转速为中心进行周期性变化,并控制第二光学元件的转速以第二转速为中心进行周期性变化。其中,转速进行周期性变化的波形可以包括以下之一:正弦波、余弦波、梯形波、三角波。Exemplarily, the manner of controlling the detection device to be in the third scanning mode may include: controlling the first optical element to rotate at a first rotational speed at a constant speed, and controlling the rotational speed of the second optical element to periodically change around the second rotational speed; or controlling The second optical element rotates at a constant speed at the second rotational speed, and controls the rotational speed of the first optical element to periodically change around the first rotational speed; or controls the rotational speed of the first optical element to periodically change around the first rotational speed, and The rotational speed of the second optical element is controlled to change periodically around the second rotational speed. Wherein, the waveform in which the rotating speed changes periodically may include one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
示例性的,控制第一光学元件的转速的方式可以包括:获取第一光学元件的转速的反馈控制参数;根据第一光学元件的转速的反馈控制参数,对第一光学元件的转速进行反馈控制。其中,第一光学元件的转速的反馈控制参数包括第一光学元件与第二光学元件之间的期望相位差、第一光学元件的当前旋转角度、第一光学元件的当前转速以及第二光学元件的第二旋转角度。通过第一光学元件的转速的反馈控制参数对第一光学元件的转速进行反馈控制,可以精确地控制第一光学元件的转速以第一转速为中心进行周期性变化。Exemplarily, the manner of controlling the rotational speed of the first optical element may include: acquiring a feedback control parameter of the rotational speed of the first optical element; performing feedback control on the rotational speed of the first optical element according to the feedback control parameter of the rotational speed of the first optical element . Wherein, the feedback control parameters of the rotational speed of the first optical element include the expected phase difference between the first optical element and the second optical element, the current rotation angle of the first optical element, the current rotational speed of the first optical element, and the the second rotation angle. By performing feedback control on the rotational speed of the first optical element through the feedback control parameter of the rotational speed of the first optical element, the rotational speed of the first optical element can be precisely controlled to change periodically around the first rotational speed.
示例性的,获取第一光学元件与所述第二光学元件之间的期望相位差、第一光学元件的当前旋转角度、第一光学元件的当前转速以及第二光学元件的第二旋转角度。其中,期望相位差的获取方式可以包括:获取第一光学元件在当前周期内的当前反馈控制时刻;根据当前反馈控制时刻和预设的相位差与反馈控制时刻之间的映射关系,确定第一光学元件与所述第二光学元件之间的期望相位差。Exemplarily, the expected phase difference between the first optical element and the second optical element, the current rotation angle of the first optical element, the current rotational speed of the first optical element, and the second rotation angle of the second optical element are acquired. Wherein, the way of acquiring the expected phase difference may include: acquiring the current feedback control moment of the first optical element in the current period; determining the first A desired phase difference between the optical element and the second optical element.
示例性的,预设的相位差与反馈控制时刻之间的映射关系是根据探测装置在第一视场方向的最大扫描范围、发射器数量、发射夹角、点云帧率、第一转速和第二转速确定的,相位差与反馈控制时刻之间的映射关系可以基于实际情况进行设置,本实施例对此不做具体限定。例如,相位差与反馈控制时刻之间的映射关系可以如图11所示的曲线进行表示,图11所示的曲线表示:在第一视差方向的边缘视场扫描速度慢的时候加快速度,在视场中心扫描速度快的时候降低速度,从而可以实现点云的均匀排布。Exemplarily, the mapping relationship between the preset phase difference and the feedback control moment is based on the maximum scanning range of the detection device in the direction of the first field of view, the number of emitters, the included angle of emission, the point cloud frame rate, the first rotational speed and The second rotation speed is determined, and the mapping relationship between the phase difference and the feedback control time can be set based on actual conditions, which is not specifically limited in this embodiment. For example, the mapping relationship between the phase difference and the feedback control moment can be represented by a curve as shown in FIG. 11. The curve shown in FIG. When the scanning speed in the center of the field of view is fast, the speed is reduced, so that the uniform arrangement of the point cloud can be achieved.
示例性的,根据第一光学元件的反馈控制参数,对所述第一光学元件的转速进行反馈控制的方式可以包括:根据第二旋转角度,确定第一光学元件的参考转速;根据第二旋转角度和期望相位差,确定第一光学元件的参考旋转角度;根据当前旋转角度和参考旋转角度,确定第一光学元件的补偿参考转速;根据 参考转速、补偿参考转速和第一光学元件的当前转速,对第一光学元件的当前转速进行反馈控制。需要注意的是,可以示例性地给出根据第二旋转角度,确定第一光学元件的参考转速的方法,即根据第二旋转角度可以得到对应的当前参考时刻,根据当前参考时刻和第一光学元件的转速、时间映射关系可以确定第一光学元件的参考转速。Exemplarily, according to the feedback control parameters of the first optical element, the way of feedback controlling the rotational speed of the first optical element may include: determining the reference rotational speed of the first optical element according to the second rotation angle; Angle and expected phase difference, determine the reference rotation angle of the first optical element; determine the compensation reference rotation speed of the first optical element according to the current rotation angle and the reference rotation angle; according to the reference rotation speed, the compensation reference rotation speed and the current rotation speed of the first optical element , to perform feedback control on the current rotational speed of the first optical element. It should be noted that the method of determining the reference rotation speed of the first optical element according to the second rotation angle can be exemplarily given, that is, the corresponding current reference moment can be obtained according to the second rotation angle, and according to the current reference moment and the first optical element The rotational speed of the element and the time mapping relationship can determine the reference rotational speed of the first optical element.
可以理解的是,控制第二光学元件以第二转速为中心进行周期性变化的方式可以参考上述控制第一光学元件以第一转速为中心进行周期性变化的具体过程,此处不再赘述。It can be understood that, the manner of controlling the second optical element to periodically change around the second rotational speed may refer to the specific process of controlling the first optical element to periodically change around the first rotational speed, which will not be repeated here.
在一实施例中,探测装置在启动后,可以默认进入第三扫描模式。例如,探测装置在启动后,自动触发第三模式切换指令,并根据第三模式切换指令,控制探测装置进入第三扫描模式。当然,也可以默认进入第一扫描模式或第二扫描模式,本实施例对此不做具体限定。通过默认进入第三扫描模式,可以保证探测装置输出的点云分布图的均衡性和点云密度,也可以降低探测装置的功耗,提高探测装置的使用寿命。In an embodiment, after the detection device is started, it may enter the third scanning mode by default. For example, after the detection device is started, it automatically triggers the third mode switching instruction, and controls the detection device to enter the third scanning mode according to the third mode switching instruction. Of course, the first scanning mode or the second scanning mode may also be entered by default, which is not specifically limited in this embodiment. By entering the third scanning mode by default, the balance and point cloud density of the point cloud distribution map output by the detection device can be guaranteed, the power consumption of the detection device can also be reduced, and the service life of the detection device can be improved.
请参阅图12,图12是本申请实施例提供的一种探测装置的结构示意性框图。Please refer to FIG. 12 . FIG. 12 is a schematic block diagram of a detection device provided by an embodiment of the present application.
如图12所示,探测装置200包括扫描模组210、存储器220和一个或多个处理器230,扫描模组210、存储器220和一个或多个处理器230通过总线240连接,该总线240比如为I2C(Inter-integrated Circuit)总线。As shown in FIG. 12 , the detection device 200 includes a scanning module 210, a memory 220 and one or more processors 230, and the scanning module 210, the memory 220 and one or more processors 230 are connected through a bus 240, and the bus 240 is, for example, It is the I2C (Inter-integrated Circuit) bus.
具体地,扫描模组200,设于光源发射出的光脉冲序列的光路上,所述扫描模组200包括第一光学元件和第二光学元件,所述第一光学元件和所述第二光学元件用于改变所述光脉冲序列的传播方向,以使所述探测装置200按照第一视场方向和/或第二视场方向进行扫描。Specifically, the scanning module 200 is arranged on the optical path of the light pulse sequence emitted by the light source, the scanning module 200 includes a first optical element and a second optical element, the first optical element and the second optical The element is used to change the propagation direction of the light pulse sequence, so that the detection device 200 scans according to the first field of view direction and/or the second field of view direction.
具体地,存储器220可以是Flash芯片、只读存储器(ROM,Read-Only Memory)磁盘、光盘、U盘或移动硬盘等,存储器220用于存储计算机程序。Specifically, the memory 220 can be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk or a mobile hard disk, etc., and the memory 220 is used to store computer programs.
具体地,处理器230可以是微控制单元(Micro-controller Unit,MCU)、中央处理单元(Central Processing Unit,CPU)或数字信号处理器(Digital Signal Processor,DSP)等。Specifically, the processor 230 may be a micro-controller unit (Micro-controller Unit, MCU), a central processing unit (Central Processing Unit, CPU), or a digital signal processor (Digital Signal Processor, DSP), etc.
其中,一个或多个处理器230,单独地或共同地工作,用于执行所述计算机程序并在执行所述计算机程序时实现以下步骤:Wherein, one or more processors 230 work individually or jointly to execute the computer program and implement the following steps when executing the computer program:
获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差;Acquiring the target phase difference between the first optical element and the second optical element of the scanning module in the detection device;
根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置在第一视场方向上的对应视场位置或视场区域进行扫描。According to the target phase difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
可选的,所述处理器在实现根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数时,用于实现:Optionally, when the processor adjusts the motion parameter of the first optical element and/or the motion parameter of the second optical element according to the target phase difference, it is configured to:
根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置处于第一扫描模式;adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference, so that the detection device is in a first scanning mode;
其中,在所述第一扫描模式下,所述第一光学元件和所述第二光学元件按照相同的转速和方向保持所述目标相位差进行旋转,使得所述探测装置在第一视场方向上的所述目标相位差对应的视场位置进行扫描。Wherein, in the first scanning mode, the first optical element and the second optical element rotate according to the same rotation speed and direction while maintaining the target phase difference, so that the detection device rotates in the direction of the first field of view The position of the field of view corresponding to the phase difference of the target is scanned.
可选的,所述处理器在实现获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差时,用于实现:Optionally, when obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device, the processor is used to:
获取第一模式切换指令,其中,所述第一模式切换指令用于指示所述探测装置将扫描模式切换为所述第一扫描模式;Acquiring a first mode switching instruction, wherein the first mode switching instruction is used to instruct the detection device to switch the scanning mode to the first scanning mode;
将所述第一模式切换指令中的相位差确定为所述第一光学元件与所述第二光学元件之间的目标相位差。The phase difference in the first mode switching instruction is determined as a target phase difference between the first optical element and the second optical element.
可选的,所述处理器在实现获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差时,用于实现:Optionally, when obtaining the target phase difference between the first optical element and the second optical element of the scanning module in the detection device, the processor is used to:
当获取到第一模式切换指令时,将所述第一光学元件与所述第二光学元件之间的当前相位差确定为所述目标相位差,其中,所述第一模式切换指令用于指示所述探测装置将扫描模式切换为所述第一扫描模式。When the first mode switching instruction is acquired, the current phase difference between the first optical element and the second optical element is determined as the target phase difference, wherein the first mode switching instruction is used to indicate The detection device switches the scanning mode to the first scanning mode.
可选的,所述处理器在实现根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数时,用于实现:Optionally, when the processor adjusts the motion parameter of the first optical element and/or the motion parameter of the second optical element according to the target phase difference, it is configured to:
获取所述第一光学元件与所述第二光学元件之间的目标转速差;acquiring a target rotational speed difference between the first optical element and the second optical element;
根据所述目标相位差和所述目标转速差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置处于第二扫描模式;adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference and the target rotational speed difference, so that the detection device is in a second scanning mode;
其中,在所述第二扫描模式下,所述第一光学元件与所述第二光学元件之间的相位差以所述目标相位差为起点进行周期性变化,使得所述探测装置在第一视场方向上的视场区域进行扫描。Wherein, in the second scanning mode, the phase difference between the first optical element and the second optical element changes periodically starting from the target phase difference, so that the detection device The field of view area in the field of view direction is scanned.
可选的,所述处理器在实现根据所述目标相位差和所述目标转速差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数时,用于实现:Optionally, when the processor adjusts the motion parameter of the first optical element and/or the motion parameter of the second optical element according to the target phase difference and the target rotational speed difference, it is configured to implement :
根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光 学元件的运动参数;Adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference;
在所述第一光学元件和所述第二光学元件按照相同的转速和方向旋转,且所述第一光学元件与第二光学元件之间的相位差达到所述目标相位差时,根据所述目标转速差,控制所述相位差以所述目标相位差为起点进行周期性变化。When the first optical element and the second optical element rotate at the same rotational speed and direction, and the phase difference between the first optical element and the second optical element reaches the target phase difference, according to the The target rotational speed difference is used to control the phase difference to periodically change with the target phase difference as a starting point.
可选的,所述处理器在实现根据所述目标转速差,控制所述相位差以所述目标相位差为起点进行周期性变化时,用于实现:Optionally, when the processor controls the phase difference to periodically change with the target phase difference as a starting point according to the target rotational speed difference, it is used to realize:
根据所述目标转速差和所述目标相位差,确定相位差变化范围,其中,所述相位差变化范围以所述目标相位差为起点;Determine a phase difference variation range according to the target rotational speed difference and the target phase difference, where the phase difference variation range starts from the target phase difference;
控制所述第一光学元件的运动参数和/或所述第二光学元件的运动参数进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化。The motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference is periodically changed according to the phase difference variation range.
可选的,所述处理器在实现控制所述第一光学元件的运动参数和/或所述第二光学元件的运动参数进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化时,用于实现:Optionally, the processor controls the motion parameters of the first optical element and/or the motion parameters of the second optical element to periodically change, so that the phase difference varies according to the phase difference range When performing periodic changes, it is used to achieve:
获取同步转速,其中,所述第一光学元件和所述第二光学元件按照所述同步转速进行旋转时,所述相位差与所述目标相位差相同;acquiring a synchronous rotational speed, wherein when the first optical element and the second optical element rotate according to the synchronous rotational speed, the phase difference is the same as the target phase difference;
控制所述第一光学元件的转速和/或第二光学元件的转速以所述同步转速为中心进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化。The rotational speed of the first optical element and/or the rotational speed of the second optical element are controlled to periodically change around the synchronous rotational speed, so that the phase difference is periodically changed according to the phase difference variation range.
可选的,所述探测装置在所述第一视场方向上的所述相位差变化范围对应的视场区域内进行扫描。Optionally, the detection device scans in the field of view area corresponding to the phase difference variation range in the first field of view direction.
可选的,所述运动参数包括转速,所述转速进行周期性变化的波形包括以下之一:正弦波、余弦波、梯形波、三角波。Optionally, the motion parameter includes a rotational speed, and the waveform in which the rotational speed changes periodically includes one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
可选的,所述处理器在实现根据所述目标转速差和所述目标相位差,确定相位差变化范围时,用于实现:Optionally, when the processor realizes determining the variation range of the phase difference according to the target rotational speed difference and the target phase difference, it is used to realize:
获取所述探测装置的点云帧率,并根据所述点云帧率确定一个周期的持续时长;Obtain the point cloud frame rate of the detection device, and determine the duration of a cycle according to the point cloud frame rate;
根据所述持续时长和所述目标转速差,确定第一相位差;determining a first phase difference according to the duration and the target speed difference;
根据所述第一相位差和所述目标相位差,确定所述相位差变化范围。Determine the phase difference variation range according to the first phase difference and the target phase difference.
可选的,所述处理器在实现根据所述第一相位差和所述目标相位差,确定所述相位差变化范围时,用于实现:Optionally, when the processor realizes determining the variation range of the phase difference according to the first phase difference and the target phase difference, it is configured to:
根据所述第一相位差和所述目标相位差,确定第二相位差,其中,所述目标相位差为所述第一相位差与所述第二相位差之间的中点处的相位差;determining a second phase difference according to the first phase difference and the target phase difference, wherein the target phase difference is a phase difference at a midpoint between the first phase difference and the second phase difference ;
根据所述第一相位差、所述第二相位差和所述目标相位差,确定所述相位差变化范围。The phase difference variation range is determined according to the first phase difference, the second phase difference and the target phase difference.
可选的,所述处理器还用于实现以下步骤:Optionally, the processor is also used to implement the following steps:
获取第二模式切换指令,其中,所述第二模式切换指令用于指示所述探测装置将扫描模式切换为所述第二扫描模式;Obtaining a second mode switching instruction, wherein the second mode switching instruction is used to instruct the detection device to switch the scanning mode to the second scanning mode;
将所述第二模式切换指令中的转速差确定为所述目标转速差。The rotational speed difference in the second mode switching command is determined as the target rotational speed difference.
可选的,所述处理器还用于实现以下步骤:Optionally, the processor is also used to implement the following steps:
将所述第二模式切换指令中的相位差确定为所述目标相位差。determining the phase difference in the second mode switching command as the target phase difference.
可选的,所述探测装置设有第一扫描模式和/或第二扫描模式,所述第一扫描模式指示所述探测装置在第一视场方向上的对应视场位置进行扫描,所述第二扫描模式指示所述探测装置在第一视场方向上的视场区域进行扫描。Optionally, the detection device is provided with a first scanning mode and/or a second scanning mode, the first scanning mode instructs the detection device to scan at a corresponding field of view position in the direction of the first field of view, the The second scanning mode instructs the detecting device to scan the field of view area in the first field of view direction.
可选的,所述第一扫描模式下所述探测装置在第二视场方向上的扫描范围与所述第二扫描模式下所述探测装置在第二视场方向上的扫描范围相同;和/或,Optionally, the scanning range of the detection device in the second field of view direction in the first scanning mode is the same as the scanning range of the detection device in the second field of view direction in the second scanning mode; and /or,
所述探测装置在第一视场方向上进行扫描的视场位置或视场区域是能够被调节的;和/或,The position or area of the field of view that the detection device scans in the first field of view direction can be adjusted; and/or,
所述视场区域包括所述视场位置。The field of view area includes the field of view position.
可选的,所述处理器还用于实现以下步骤:Optionally, the processor is also used to implement the following steps:
获取第三模式切换指令,并根据所述第三模式切换指令,控制所述探测装置处于第三扫描模式;Acquiring a third mode switching instruction, and controlling the detection device to be in a third scanning mode according to the third mode switching instruction;
其中,在所述第三扫描模式下,所述第一光学元件的转速以第一转速为中心呈周期性变化和/或第二光学元件的转速以第二转速为中心呈周期性变化。Wherein, in the third scanning mode, the rotational speed of the first optical element changes periodically around the first rotational speed and/or the rotational speed of the second optical element changes periodically around the second rotational speed.
可选的,在所述第三扫描模式下,所述第一转速、所述第一光学元件的第一旋转角度、所述第二转速和所述第二光学元件的第二旋转角度满足预设约束条件。Optionally, in the third scanning mode, the first rotational speed, the first rotational angle of the first optical element, the second rotational speed, and the second rotational angle of the second optical element satisfy a predetermined Set constraints.
可选的,所述处理器在实现控制所述探测装置处于第三扫描模式时,用于实现:Optionally, when the processor realizes controlling the detection device to be in the third scanning mode, it is used to realize:
控制所述第一光学元件以所述第一转速匀速旋转,并控制所述第二光学元件的转速以所述第二转速为中心进行周期性变化;或者controlling the first optical element to rotate at a constant speed at the first rotational speed, and controlling the rotational speed of the second optical element to periodically change around the second rotational speed; or
控制所述第二光学元件以所述第二转速匀速旋转,并控制所述第一光学元件的转速以所述第一转速为中心进行周期性变化;或者controlling the second optical element to rotate at a constant speed at the second rotational speed, and controlling the rotational speed of the first optical element to periodically change around the first rotational speed; or
控制所述第一光学元件的转速以所述第一转速为中心进行周期性变化,并 控制所述第二光学元件的转速以所述第二转速为中心进行周期性变化。The rotational speed of the first optical element is controlled to periodically change around the first rotational speed, and the rotational speed of the second optical element is controlled to be periodically varied around the second rotational speed.
可选的,所述处理器在实现控制所述第一光学元件的转速时,用于实现:Optionally, when the processor realizes controlling the rotational speed of the first optical element, it is configured to realize:
获取所述第一光学元件的转速的反馈控制参数;Acquiring a feedback control parameter of the rotational speed of the first optical element;
根据所述反馈控制参数,对所述第一光学元件的转速进行反馈控制。Feedback control is performed on the rotational speed of the first optical element according to the feedback control parameter.
可选的,所述处理器在实现获取所述第一光学元件的转速的反馈控制参数时,用于实现:Optionally, when the processor obtains the feedback control parameter of the rotational speed of the first optical element, it is configured to:
获取所述第一光学元件与所述第二光学元件之间的期望相位差、所述第一光学元件的当前旋转角度、所述第一光学元件的当前转速以及所述第二光学元件的第二旋转角度。Obtaining the expected phase difference between the first optical element and the second optical element, the current rotation angle of the first optical element, the current rotational speed of the first optical element, and the first rotation angle of the second optical element Two rotation angles.
可选的,所述处理器在实现根据所述反馈控制参数,对所述第一光学元件的转速进行反馈控制时,用于实现:Optionally, when the processor performs feedback control on the rotational speed of the first optical element according to the feedback control parameter, it is configured to:
根据所述第二旋转角度,确定所述第一光学元件的参考转速;determining a reference rotation speed of the first optical element according to the second rotation angle;
根据所述第二旋转角度和所述期望相位差,确定所述第一光学元件的参考旋转角度;determining a reference rotation angle of the first optical element according to the second rotation angle and the expected phase difference;
根据所述当前旋转角度和所述参考旋转角度,确定所述第一光学元件的补偿参考转速;determining a compensation reference rotation speed of the first optical element according to the current rotation angle and the reference rotation angle;
根据所述参考转速、所述补偿参考转速和所述当前转速,对所述第一光学元件的当前转速进行反馈控制。Feedback control is performed on the current rotational speed of the first optical element according to the reference rotational speed, the compensation reference rotational speed and the current rotational speed.
可选的,所述处理器在实现获取所述第一光学元件与所述第二光学元件之间的期望相位差时,用于实现:Optionally, when the processor obtains the desired phase difference between the first optical element and the second optical element, it is configured to:
获取所述第一光学元件在当前周期内的当前反馈控制时刻;Acquiring the current feedback control moment of the first optical element in the current period;
根据所述当前反馈控制时刻和预设的相位差与反馈控制时刻之间的映射关系,确定所述第一光学元件与所述第二光学元件之间的期望相位差。An expected phase difference between the first optical element and the second optical element is determined according to the current feedback control time and a preset mapping relationship between the phase difference and the feedback control time.
可选的,所述映射关系是根据所述探测装置在所述第一视场方向的最大扫描范围、发射器数量、发射夹角、点云帧率、所述第一转速和所述第二转速确定的。Optionally, the mapping relationship is based on the maximum scanning range of the detection device in the direction of the first field of view, the number of emitters, the included angle of emission, the point cloud frame rate, the first rotational speed and the second Speed is determined.
可选的,所述第一光学元件包括棱镜,所述第二光学元件包括反射镜。Optionally, the first optical element includes a prism, and the second optical element includes a mirror.
需要说明的是,所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的探测装置的具体工作过程,可以参考前述探测装置的视场控制方法实施例中的对应过程,在此不再赘述。It should be noted that those skilled in the art can clearly understand that for the convenience and brevity of the description, the specific working process of the detection device described above can refer to the corresponding process in the embodiment of the field of view control method of the detection device described above, I won't repeat them here.
请参阅图13,图13是本申请实施例提供的一种可移动平台的结构示意性框图。Please refer to FIG. 13 . FIG. 13 is a schematic structural block diagram of a mobile platform provided by an embodiment of the present application.
如图13所示,可移动平台300包括平台本体310、动力系统320和探测装置330。其中,动力系统320,设于平台本体上310上,用于为可移动平台300提供移动动力,探测装置330,设于平台本体310上,用于探测可移动平台300所处环境的外部环境信息。探测装置330可以为图12中的探测装置200。As shown in FIG. 13 , the movable platform 300 includes a platform body 310 , a power system 320 and a detection device 330 . Among them, the power system 320 is set on the platform body 310 and is used to provide mobile power for the movable platform 300, and the detection device 330 is set on the platform body 310 and is used to detect the external environment information of the environment where the movable platform 300 is located. . The detection device 330 may be the detection device 200 in FIG. 12 .
需要说明的是,所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的可移动平台的具体工作过程,可以参考前述探测装置的视场控制方法实施例中的对应过程,在此不再赘述。It should be noted that those skilled in the art can clearly understand that for the convenience and brevity of the description, the specific working process of the movable platform described above can refer to the corresponding process in the embodiment of the field of view control method of the detection device , which will not be repeated here.
本申请实施例还提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序中包括程序指令,所述处理器执行所述程序指令,实现上述实施例提供的探测装置的视场控制方法的步骤。The embodiment of the present application also provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, the computer program includes program instructions, and the processor executes the program instructions to implement the above-mentioned embodiment. The steps of the method for controlling the field of view of the detecting device.
其中,所述计算机可读存储介质可以是前述任一实施例所述的探测装置或可移动平台的内部存储单元,例如所述探测装置或可移动平台的硬盘或内存。所述计算机可读存储介质也可以是所述探测装置或可移动平台的外部存储设备,例如所述探测装置或可移动平台上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。Wherein, the computer-readable storage medium may be an internal storage unit of the detection device or the movable platform described in any of the foregoing embodiments, such as a hard disk or a memory of the detection device or the movable platform. The computer-readable storage medium can also be an external storage device of the detection device or the removable platform, such as a plug-in hard disk equipped on the detection device or the removable platform, a smart memory card (Smart Media Card, SMC) , Secure Digital (Secure Digital, SD) card, flash memory card (Flash Card), etc.
应当理解,在此本申请说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本申请。如在本申请说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。It should be understood that the terms used in the specification of this application are for the purpose of describing specific embodiments only and are not intended to limit the application. As used in this specification and the appended claims, the singular forms "a", "an" and "the" are intended to include plural referents unless the context clearly dictates otherwise.
还应当理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。It should also be understood that the term "and/or" used in the description of the present application and the appended claims refers to any combination and all possible combinations of one or more of the associated listed items, and includes these combinations.
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以权利要求的保护范围为准。The above is only a specific embodiment of the application, but the scope of protection of the application is not limited thereto. Any person familiar with the technical field can easily think of various equivalents within the scope of the technology disclosed in the application. Modifications or replacements, these modifications or replacements shall be covered within the scope of protection of this application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.

Claims (52)

  1. 一种探测装置的视场控制方法,其特征在于,包括:A method for controlling a field of view of a detection device, comprising:
    获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差;Acquiring the target phase difference between the first optical element and the second optical element of the scanning module in the detection device;
    根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置在第一视场方向上的对应视场位置或视场区域进行扫描。According to the target phase difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
  2. 根据权利要求1所述的视场控制方法,其特征在于,所述根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,包括:The field of view control method according to claim 1, wherein the adjusting the motion parameters of the first optical element and/or the motion parameters of the second optical element according to the target phase difference comprises:
    根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置处于第一扫描模式;adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference, so that the detection device is in a first scanning mode;
    其中,在所述第一扫描模式下,所述第一光学元件和所述第二光学元件按照相同的转速和方向保持所述目标相位差进行旋转,使得所述探测装置在第一视场方向上的所述目标相位差对应的视场位置进行扫描。Wherein, in the first scanning mode, the first optical element and the second optical element rotate according to the same rotation speed and direction while maintaining the target phase difference, so that the detection device rotates in the direction of the first field of view The position of the field of view corresponding to the phase difference of the target is scanned.
  3. 根据权利要求2所述的视场控制方法,其特征在于,所述获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差,包括:The field of view control method according to claim 2, wherein the acquiring the target phase difference between the first optical element and the second optical element of the scanning module in the detection device comprises:
    获取第一模式切换指令,其中,所述第一模式切换指令用于指示所述探测装置将扫描模式切换为所述第一扫描模式;Acquiring a first mode switching instruction, wherein the first mode switching instruction is used to instruct the detection device to switch the scanning mode to the first scanning mode;
    将所述第一模式切换指令中的相位差确定为所述第一光学元件与所述第二光学元件之间的目标相位差。The phase difference in the first mode switching instruction is determined as a target phase difference between the first optical element and the second optical element.
  4. 根据权利要求2所述的视场控制方法,其特征在于,所述获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差,包括:The field of view control method according to claim 2, wherein the acquiring the target phase difference between the first optical element and the second optical element of the scanning module in the detection device comprises:
    当获取到第一模式切换指令时,将所述第一光学元件与所述第二光学元件之间的当前相位差确定为所述目标相位差,其中,所述第一模式切换指令用于指示所述探测装置将扫描模式切换为所述第一扫描模式。When the first mode switching instruction is acquired, the current phase difference between the first optical element and the second optical element is determined as the target phase difference, wherein the first mode switching instruction is used to indicate The detection device switches the scanning mode to the first scanning mode.
  5. 根据权利要求1至4中任一项所述的视场控制方法,其特征在于,所述根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,包括:The field of view control method according to any one of claims 1 to 4, characterized in that, according to the target phase difference, adjusting the motion parameters of the first optical element and/or the second optical element motion parameters, including:
    获取所述第一光学元件与所述第二光学元件之间的目标转速差;acquiring a target rotational speed difference between the first optical element and the second optical element;
    根据所述目标相位差和所述目标转速差,调整所述第一光学元件的运动参 数和/或所述第二光学元件的运动参数,以使所述探测装置处于第二扫描模式;According to the target phase difference and the target rotational speed difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the detection device is in the second scanning mode;
    其中,在所述第二扫描模式下,所述第一光学元件与所述第二光学元件之间的相位差以所述目标相位差为起点进行周期性变化,使得所述探测装置在第一视场方向上的视场区域进行扫描。Wherein, in the second scanning mode, the phase difference between the first optical element and the second optical element changes periodically starting from the target phase difference, so that the detection device The field of view area in the field of view direction is scanned.
  6. 根据权利要求5所述的视场控制方法,其特征在于,所述根据所述目标相位差和所述目标转速差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,包括:The field of view control method according to claim 5, characterized in that, according to the target phase difference and the target rotational speed difference, adjusting the motion parameters of the first optical element and/or the second optical element motion parameters, including:
    根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数;adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference;
    在所述第一光学元件和所述第二光学元件按照相同的转速和方向旋转,且所述第一光学元件与第二光学元件之间的相位差达到所述目标相位差时,根据所述目标转速差,控制所述相位差以所述目标相位差为起点进行周期性变化。When the first optical element and the second optical element rotate at the same rotational speed and direction, and the phase difference between the first optical element and the second optical element reaches the target phase difference, according to the The target rotational speed difference is used to control the phase difference to periodically change with the target phase difference as a starting point.
  7. 根据权利要求6所述的视场控制方法,其特征在于,所述根据所述目标转速差,控制所述相位差以所述目标相位差为起点进行周期性变化,包括:The field of view control method according to claim 6, wherein, according to the target rotational speed difference, controlling the phase difference to periodically change with the target phase difference as a starting point includes:
    根据所述目标转速差和所述目标相位差,确定相位差变化范围,其中,所述相位差变化范围以所述目标相位差为起点;Determine a phase difference variation range according to the target rotational speed difference and the target phase difference, where the phase difference variation range starts from the target phase difference;
    控制所述第一光学元件的运动参数和/或所述第二光学元件的运动参数进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化。The motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference is periodically changed according to the phase difference variation range.
  8. 根据权利要求7所述的视场控制方法,其特征在于,所述控制所述第一光学元件的运动参数和/或所述第二光学元件的运动参数进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化,包括:The field of view control method according to claim 7, characterized in that the control of the motion parameters of the first optical element and/or the motion parameters of the second optical element is periodically changed so that the phase The difference changes periodically according to the phase difference variation range, including:
    获取同步转速,其中,所述第一光学元件和所述第二光学元件按照所述同步转速进行旋转时,所述相位差与所述目标相位差相同;acquiring a synchronous rotational speed, wherein when the first optical element and the second optical element rotate according to the synchronous rotational speed, the phase difference is the same as the target phase difference;
    控制所述第一光学元件的转速和/或第二光学元件的转速以所述同步转速为中心进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化。The rotational speed of the first optical element and/or the rotational speed of the second optical element are controlled to periodically change around the synchronous rotational speed, so that the phase difference is periodically changed according to the phase difference variation range.
  9. 根据权利要求7所述的视场控制方法,其特征在于,所述探测装置在所述第一视场方向上的所述相位差变化范围对应的视场区域内进行扫描。The field of view control method according to claim 7, wherein the detection device scans the field of view area corresponding to the phase difference variation range in the first field of view direction.
  10. 根据权利要求7所述的视场控制方法,其特征在于,所述运动参数包括转速,所述转速进行周期性变化的波形包括以下之一:正弦波、余弦波、梯形波、三角波。The field of view control method according to claim 7, wherein the motion parameter includes a rotational speed, and the waveform in which the rotational speed changes periodically includes one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
  11. 根据权利要求7所述的视场控制方法,其特征在于,所述根据所述目 标转速差和目标相位差,确定相位差变化范围,包括:The field of view control method according to claim 7, wherein said determining the phase difference variation range according to said target rotational speed difference and target phase difference comprises:
    获取所述探测装置的点云帧率,并根据所述点云帧率确定一个周期的持续时长;Obtain the point cloud frame rate of the detection device, and determine the duration of a cycle according to the point cloud frame rate;
    根据所述持续时长和所述目标转速差,确定第一相位差;determining a first phase difference according to the duration and the target speed difference;
    根据所述第一相位差和所述目标相位差,确定所述相位差变化范围。Determine the phase difference variation range according to the first phase difference and the target phase difference.
  12. 根据权利要求11所述的视场控制方法,其特征在于,所述根据所述第一相位差和所述目标相位差,确定所述相位差变化范围,包括:The field of view control method according to claim 11, wherein the determining the phase difference variation range according to the first phase difference and the target phase difference comprises:
    根据所述第一相位差和所述目标相位差,确定第二相位差,其中,所述目标相位差为所述第一相位差与所述第二相位差之间的中点处的相位差;determining a second phase difference according to the first phase difference and the target phase difference, wherein the target phase difference is a phase difference at a midpoint between the first phase difference and the second phase difference ;
    根据所述第一相位差、所述第二相位差和所述目标相位差,确定所述相位差变化范围。The phase difference variation range is determined according to the first phase difference, the second phase difference and the target phase difference.
  13. 根据权利要求5所述的视场控制方法,其特征在于,所述方法还包括:The field of view control method according to claim 5, further comprising:
    获取第二模式切换指令,其中,所述第二模式切换指令用于指示所述探测装置将扫描模式切换为所述第二扫描模式;Obtaining a second mode switching instruction, wherein the second mode switching instruction is used to instruct the detection device to switch the scanning mode to the second scanning mode;
    将所述第二模式切换指令中的转速差确定为所述目标转速差。The rotational speed difference in the second mode switching command is determined as the target rotational speed difference.
  14. 根据权利要求13所述的视场控制方法,其特征在于,所述方法还包括:The field of view control method according to claim 13, further comprising:
    将所述第二模式切换指令中的相位差确定为所述目标相位差。determining the phase difference in the second mode switching command as the target phase difference.
  15. 根据权利要求1所述的视场控制方法,其特征在于,所述探测装置设有第一扫描模式和/或第二扫描模式,所述第一扫描模式指示所述探测装置在第一视场方向上的对应视场位置进行扫描,所述第二扫描模式指示所述探测装置在第一视场方向上的视场区域进行扫描。The field of view control method according to claim 1, wherein the detection device is provided with a first scanning mode and/or a second scanning mode, and the first scanning mode indicates that the detection device is in the first field of view The corresponding viewing field position in the direction is scanned, and the second scanning mode instructs the detection device to scan the viewing field area in the first viewing field direction.
  16. 根据权利要求15所述的视场控制方法,其特征在于,所述第一扫描模式下所述探测装置在第二视场方向上的扫描范围与所述第二扫描模式下所述探测装置在第二视场方向上的扫描范围相同;和/或,The field of view control method according to claim 15, characterized in that, the scanning range of the detection device in the second field of view direction in the first scanning mode is the same as that of the detection device in the second scanning mode. The same scan range in the direction of the second field of view; and/or,
    所述探测装置在第一视场方向上进行扫描的视场位置或视场区域是能够被调节的;和/或,The position or area of the field of view that the detection device scans in the first field of view direction can be adjusted; and/or,
    所述视场区域包括所述视场位置。The field of view area includes the field of view position.
  17. 根据权利要求1至16中任一项所述的视场控制方法,其特征在于,所述方法还包括:The field of view control method according to any one of claims 1 to 16, wherein the method further comprises:
    获取第三模式切换指令,并根据所述第三模式切换指令,控制所述探测装置处于第三扫描模式;Acquiring a third mode switching instruction, and controlling the detection device to be in a third scanning mode according to the third mode switching instruction;
    其中,在所述第三扫描模式下,所述第一光学元件的转速以第一转速为中 心呈周期性变化和/或第二光学元件的转速以第二转速为中心呈周期性变化。Wherein, in the third scanning mode, the rotational speed of the first optical element changes periodically around the first rotational speed and/or the rotational speed of the second optical element changes periodically around the second rotational speed.
  18. 根据权利要求17所述的视场控制方法,其特征在于,在所述第三扫描模式下,所述第一转速、所述第一光学元件的第一旋转角度、所述第二转速和所述第二光学元件的第二旋转角度满足预设约束条件。The field of view control method according to claim 17, wherein, in the third scanning mode, the first rotation speed, the first rotation angle of the first optical element, the second rotation speed and the The second rotation angle of the second optical element satisfies a preset constraint condition.
  19. 根据权利要求17所述的视场控制方法,其特征在于,所述控制所述探测装置处于第三扫描模式,包括:The field of view control method according to claim 17, wherein the controlling the detection device to be in the third scanning mode comprises:
    控制所述第一光学元件以所述第一转速匀速旋转,并控制所述第二光学元件的转速以所述第二转速为中心进行周期性变化;或者controlling the first optical element to rotate at a constant speed at the first rotational speed, and controlling the rotational speed of the second optical element to periodically change around the second rotational speed; or
    控制所述第二光学元件以所述第二转速匀速旋转,并控制所述第一光学元件的转速以所述第一转速为中心进行周期性变化;或者controlling the second optical element to rotate at a constant speed at the second rotational speed, and controlling the rotational speed of the first optical element to periodically change around the first rotational speed; or
    控制所述第一光学元件的转速以所述第一转速为中心进行周期性变化,并控制所述第二光学元件的转速以所述第二转速为中心进行周期性变化。The rotation speed of the first optical element is controlled to change periodically around the first rotation speed, and the rotation speed of the second optical element is controlled to change periodically around the second rotation speed.
  20. 根据权利要求19所述的视场控制方法,其特征在于,所述控制所述第一光学元件的转速,包括:The field of view control method according to claim 19, wherein the controlling the rotation speed of the first optical element comprises:
    获取所述第一光学元件的转速的反馈控制参数;Acquiring a feedback control parameter of the rotational speed of the first optical element;
    根据所述反馈控制参数,对所述第一光学元件的转速进行反馈控制。Feedback control is performed on the rotational speed of the first optical element according to the feedback control parameter.
  21. 根据权利要求20所述的视场控制方法,其特征在于,所述获取所述第一光学元件的转速的反馈控制参数,包括:The field of view control method according to claim 20, wherein said acquiring the feedback control parameters of the rotational speed of the first optical element comprises:
    获取所述第一光学元件与所述第二光学元件之间的期望相位差、所述第一光学元件的当前旋转角度、所述第一光学元件的当前转速以及所述第二光学元件的第二旋转角度。Obtaining the expected phase difference between the first optical element and the second optical element, the current rotation angle of the first optical element, the current rotational speed of the first optical element, and the first rotation angle of the second optical element Two rotation angles.
  22. 根据权利要求21所述的视场控制方法,其特征在于,所述根据所述反馈控制参数,对所述第一光学元件的转速进行反馈控制,包括:The field of view control method according to claim 21, wherein the feedback control of the rotational speed of the first optical element according to the feedback control parameters comprises:
    根据所述第二旋转角度,确定所述第一光学元件的参考转速;determining a reference rotation speed of the first optical element according to the second rotation angle;
    根据所述第二旋转角度和所述期望相位差,确定所述第一光学元件的参考旋转角度;determining a reference rotation angle of the first optical element according to the second rotation angle and the expected phase difference;
    根据所述当前旋转角度和所述参考旋转角度,确定所述第一光学元件的补偿参考转速;determining a compensation reference rotation speed of the first optical element according to the current rotation angle and the reference rotation angle;
    根据所述参考转速、所述补偿参考转速和所述当前转速,对所述第一光学元件的当前转速进行反馈控制。Feedback control is performed on the current rotational speed of the first optical element according to the reference rotational speed, the compensation reference rotational speed and the current rotational speed.
  23. 根据权利要求21所述的视场控制方法,其特征在于,所述获取所述第一光学元件与所述第二光学元件之间的期望相位差,包括:The field of view control method according to claim 21, wherein the acquiring the expected phase difference between the first optical element and the second optical element comprises:
    获取所述第一光学元件在当前周期内的当前反馈控制时刻;Acquiring the current feedback control moment of the first optical element in the current cycle;
    根据所述当前反馈控制时刻和预设的相位差与反馈控制时刻之间的映射关系,确定所述第一光学元件与所述第二光学元件之间的期望相位差。An expected phase difference between the first optical element and the second optical element is determined according to the current feedback control time and a preset mapping relationship between the phase difference and the feedback control time.
  24. 根据权利要求23所述的视场控制方法,其特征在于,所述映射关系是根据所述探测装置在所述第一视场方向的最大扫描范围、发射器数量、发射夹角、点云帧率、所述第一转速和所述第二转速确定的。The field of view control method according to claim 23, wherein the mapping relationship is based on the maximum scanning range of the detection device in the direction of the first field of view, the number of emitters, the included angle of emission, and the point cloud frame rate, the first speed and the second speed are determined.
  25. 根据权利要求1至16中任一项所述的视场控制方法,其特征在于,所述第一光学元件包括棱镜,所述第二光学元件包括反射镜。The field of view control method according to any one of claims 1 to 16, wherein the first optical element includes a prism, and the second optical element includes a mirror.
  26. 一种探测装置,其特征在于,包括:A detection device, characterized in that it comprises:
    扫描模组,设于光源发射出的光脉冲序列的光路上,所述扫描模组包括第一光学元件和第二光学元件,所述第一光学元件和所述第二光学元件用于改变所述光脉冲序列的传播方向,以使所述探测装置按照第一视场方向和/或第二视场方向进行扫描;The scanning module is arranged on the optical path of the light pulse sequence emitted by the light source, the scanning module includes a first optical element and a second optical element, and the first optical element and the second optical element are used to change the The propagation direction of the light pulse sequence, so that the detection device scans according to the first field of view direction and/or the second field of view direction;
    存储器,用于存储计算机程序;memory for storing computer programs;
    一个或多个处理器,单独地或共同地工作,用于执行所述计算机程序并在执行所述计算机程序时实现以下步骤:One or more processors, working individually or jointly, for executing the computer program and implementing the following steps when executing the computer program:
    获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差;Acquiring the target phase difference between the first optical element and the second optical element of the scanning module in the detection device;
    根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置在第一视场方向上的对应视场位置或视场区域进行扫描。According to the target phase difference, adjust the motion parameters of the first optical element and/or the motion parameters of the second optical element, so that the corresponding field of view position or field of view of the detection device in the first field of view direction field area to scan.
  27. 根据权利要求26所述的探测装置,其特征在于,所述处理器在实现根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数时,用于实现:The detection device according to claim 26, wherein when the processor adjusts the motion parameters of the first optical element and/or the motion parameters of the second optical element according to the target phase difference , used to implement:
    根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置处于第一扫描模式;adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference, so that the detection device is in a first scanning mode;
    其中,在所述第一扫描模式下,所述第一光学元件和所述第二光学元件按照相同的转速和方向保持所述目标相位差进行旋转,使得所述探测装置在第一视场方向上的所述目标相位差对应的视场位置进行扫描。Wherein, in the first scanning mode, the first optical element and the second optical element rotate according to the same rotation speed and direction while maintaining the target phase difference, so that the detection device rotates in the direction of the first field of view The position of the field of view corresponding to the phase difference of the target is scanned.
  28. 根据权利要求27所述的探测装置,其特征在于,所述处理器在实现获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差时,用于实现:The detection device according to claim 27, wherein the processor is configured to realize the target phase difference between the first optical element and the second optical element of the scanning module in the detection device when obtaining :
    获取第一模式切换指令,其中,所述第一模式切换指令用于指示所述探测装置将扫描模式切换为所述第一扫描模式;Acquiring a first mode switching instruction, wherein the first mode switching instruction is used to instruct the detection device to switch the scanning mode to the first scanning mode;
    将所述第一模式切换指令中的相位差确定为所述第一光学元件与所述第二光学元件之间的目标相位差。The phase difference in the first mode switching instruction is determined as a target phase difference between the first optical element and the second optical element.
  29. 根据权利要求27所述的探测装置,其特征在于,所述处理器在实现获取所述探测装置中扫描模组的第一光学元件与第二光学元件之间的目标相位差时,用于实现:The detection device according to claim 27, wherein the processor is configured to realize the target phase difference between the first optical element and the second optical element of the scanning module in the detection device when obtaining :
    当获取到第一模式切换指令时,将所述第一光学元件与所述第二光学元件之间的当前相位差确定为所述目标相位差,其中,所述第一模式切换指令用于指示所述探测装置将扫描模式切换为所述第一扫描模式。When the first mode switching instruction is acquired, the current phase difference between the first optical element and the second optical element is determined as the target phase difference, wherein the first mode switching instruction is used to indicate The detection device switches the scanning mode to the first scanning mode.
  30. 根据权利要求26至29中任一项所述的探测装置,其特征在于,所述处理器在实现根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数时,用于实现:The detection device according to any one of claims 26 to 29, wherein the processor adjusts the motion parameters of the first optical element and/or the second optical element according to the target phase difference. When the motion parameters of optical components are used to achieve:
    获取所述第一光学元件与所述第二光学元件之间的目标转速差;acquiring a target rotational speed difference between the first optical element and the second optical element;
    根据所述目标相位差和所述目标转速差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数,以使所述探测装置处于第二扫描模式;adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference and the target rotational speed difference, so that the detection device is in a second scanning mode;
    其中,在所述第二扫描模式下,所述第一光学元件与所述第二光学元件之间的相位差以所述目标相位差为起点进行周期性变化,使得所述探测装置在第一视场方向上的视场区域进行扫描。Wherein, in the second scanning mode, the phase difference between the first optical element and the second optical element changes periodically starting from the target phase difference, so that the detection device The field of view area in the field of view direction is scanned.
  31. 根据权利要求30所述的探测装置,其特征在于,所述处理器在实现根据所述目标相位差和所述目标转速差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数时,用于实现:The detection device according to claim 30, wherein the processor adjusts the motion parameters of the first optical element and/or the second optical element according to the target phase difference and the target rotation speed difference. When the motion parameters of optical components are used to achieve:
    根据所述目标相位差,调整所述第一光学元件的运动参数和/或所述第二光学元件的运动参数;adjusting a motion parameter of the first optical element and/or a motion parameter of the second optical element according to the target phase difference;
    在所述第一光学元件和所述第二光学元件按照相同的转速和方向旋转,且所述第一光学元件与第二光学元件之间的相位差达到所述目标相位差时,根据所述目标转速差,控制所述相位差以所述目标相位差为起点进行周期性变化。When the first optical element and the second optical element rotate at the same rotational speed and direction, and the phase difference between the first optical element and the second optical element reaches the target phase difference, according to the The target rotational speed difference is used to control the phase difference to periodically change with the target phase difference as a starting point.
  32. 根据权利要求31所述的探测装置,其特征在于,所述处理器在实现根据所述目标转速差,控制所述相位差以所述目标相位差为起点进行周期性变化时,用于实现:The detection device according to claim 31, characterized in that, when the processor controls the phase difference to periodically change with the target phase difference as a starting point according to the target rotational speed difference, it is used to realize:
    根据所述目标转速差和所述目标相位差,确定相位差变化范围,其中,所述相位差变化范围以所述目标相位差为起点;Determine a phase difference variation range according to the target rotational speed difference and the target phase difference, where the phase difference variation range starts from the target phase difference;
    控制所述第一光学元件的运动参数和/或所述第二光学元件的运动参数进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化。The motion parameters of the first optical element and/or the motion parameters of the second optical element are controlled to change periodically, so that the phase difference is periodically changed according to the phase difference variation range.
  33. 根据权利要求32所述的探测装置,其特征在于,所述处理器在实现控制所述第一光学元件的运动参数和/或所述第二光学元件的运动参数进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化时,用于实现:The detection device according to claim 32, wherein the processor controls the motion parameters of the first optical element and/or the motion parameters of the second optical element to change periodically, so that the When the phase difference changes periodically according to the phase difference variation range, it is used to realize:
    获取同步转速,其中,所述第一光学元件和所述第二光学元件按照所述同步转速进行旋转时,所述相位差与所述目标相位差相同;acquiring a synchronous rotational speed, wherein when the first optical element and the second optical element rotate according to the synchronous rotational speed, the phase difference is the same as the target phase difference;
    控制所述第一光学元件的转速和/或第二光学元件的转速以所述同步转速为中心进行周期性变化,以使所述相位差按照所述相位差变化范围进行周期性变化。The rotational speed of the first optical element and/or the rotational speed of the second optical element are controlled to periodically change around the synchronous rotational speed, so that the phase difference is periodically changed according to the phase difference variation range.
  34. 根据权利要求32所述的探测装置,其特征在于,所述探测装置在所述第一视场方向上的所述相位差变化范围对应的视场区域内进行扫描。The detecting device according to claim 32, characterized in that, the detecting device scans in the viewing field area corresponding to the phase difference variation range in the first viewing field direction.
  35. 根据权利要求32所述的探测装置,其特征在于,所述运动参数包括转速,所述转速进行周期性变化的波形包括以下之一:正弦波、余弦波、梯形波、三角波。The detecting device according to claim 32, wherein the motion parameter includes a rotational speed, and the waveform of the rotational speed periodically changing includes one of the following: sine wave, cosine wave, trapezoidal wave, and triangular wave.
  36. 根据权利要求32所述的探测装置,其特征在于,所述处理器在实现根据所述目标转速差和所述目标相位差,确定相位差变化范围时,用于实现:The detection device according to claim 32, characterized in that, when the processor realizes determining the variation range of the phase difference according to the target rotational speed difference and the target phase difference, it is used to realize:
    获取所述探测装置的点云帧率,并根据所述点云帧率确定一个周期的持续时长;Obtain the point cloud frame rate of the detection device, and determine the duration of a cycle according to the point cloud frame rate;
    根据所述持续时长和所述目标转速差,确定第一相位差;determining a first phase difference according to the duration and the target speed difference;
    根据所述第一相位差和所述目标相位差,确定所述相位差变化范围。Determine the phase difference variation range according to the first phase difference and the target phase difference.
  37. 根据权利要求36所述的探测装置,其特征在于,所述处理器在实现根据所述第一相位差和所述目标相位差,确定所述相位差变化范围时,用于实现:The detection device according to claim 36, characterized in that, when the processor determines the variation range of the phase difference according to the first phase difference and the target phase difference, it is used to realize:
    根据所述第一相位差和所述目标相位差,确定第二相位差,其中,所述目标相位差为所述第一相位差与所述第二相位差之间的中点处的相位差;determining a second phase difference according to the first phase difference and the target phase difference, wherein the target phase difference is a phase difference at a midpoint between the first phase difference and the second phase difference ;
    根据所述第一相位差、所述第二相位差和所述目标相位差,确定所述相位差变化范围。The phase difference variation range is determined according to the first phase difference, the second phase difference and the target phase difference.
  38. 根据权利要求30所述的探测装置,其特征在于,所述处理器还用于实现以下步骤:The detection device according to claim 30, wherein the processor is further configured to implement the following steps:
    获取第二模式切换指令,其中,所述第二模式切换指令用于指示所述探测装置将扫描模式切换为所述第二扫描模式;Obtaining a second mode switching instruction, wherein the second mode switching instruction is used to instruct the detection device to switch the scanning mode to the second scanning mode;
    将所述第二模式切换指令中的转速差确定为所述目标转速差。The rotational speed difference in the second mode switching instruction is determined as the target rotational speed difference.
  39. 根据权利要求38所述的探测装置,其特征在于,所述处理器还用于实现以下步骤:The detection device according to claim 38, wherein the processor is further configured to implement the following steps:
    将所述第二模式切换指令中的相位差确定为所述目标相位差。determining the phase difference in the second mode switching instruction as the target phase difference.
  40. 根据权利要求26所述的探测装置,其特征在于,所述探测装置设有第一扫描模式和/或第二扫描模式,所述第一扫描模式指示所述探测装置在第一视场方向上的对应视场位置进行扫描,所述第二扫描模式指示所述探测装置在第一视场方向上的视场区域进行扫描。The detecting device according to claim 26, wherein the detecting device is provided with a first scanning mode and/or a second scanning mode, and the first scanning mode indicates that the detecting device is in the direction of the first field of view The corresponding viewing field position is scanned, and the second scanning mode instructs the detection device to scan the viewing field area in the first viewing field direction.
  41. 根据权利要求40所述的探测装置,其特征在于,所述第一扫描模式下所述探测装置在第二视场方向上的扫描范围与所述第二扫描模式下所述探测装置在第二视场方向上的扫描范围相同;和/或,The detecting device according to claim 40, characterized in that, the scanning range of the detecting device in the second field of view direction in the first scanning mode is the same as that in the second scanning mode of the detecting device in the second scanning mode. same scanning range in the field of view direction; and/or,
    所述探测装置在第一视场方向上进行扫描的视场位置或视场区域是能够被调节的;和/或,The position or area of the field of view that the detection device scans in the first field of view direction can be adjusted; and/or,
    所述视场区域包括所述视场位置。The field of view area includes the field of view position.
  42. 根据权利要求26至41中任一项所述的探测装置,其特征在于,所述处理器还用于实现以下步骤:The detection device according to any one of claims 26 to 41, wherein the processor is further configured to implement the following steps:
    获取第三模式切换指令,并根据所述第三模式切换指令,控制所述探测装置处于第三扫描模式;Acquiring a third mode switching instruction, and controlling the detection device to be in a third scanning mode according to the third mode switching instruction;
    其中,在所述第三扫描模式下,所述第一光学元件的转速以第一转速为中心呈周期性变化和/或第二光学元件的转速以第二转速为中心呈周期性变化。Wherein, in the third scanning mode, the rotational speed of the first optical element changes periodically around the first rotational speed and/or the rotational speed of the second optical element changes periodically around the second rotational speed.
  43. 根据权利要求42所述的探测装置,其特征在于,在所述第三扫描模式下,所述第一转速、所述第一光学元件的第一旋转角度、所述第二转速和所述第二光学元件的第二旋转角度满足预设约束条件。The detecting device according to claim 42, characterized in that, in the third scanning mode, the first rotation speed, the first rotation angle of the first optical element, the second rotation speed and the first The second rotation angle of the two optical elements satisfies a preset constraint condition.
  44. 根据权利要求42所述的探测装置,其特征在于,所述处理器在实现控制所述探测装置处于第三扫描模式时,用于实现:The detection device according to claim 42, wherein the processor is configured to realize: when controlling the detection device to be in the third scanning mode:
    控制所述第一光学元件以所述第一转速匀速旋转,并控制所述第二光学元件的转速以所述第二转速为中心进行周期性变化;或者controlling the first optical element to rotate at a constant speed at the first rotational speed, and controlling the rotational speed of the second optical element to periodically change around the second rotational speed; or
    控制所述第二光学元件以所述第二转速匀速旋转,并控制所述第一光学元件的转速以所述第一转速为中心进行周期性变化;或者controlling the second optical element to rotate at a constant speed at the second rotational speed, and controlling the rotational speed of the first optical element to periodically change around the first rotational speed; or
    控制所述第一光学元件的转速以所述第一转速为中心进行周期性变化,并控制所述第二光学元件的转速以所述第二转速为中心进行周期性变化。The rotation speed of the first optical element is controlled to change periodically around the first rotation speed, and the rotation speed of the second optical element is controlled to change periodically around the second rotation speed.
  45. 根据权利要求44所述的探测装置,其特征在于,所述处理器在实现控 制所述第一光学元件的转速时,用于实现:The detection device according to claim 44, wherein, when the processor realizes controlling the rotational speed of the first optical element, it is used to realize:
    获取所述第一光学元件的转速的反馈控制参数;Acquiring a feedback control parameter of the rotational speed of the first optical element;
    根据所述反馈控制参数,对所述第一光学元件的转速进行反馈控制。Feedback control is performed on the rotational speed of the first optical element according to the feedback control parameter.
  46. 根据权利要求45所述的探测装置,其特征在于,所述处理器在实现获取所述第一光学元件的转速的反馈控制参数时,用于实现:The detection device according to claim 45, characterized in that, when the processor obtains the feedback control parameters of the rotation speed of the first optical element, it is used to realize:
    获取所述第一光学元件与所述第二光学元件之间的期望相位差、所述第一光学元件的当前旋转角度、所述第一光学元件的当前转速以及所述第二光学元件的第二旋转角度。Obtaining the expected phase difference between the first optical element and the second optical element, the current rotation angle of the first optical element, the current rotational speed of the first optical element, and the first rotation angle of the second optical element Two rotation angles.
  47. 根据权利要求46所述的探测装置,其特征在于,所述处理器在实现根据所述反馈控制参数,对所述第一光学元件的转速进行反馈控制时,用于实现:The detection device according to claim 46, characterized in that, when the processor performs feedback control on the rotational speed of the first optical element according to the feedback control parameter, it is used to realize:
    根据所述第二旋转角度,确定所述第一光学元件的参考转速;determining a reference rotation speed of the first optical element according to the second rotation angle;
    根据所述第二旋转角度和所述期望相位差,确定所述第一光学元件的参考旋转角度;determining a reference rotation angle of the first optical element according to the second rotation angle and the expected phase difference;
    根据所述当前旋转角度和所述参考旋转角度,确定所述第一光学元件的补偿参考转速;determining a compensation reference rotation speed of the first optical element according to the current rotation angle and the reference rotation angle;
    根据所述参考转速、所述补偿参考转速和所述当前转速,对所述第一光学元件的当前转速进行反馈控制。Feedback control is performed on the current rotational speed of the first optical element according to the reference rotational speed, the compensation reference rotational speed and the current rotational speed.
  48. 根据权利要求46所述的探测装置,其特征在于,所述处理器在实现获取所述第一光学元件与所述第二光学元件之间的期望相位差时,用于实现:The detection device according to claim 46, wherein the processor is configured to realize: when obtaining the expected phase difference between the first optical element and the second optical element:
    获取所述第一光学元件在当前周期内的当前反馈控制时刻;Acquiring the current feedback control moment of the first optical element in the current period;
    根据所述当前反馈控制时刻和预设的相位差与反馈控制时刻之间的映射关系,确定所述第一光学元件与所述第二光学元件之间的期望相位差。An expected phase difference between the first optical element and the second optical element is determined according to the current feedback control time and a preset mapping relationship between the phase difference and the feedback control time.
  49. 根据权利要求48所述的探测装置,其特征在于,所述映射关系是根据所述探测装置在所述第一视场方向的最大扫描范围、发射器数量、发射夹角、点云帧率、所述第一转速和所述第二转速确定的。The detection device according to claim 48, wherein the mapping relationship is based on the maximum scanning range of the detection device in the direction of the first field of view, the number of emitters, the included angle of emission, the point cloud frame rate, The first rotational speed and the second rotational speed are determined.
  50. 根据权利要求26至41中任一项所述的探测装置,其特征在于,所述第一光学元件包括棱镜,所述第二光学元件包括反射镜。The detection device according to any one of claims 26 to 41, wherein the first optical element comprises a prism, and the second optical element comprises a mirror.
  51. 一种可移动平台,其特征在于,包括:A mobile platform, characterized in that it comprises:
    平台本体;platform body;
    动力系统,设于所述平台本体上,用于为所述可移动平台提供移动动力;A power system is provided on the platform body and is used to provide moving power for the movable platform;
    权利要求26至50中任一项所述的探测装置,设于所述平台本体上,用于探测外部环境信息。The detecting device according to any one of claims 26 to 50, which is arranged on the platform body and is used for detecting external environment information.
  52. 一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现权利要求1至25中任一项所述的探测装置的视场控制方法。A computer-readable storage medium, characterized in that the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor implements any one of claims 1 to 25. The field of view control method of the detection device.
PCT/CN2021/116540 2021-09-03 2021-09-03 Field of view control method for detection device, detection device, and mobile platform WO2023029005A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2021/116540 WO2023029005A1 (en) 2021-09-03 2021-09-03 Field of view control method for detection device, detection device, and mobile platform

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2021/116540 WO2023029005A1 (en) 2021-09-03 2021-09-03 Field of view control method for detection device, detection device, and mobile platform

Publications (1)

Publication Number Publication Date
WO2023029005A1 true WO2023029005A1 (en) 2023-03-09

Family

ID=85411865

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/116540 WO2023029005A1 (en) 2021-09-03 2021-09-03 Field of view control method for detection device, detection device, and mobile platform

Country Status (1)

Country Link
WO (1) WO2023029005A1 (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5434486A (en) * 1992-06-22 1995-07-18 Fuji Electric Co., Ltd. Synchronous operation system
CN103490678A (en) * 2013-10-17 2014-01-01 双峰格雷斯海姆医药玻璃(丹阳)有限公司 Synchronous control method and system of host and slave computers
CN108712115A (en) * 2018-05-21 2018-10-26 南京航空航天大学 A kind of bi-motor position synchronization control strategy study design
CN110198148A (en) * 2019-04-09 2019-09-03 深圳鳍源科技有限公司 A kind of Multi-motor control method, device, equipment and storage medium
CN110235025A (en) * 2018-04-28 2019-09-13 深圳市大疆创新科技有限公司 Distance detector
CN111868551A (en) * 2019-01-09 2020-10-30 深圳市大疆创新科技有限公司 Distance measuring device, scanning mechanism thereof, control method and movable platform
CN112955783A (en) * 2019-09-27 2021-06-11 深圳市大疆创新科技有限公司 Motor module, scanning module, distance measuring device and control method

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5434486A (en) * 1992-06-22 1995-07-18 Fuji Electric Co., Ltd. Synchronous operation system
CN103490678A (en) * 2013-10-17 2014-01-01 双峰格雷斯海姆医药玻璃(丹阳)有限公司 Synchronous control method and system of host and slave computers
CN110235025A (en) * 2018-04-28 2019-09-13 深圳市大疆创新科技有限公司 Distance detector
CN108712115A (en) * 2018-05-21 2018-10-26 南京航空航天大学 A kind of bi-motor position synchronization control strategy study design
CN111868551A (en) * 2019-01-09 2020-10-30 深圳市大疆创新科技有限公司 Distance measuring device, scanning mechanism thereof, control method and movable platform
CN110198148A (en) * 2019-04-09 2019-09-03 深圳鳍源科技有限公司 A kind of Multi-motor control method, device, equipment and storage medium
CN112955783A (en) * 2019-09-27 2021-06-11 深圳市大疆创新科技有限公司 Motor module, scanning module, distance measuring device and control method

Similar Documents

Publication Publication Date Title
US11592844B2 (en) Image space motion planning of an autonomous vehicle
US11320290B2 (en) Rotation parameter detection method, encoder, laser radar and unmanned aerial vehicle
US11899447B2 (en) Adaptive rate gain controller
US20200346753A1 (en) Uav control method, device and uav
WO2018058442A1 (en) Method and device for panning route, flight control system, omnidirectional obstacle avoidance system, and unmanned aerial vehicle
WO2020103049A1 (en) Terrain prediction method and device of rotary microwave radar, and system and unmanned aerial vehicle
JP6235213B2 (en) Autonomous flying robot
US20220238029A1 (en) Unmanned aerial vehicle return method and apparatus and unmanned aerial vehicle
Wenzel et al. Low-cost visual tracking of a landing place and hovering flight control with a microcontroller
WO2019000345A1 (en) Control method, unmanned aerial vehicle, and computer readable storage medium
WO2019137559A1 (en) Blind zone tracking method for directional antenna, device therefor, and mobile tracking system
CN107102653B (en) Device and method for controlling ground angle of mounting equipment of unmanned aerial vehicle
US20210229810A1 (en) Information processing device, flight control method, and flight control system
JP2021117502A (en) Landing control device, landing control method and program
WO2023029005A1 (en) Field of view control method for detection device, detection device, and mobile platform
EP3822732A1 (en) Control method and apparatus for unmanned aerial vehicle and unmanned aerial vehicle
CN112154480B (en) Positioning method and device for movable platform, movable platform and storage medium
CN110058605A (en) Unmanned aerial vehicle power line patrol control method
WO2022205294A1 (en) Method and apparatus for controlling unmanned aerial vehicle, unmanned aerial vehicle, and storage medium
WO2022227097A1 (en) Method and apparatus for planning route of unmanned aerial vehicle, device, system and storage medium
CN114667462A (en) Laser radar apparatus, system, and control method thereof
WO2022227096A1 (en) Point cloud data processing method, and device and storage medium
WO2018119706A1 (en) Communication method, device, and system based on two-dimensional code
WO2022126559A1 (en) Target detection method and device, platform, and computer-readable storage medium
WO2022188174A1 (en) Movable platform, control method of movable platform, and storage medium

Legal Events

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

Ref document number: 21955538

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21955538

Country of ref document: EP

Kind code of ref document: A1