Ultrasonic sensor array drive control device, ultrasonic sensor array drive control method, and mobile body

The ultrasonic sensor array drive control device addresses the issue of mutual sound wave cancellation by enabling independent control of sensors, ensuring accurate obstacle detection and preventing collisions through single and array control methods, enhancing detection accuracy and speed.

WO2024247525A1PCT designated stage expired Publication Date: 2024-12-05KK TOKAI RIKA DENKI SEISAKUSHO
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
PCT/JP2024/015291
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-05-31
Filing Date
2024-04-17
Publication Date
2024-12-05

AI Technical Summary

Technical Problem

Existing ultrasonic sensor array systems face issues with erroneous obstacle detection due to mutual cancellation of sound waves, leading to potential collisions when multiple robots equipped with the same sensors face each other, as the interference results in no reflected waves being detected.

Method used

An ultrasonic sensor array drive control device and method that allows independent control of each sensor, enabling single control and array control to detect obstacles even when sound waves cancel each other out, by driving and controlling multiple sensors simultaneously or sequentially, and adjusting the directivity range to avoid interference.

Benefits of technology

Prevents erroneous obstacle detection and collision by ensuring reflected waves can be detected, improving detection accuracy and speed, and allowing for precise navigation of moving objects.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure JP2024015291_05122024_PF_FP_ABST
    Figure JP2024015291_05122024_PF_FP_ABST
Patent Text Reader

Abstract

This ultrasonic sensor drive control device drives and controls an ultrasonic sensor array including a plurality of independently controllable ultrasonic sensors. The ultrasonic sensor drive control device comprises a drive control unit that performs individual control for driving and controlling one ultrasonic sensor, and array control for driving and controlling at least two ultrasonic sensors.
Need to check novelty before this filing date? Find Prior Art

Description

Ultrasonic sensor array drive control device, ultrasonic sensor array drive control method, and mobile body

[0001] The present disclosure relates to an ultrasonic sensor array drive control device, an ultrasonic sensor array drive control method, and a moving object.

[0002] Japanese Patent Application Laid-Open Publication No. 2022-113198 discloses a control method for suppressing false detections in the process of detecting objects that interfere with the operation of a mobile body. The invention described in Japanese Patent Application Laid-Open Publication No. 2022-113198 involves determining which of a plurality of sensors to operate in a mobile body, depending on the type of operation of the mobile body and the surrounding environment, in a manner that allows ultrasonic sensors other than the operating sensors to not transmit ultrasonic waves, thereby suppressing the generation of interference waves from inactive ultrasonic sensors and improving the accuracy of object detection based on the distance measurement results of the operating sensors or ultrasonic sensors of other mobile bodies.

[0003] On the other hand, as shown in Fig. 9, for example, when two robots 200A and 200B are using the same ultrasonic sensor 222 to detect obstacles, and these two robots 200A and 200B are facing each other, the sound waves U emitted by each robot are emitted in the same direction. Then, as shown in Fig. 10, the sound waves U emitted by each robot may cancel each other out, resulting in no reflected waves and making it impossible to detect the obstacle. The control method described in JP 2022-113198 A does not disclose a control method for such a case where the sound waves U cancel each other out.

[0004] The present disclosure provides an ultrasonic sensor array drive control device, an ultrasonic sensor array drive control method, and a moving body that can avoid erroneous determination that there is no obstacle due to sound waves canceling each other out.

[0005] An ultrasonic sensor array drive control device of a first aspect of the present disclosure is a drive control device that drives and controls an ultrasonic sensor array having a plurality of ultrasonic sensors that can each be controlled independently, and includes a drive control unit that performs single control to drive and control one of the ultrasonic sensors and array control to drive and control at least two or more of the ultrasonic sensors.

[0006] In the ultrasonic sensor array drive control device according to the first aspect of the present disclosure, in an ultrasonic sensor array including a plurality of independently controllable ultrasonic sensors, single control is performed to drive and control one ultrasonic sensor, and array control is performed to drive and control at least two or more ultrasonic sensors. Therefore, even if the sound waves emitted by the plurality of ultrasonic sensors cancel each other out and no reflected waves are detected when an obstacle is present, the reflected waves can be detected using either single control or array control. This makes it possible to avoid a false determination that no obstacle exists due to the sound waves canceling each other out, thereby avoiding a collision with the obstacle.

[0007] An ultrasonic sensor array drive control device according to a second aspect of the present disclosure has the configuration of the first aspect, wherein the drive control unit drives and controls all of the ultrasonic sensors when performing the array control.

[0008] In the ultrasonic sensor array drive control device according to the second aspect of the present disclosure, all ultrasonic sensors are driven and controlled when performing array control, so that the detection performance of the ultrasonic sensor array can be more appropriately utilized.

[0009] An ultrasonic sensor array drive control device according to a third aspect of the present disclosure is configured as in the first or second aspect, wherein the drive control unit performs the array control after performing the individual control.

[0010] In the ultrasonic sensor array drive control device of the third aspect of the present disclosure, array control is performed after single-unit control, so that single-unit control, which has a faster obstacle detection speed than array control, is performed first. Therefore, obstacles can be detected more quickly. Furthermore, by performing array control, which has a higher directivity than single-unit control, after single-unit control, if an obstacle is not detected by single-unit control, it is possible to change direction and detect the obstacle, thereby improving obstacle detection accuracy.

[0011] The ultrasonic sensor array drive control device of a fourth aspect of the present disclosure is configured in any one of the first to third aspects, in which the array control sweeps at a predetermined angle within the directional range of the ultrasonic sensor array.

[0012] In the ultrasonic sensor array drive control device according to the fourth aspect of the present disclosure, when performing array control, the ultrasonic sensor array sweeps at a predetermined angle within the pointing range of the ultrasonic sensor array, so that obstacles can be detected in multiple directions, thereby further improving the accuracy of obstacle detection.

[0013] The ultrasonic sensor array drive control device of the fifth aspect of the present disclosure is configured in any one of the first to fourth aspects, in which the ultrasonic sensor array is mounted on a moving body, and the drive control unit performs the individual control and the array control while the moving body is in operation.

[0014] In the ultrasonic sensor array drive control device of the fifth aspect of the present disclosure, the ultrasonic sensor array is mounted on a moving body, and individual control and array control are performed while the moving body is in operation, so that it is possible to avoid a false determination that there is no obstacle due to the sound waves canceling each other out while the moving body is in operation, and it is possible to avoid collisions with obstacles.

[0015] An ultrasonic sensor array drive control device of a sixth aspect of the present disclosure is configured in any one of the first to fifth aspects, in which the ultrasonic sensor array is mounted on a moving body, and the drive control unit determines the direction of travel of the moving body based on the detection result of an obstacle by the ultrasonic sensor array.

[0016] In the ultrasonic sensor array drive control device of the sixth aspect of the present disclosure, the ultrasonic sensor array is mounted on a moving body, and the direction of travel of the moving body is determined based on the detection results of an obstacle by the ultrasonic sensor array, thereby making it possible to avoid collisions with obstacles.

[0017] An ultrasonic sensor array drive control method according to a seventh aspect of the present disclosure is a drive control method for driving and controlling an ultrasonic sensor array having a plurality of ultrasonic sensors that can each be controlled independently, and performs single control for driving and controlling one of the ultrasonic sensors, and array control for driving and controlling at least two or more of the ultrasonic sensors.

[0018] According to the ultrasonic sensor array drive control method of the seventh aspect of the present disclosure, it is possible to obtain the same effects as those of the ultrasonic sensor array drive control device of the first aspect.

[0019] A moving body according to an eighth aspect of the present disclosure is equipped with an ultrasonic sensor array that is driven and controlled by the ultrasonic sensor array drive control method according to the seventh aspect.

[0020] According to the moving body of the eighth aspect of the present disclosure, similar effects to those of the ultrasonic sensor array drive control method of the seventh aspect and the ultrasonic sensor array drive control device of the first aspect can be obtained.

[0021] As described above, the ultrasonic sensor array drive control device, ultrasonic sensor array drive control method, and moving body disclosed herein have the advantage of being able to avoid erroneous determinations that there is no obstacle due to sound waves canceling each other out.

[0022] FIG. 1 is a configuration diagram schematically showing the configuration of a moving body according to an embodiment of the present disclosure. FIG. 1 is a configuration diagram schematically showing the configuration of an ultrasonic sensor system including an ultrasonic sensor array drive control device according to an embodiment of the present disclosure. FIG. 2 is a schematic diagram showing the generation of sound waves by an ultrasonic sensor during single-unit control. FIG. 3 is a schematic diagram showing the generation of sound waves by an ultrasonic sensor during array control. FIG. 4 is a flowchart showing an example of the flow of drive control processing by the drive control device. FIG. 5 is a flowchart showing an example of the flow of collision avoidance processing by the drive control device. FIG. 6 is an explanatory diagram explaining the movement of a moving body when an obstacle is detected during single-unit control. FIG. 7 is an explanatory diagram explaining the movement of a moving body when an obstacle is detected during array control. FIG. 8 is an explanatory diagram explaining the conventional state of sound wave generation when two moving bodies face each other head-on. FIG. 9 is an explanatory diagram explaining the conventional state of received waves when two moving bodies face each other head-on. FIG. 10 is a configuration diagram schematically showing the hardware configuration of a drive control device.

[0023] 1 to 4 , an ultrasonic sensor system 10 including a drive control device 30 as an ultrasonic sensor array drive control device according to an embodiment of the present disclosure will be described. The ultrasonic sensor system 10 of this embodiment uses ToF (Time of Flight) technology, which measures distance from the speed of sound based on the time interval between a transmitted wave consisting of ultrasonic waves and a reflected wave that returns after the transmitted wave is reflected by an object. The ultrasonic sensors 22 mounted on the ultrasonic sensor array 20 of the ultrasonic sensor system 10 of this embodiment are formed, for example, using microfabrication technology (MEMS: Micro Electro Mechanical Systems) that processes silicon or the like to form minute elements.

[0024] FIG. 1 is a diagram schematically illustrating the configuration of a moving body 100 according to an embodiment of the present disclosure, and FIG. 2 is a diagram schematically illustrating the configuration of an ultrasonic sensor system 10 including a drive control device 30 according to an embodiment of the present disclosure. As shown in FIG. 1, the ultrasonic sensor system 10 including the drive control device 30 according to an embodiment of the present disclosure is mounted on the moving body 100. The moving body 100 is configured to be capable of autonomous travel, for example, and may be a cleaning robot, a humanoid robot that serves food, a pet robot, or the like. The moving body 100 includes a drive unit (not shown), and the drive unit is drive-controlled by a drive control unit 32, which will be described later.

[0025] 2, the ultrasonic sensor system 10 of this embodiment includes an ultrasonic sensor array 20 and a drive control device 30. The ultrasonic sensor array 20 includes a plurality of ultrasonic sensors 22, which are arranged to form a one-dimensional array or a two-dimensional array. Each of the ultrasonic sensors 22 includes a vibrator (not shown) that generates a transmission wave 40 as an ultrasonic wave based on an input control signal, and each sensor is configured to be independently controllable.

[0026] The vibrating body is configured to include, for example, a substrate (not shown), a diaphragm (not shown), and a piezoelectric film (not shown), and when a voltage is applied to the piezoelectric film, the piezoelectric film expands and contracts, and this expansion and contraction causes the diaphragm to vibrate, thereby vibrating the vibrating body. This vibration of the vibrating body generates a transmission wave 40. Furthermore, for example, each of the multiple ultrasonic sensors 22 has a drive circuit (not shown) that includes a boost circuit, an amplifier, and the like, and the drive circuit applies a voltage to the vibrating body based on a control signal output from a drive control unit 32, which will be described later.

[0027] Furthermore, when the vibrator receives reflected waves 50, which are the transmitted waves 40 reflected by an obstacle OB, the reflected waves 50 cause the diaphragm to vibrate, and this vibration deforms the piezoelectric film, generating a voltage. As an example, each of the multiple ultrasonic sensors 22 includes an ultrasonic microphone (not shown) that receives the reflected waves 50 and converts them into an electrical signal, an amplifier (not shown), and a receiving circuit (not shown) that includes an A / D converter, etc. Then, the output signal of the voltage generated when the piezoelectric film of the vibrator is deformed by the reflected waves 50 is amplified by the receiving circuit, converted from an analog signal to a digital signal, and output to an obstacle detection unit 34, which will be described later.

[0028] As shown in FIG. 11 , the drive control device 30 includes a CPU (Central Processing Unit) 70, a ROM (Read Only Memory) 71, a RAM (Random Access Memory) 72, a storage 73, a communication interface (communication I / F) 74, and an input / output interface (input / output I / F) 75. Each component is connected to each other via a bus 76 so as to be able to communicate with each other. The storage 73 is realized by a non-volatile storage medium such as an HDD (Hard Disk Drive) or an SSD (Solid State Drive). The input / output I / F 74 is connected to the drive circuit and receiving circuit described above via wiring.

[0029] The drive control device 30 uses the above hardware resources to realize various functions. Specifically, as shown in Fig. 2, the drive control device 30 is configured to include, as functional components, a drive control unit 32 and an obstacle detection unit 34. Note that each functional component is realized by the CPU 70 serving as a processor reading and executing a program stored in the ROM 71 serving as a memory or the storage 73 serving as a memory.

[0030] The drive control unit 32 performs single control, which drives and controls one ultrasonic sensor 22, and array control, which drives and controls at least two or more ultrasonic sensors 22. In this embodiment, as an example, the drive control unit 32 drives and controls all of the ultrasonic sensors 22 when performing array control.

[0031] FIG. 3 is a schematic diagram illustrating the generation of sound waves by an ultrasonic sensor during single-unit control. As shown in FIG. 3, the drive control unit 32 inputs a waveform to one of the ultrasonic sensors 22, thereby driving the vibrator of that ultrasonic sensor 22. The drive control unit 32 inputs a continuous square wave at the resonant frequency. Note that the waveform input by the drive control unit 32 is not limited to a square wave, and may be a waveform of any shape, such as a sine wave. In addition, in this embodiment, as an example, the drive control unit 32 individually controls the ultrasonic sensor 22 arranged approximately in the center of the multiple ultrasonic sensors 22.

[0032] FIG. 4 is a schematic diagram illustrating the generation of sound waves by ultrasonic sensors during array control. As shown in FIG. 4, the drive control unit 32 inputs waveforms to the multiple ultrasonic sensors 22 to drive the vibrators of the ultrasonic sensors 22. In this case, the drive control unit 32 delays the timing of inputting the waveforms toward the top in the vertical direction of the drawing. This causes the inclination of the wavefront 24 of the transmission wave 40 transmitted by the multiple ultrasonic sensors 22 to differ from the inclination of the wavefront 26 of the transmission wave 40 transmitted by a single ultrasonic sensor 22 shown in FIG. 3. By making the wavefront 24 in array control different from the wavefront 26 in single-unit control, the propagation direction of the transmission wave 40 can be made different from that in single-unit control.

[0033] 4 , i.e., the further downward the distance from the ultrasonic sensor 22 the further away from the ultrasonic sensor 22 the wavefront 24 becomes. During array control, the drive control unit 32 can change the tilt and amplitude of the wavefront 24 of the transmission wave 40 as needed to change the directivity range of the ultrasonic sensor 22. The tilt angle of the wavefront 24 of the transmission wave 40 can be changed within the possible directivity range.

[0034] The drive control unit 32 also inputs a continuous rectangular wave at the resonant frequency during array control. Note that the waveform input by the drive control unit 32 is not limited to a rectangular wave, and may be a waveform of any shape, such as a sine wave.

[0035] Furthermore, when the obstacle detection unit 34 detects an obstacle OB, the drive control unit 32 performs a collision avoidance process to avoid a collision with the moving body 100. Specific examples of the collision avoidance process include changing the direction of travel of the moving body 100, stopping the moving body 100, slowing down the speed of the moving body 100, and slowing down the speed of the moving body 100 and changing the direction of travel. The collision avoidance process will be described in detail later.

[0036] The drive control unit 32 determines the direction of travel of the moving body 100 based on the detection result of the obstacle OB by the obstacle detection unit 34, and drives and controls the moving body 100 so that the moving body 100 travels along the determined direction of travel.

[0037] The obstacle detection unit 34 detects the presence or absence of an obstacle OB. Specifically, the obstacle detection unit 34 detects whether or not a reflected wave 50 has been received based on the outputs from the multiple ultrasonic sensors 22. When the obstacle detection unit 34 detects the reception of a reflected wave 50, it detects that an obstacle OB is present.

[0038] In this embodiment, the obstacle detection unit 34 detects the presence or absence of an obstacle OB, but the present disclosure is not limited to this. For example, the obstacle detection unit 34 may detect the distance L to the obstacle OB based on the time TR from when the transmission wave 40 is transmitted until when the reflected wave 50 is received. Since ultrasonic waves are sound, they propagate through the air at the speed of sound C. Therefore, the distance L to the obstacle OB can be derived using the following formula (1): L = 1 / 2 × TR × C (1)

[0039] Next, a drive control method for the ultrasonic sensor array 20 by the drive control device 30 of this embodiment will be described. The drive control unit 32 performs the above-mentioned individual control and array control during operation of the moving body 100. Figure 5 is a flowchart showing an example of the flow of the drive control process of the drive control device 30.

[0040] 5 , in step S11, the drive control unit 32 performs individual control on the ultrasonic sensor array 20. That is, the drive control unit 32 inputs a waveform signal to one ultrasonic sensor 22. Next, in step S12, the ultrasonic sensor 22 to which the waveform signal has been input emits a transmission wave (sound wave) 40.

[0041] In step S13, the obstacle detection unit 34 determines whether the reflected wave 50 has been detected. Here, the obstacle detection unit 34 waits for, for example, 12 ms after the ultrasonic sensor 22 emits the transmission wave 40 until the reflected wave 50 is detected. In this embodiment, as an example, the obstacle detection unit 34 wants to detect the obstacle OB when the obstacle OB enters within 2 m of the mobile object 100. That is, when the time TR from the transmission of the transmission wave 40 to the reception of the reflected wave 50 is calculated based on the above-mentioned equation (1), the distance L is 2 m, and therefore the following equation (2) is obtained. Note that the speed of sound C is 340 m / s.

[0042] TR=2×L / C=2×2 / 340=11.76(ms)...(2)

[0043] In this embodiment, the waiting time is set to 12 ms based on the above formula (2). If the obstacle detection unit 34 does not detect the reflected wave 50 within 12 ms, it determines that the obstacle OB is not present within 2 m.

[0044] If the obstacle detection unit 34 detects the reflected wave 50 within 12 ms in step S13 (step S13; YES), the drive control unit 32 performs collision avoidance processing in step S14. On the other hand, if the obstacle detection unit 34 does not detect the reflected wave 50 within 12 ms in step S13 (step S13; NO), the drive control unit 32 performs array control in step S15. That is, the drive control unit 32 inputs waveform signals to all of the multiple ultrasonic sensors 22 at different timings.

[0045] Next, in step S16, the ultrasonic sensor 22 emits transmission waves (sound waves) 40 in the order in which the waveform signals were input. That is, in step S16, the transmission waves 40 are emitted in a direction different from that of the transmission waves 40 in step S12, and therefore the directivity range is different.

[0046] In step S17, the obstacle detection unit 34 determines whether or not the reflected wave 50 has been detected. If the obstacle detection unit 34 detects the reflected wave 50 within 12 ms (step S17; YES), the drive control unit 32 performs collision avoidance processing in step S14. On the other hand, if the obstacle detection unit 34 does not detect the reflected wave 50 within 12 ms (step S17; NO), in step S18, the drive control unit 32 performs sweeping at a predetermined angle within the directivity range of the ultrasonic sensor array 20.

[0047] Specifically, in step 16, the angle of the wavefront 24 at which the ultrasonic sensor array 20 generated the transmission wave 40 is changed by a predetermined angle, and the drive control unit 32 inputs waveform signals at different timings to all of the ultrasonic sensors 22. In this embodiment, the predetermined angle is set to ±2 degrees, as an example.

[0048] In step S19, the ultrasonic sensor 22 emits transmission waves (sound waves) 40 in the order that the waveform signals were input. That is, in step S19, the transmission waves 40 are emitted in a direction different from that of the transmission waves 40 in step S16, and therefore the directivity range is different.

[0049] In step S20, the obstacle detection unit 34 determines whether or not a reflected wave 50 has been detected. If the obstacle detection unit 34 detects the reflected wave 50 within 12 ms (step S20; YES), the drive control unit 32 performs collision avoidance processing in step S14. On the other hand, if the obstacle detection unit 34 does not detect the reflected wave 50 within 12 ms (step S20; NO), the drive control unit 32 determines in step S21 whether sweeping within the pointable range of the ultrasonic sensor array 20 has been completed. If it is determined that sweeping within the pointable range of the ultrasonic sensor array 20 has not been completed (step S21; NO), the drive control unit 32 sweeps at a predetermined angle within the pointable range of the ultrasonic sensor array 20 until the obstacle detection unit 34 detects the reflected wave 50 or until sweeping within the pointable range of the ultrasonic sensor array 20 is completed. In other words, the process from step S18 onward is repeated.

[0050] On the other hand, if the drive control unit 32 determines in step S21 that sweeping within the directivity range of the ultrasonic sensor array 20 has been completed (step S21; YES), the drive control unit 32 proceeds to step S11 and continues processing from step S11 onwards.

[0051] FIG. 6 is a flowchart showing an example of the flow of collision avoidance processing by the drive control unit 32. Here, the collision avoidance processing will be described below using an example in which two moving bodies 100 are operating. The two moving bodies 100 are a first moving body 100A and a second moving body 100B, respectively (see FIGS. 7 and 8). As shown in FIG. 6, in step S31, N=1 is set, where N represents a natural number. Next, in step S32, the drive control unit 32 decelerates the traveling speed of the first moving body 100A and the second moving body 100B.

[0052] In step S33, the drive control unit 32 determines the detection state of the obstacle detection unit 34. FIG. 7 is an explanatory diagram illustrating the movement of the moving bodies 100 (first moving body 100A and second moving body 100B) when an obstacle OB is detected during single-unit control, and FIG. 8 is an explanatory diagram illustrating the movement of the moving bodies 100 (first moving body 100A and second moving body 100B) when an obstacle OB is detected during array control. In FIGS. 7 and 8, the white moving body indicates the first moving body 100A, and the colored moving body indicates the second moving body 100B. Furthermore, the white and colored dotted arrows D1 indicate the respective traveling directions, and the white and colored arrows D2 and D3 indicate the respective traveling directions after a course change. The thin-line arrow D4 indicates the direction of the sound waves (transmitted wave 40, reflected wave 50).

[0053] In step S33, if the obstacle detection unit 34 detects an obstacle OB through single-unit control (step S33; single-unit control), the drive control unit 32 changes the traveling direction of the moving body 100 by 45 degrees to the left, for example. As shown in FIG. 7 , the first moving body 100A and the second moving body 100B are traveling in the left-right direction of the drawing, as indicated by arrow D1. In this state, when an obstacle OB is detected through single-unit control, the drive control unit 32 changes the course of the first moving body 100A and the second moving body 100B by 45 degrees to the left, i.e., 45 degrees counterclockwise, relative to their respective traveling directions (arrow D1). In other words, the first moving body 100A and the second moving body 100B change their traveling direction in the direction indicated by arrow D2.

[0054] Next, in step S35, the drive control unit 32 performs individual control on the ultrasonic sensor array 20. That is, the drive control unit 32 inputs a waveform signal to one ultrasonic sensor 22. Next, in step S36, the ultrasonic sensor 22 to which the waveform signal has been input emits a transmission wave (sound wave) 40.

[0055] In step S37, the obstacle detection unit 34 determines whether or not the reflected wave 50 is detected. If the reflected wave 50 is not detected (step S37; NO), the drive control unit 32 changes the traveling direction of the moving body 100 by 45 degrees to the right, for example. As shown in FIG. 7 , the first moving body 100A and the second moving body 100B are currently traveling in the direction indicated by arrow D2 in step S34. The course is changed 45 degrees to the right, i.e., 45 degrees clockwise, from this current traveling direction (arrow D2). In other words, by changing the traveling direction of the first moving body 100A and the second moving body 100B to the direction indicated by arrow D3, the traveling direction is returned to the original traveling direction (arrow D1).

[0056] Next, in step S40, the drive control unit 32 returns the travel speeds of the first moving body 100A and the second moving body 100B to their original travel speeds, ends the collision avoidance process, and proceeds to S22 in FIG.

[0057] On the other hand, if the reflected wave 50 is detected by the obstacle detection unit 34 in step S37 (step S37; YES), the drive control unit 32 adds "1" to N in step S38 and performs the processing from step S34 onwards. Note that if the processing from step S34 onwards is performed after the processing of step S38, when changing the traveling direction of the first moving body 100A and the second moving body 100B in step S39, the course is changed 45×N degrees to the right.

[0058] On the other hand, if the obstacle detection unit 34 detects an obstacle OB by array control in step S33 (step S33; array control), in step S41, the drive control unit 32 changes the traveling direction of the moving body 100 by θ degrees, for example, in the direction opposite to the detection direction of the obstacle OB. As shown in FIG. 8 , the first moving body 100A and the second moving body 100B are traveling in the left-right direction of the page, as indicated by arrow D1. Note that in array control, the traveling directions (arrow D1) of the first moving body 100A and the second moving body 100B are different from the sound wave direction indicated by arrow D4. Specifically, the traveling directions (arrow D1) of the first moving body 100A and the second moving body 100B are rotated counterclockwise by θ degrees with respect to the sound wave direction.

[0059] In this state, when an obstacle OB is detected by array control, the drive control unit 32 changes the course of the first moving body 100A and the second moving body 100B by θ degrees in the direction opposite to the sound wave direction indicated by arrow D4, i.e., the detection direction of the obstacle OB, with respect to their respective traveling directions (arrow D1), i.e., θ degrees counterclockwise. In other words, the first moving body 100A and the second moving body 100B change their traveling directions to the direction indicated by arrow D2.

[0060] Next, in step S42, the drive control unit 32 performs individual control on the ultrasonic sensor array 20. That is, the drive control unit 32 inputs a waveform signal to one ultrasonic sensor 22. Next, in step S43, the ultrasonic sensor 22 to which the waveform signal has been input emits a transmission wave (sound wave) 40.

[0061] In step S44, the obstacle detection unit 34 determines whether or not the reflected wave 50 has been detected. If the reflected wave 50 has not been detected (step S44; NO), the drive control unit 32 changes the traveling direction of the moving body 100 to the right by θ degrees, for example. As shown in FIG. 8 , the first moving body 100A and the second moving body 100B are currently traveling in the direction indicated by arrow D2 in step S41. The course is changed θ degrees to the right, i.e., θ degrees clockwise, from this current traveling direction (arrow D2). In other words, by changing the traveling direction of the first moving body 100A and the second moving body 100B to the direction indicated by arrow D3, the traveling direction is returned to the original traveling direction (arrow D1).

[0062] Next, in step S40, the drive control unit 32 returns the travel speeds of the first moving body 100A and the second moving body 100B to their original travel speeds, ends the collision avoidance process, and proceeds to S22 in FIG.

[0063] On the other hand, if the reflected wave 50 is detected by the obstacle detection unit 34 in step S44 (step S44; YES), the drive control unit 32 increments N by 1 in step S46 and performs the processes in step S41 and subsequent steps. Note that if the processes in step S41 and subsequent steps are performed after the process in step S46, the courses of the first moving body 100A and the second moving body 100B are changed counterclockwise by θ×N degrees when the traveling directions of the first moving body 100A and the second moving body 100B are changed in step S45.

[0064] Next, in step S40, the drive control unit 32 returns the travel speeds of the first moving body 100A and the second moving body 100B to their original travel speeds, ends the collision avoidance process, and proceeds to S22 in FIG.

[0065] 5, in step S22, the drive control unit 32 detects whether the moving body 100 has stopped, and if it has not stopped (step S22; NO), the drive control device 30 proceeds to step S11 and repeats the processes from step S11 onwards. On the other hand, if the moving body 100 has stopped in step S22 (step S22; YES), the drive control device 30 ends the drive control process.

[0066] Next, the operation and effects of this embodiment will be described.

[0067] According to the drive control device 30, the drive control method for the ultrasonic sensor array 20, and the moving body 100 of this embodiment, the ultrasonic sensor array 20 includes a plurality of independently controllable ultrasonic sensors 22. The drive control method repeatedly performs single control, which drives and controls one ultrasonic sensor 22, and array control, which drives and controls all of the plurality of ultrasonic sensors 22. Therefore, even if the sound waves (transmission waves 40) emitted by the plurality of ultrasonic sensors 22 cancel each other out and no reflected waves 50 are present when an obstacle OB is present, the reflected waves 50 can be detected by either the repeated single control or array control. This avoids a false determination that no obstacle OB exists due to the sound waves (transmission waves 40) canceling each other out, thereby avoiding a collision with the obstacle OB.

[0068] Furthermore, according to the drive control device 30, the drive control method for the ultrasonic sensor array 20, and the moving body 100 of this embodiment, all ultrasonic sensors 22 are driven and controlled when performing array control, so that the detection performance of the ultrasonic sensor array 20 can be more appropriately utilized.

[0069] Furthermore, according to the drive control device 30, the drive control method for the ultrasonic sensor array 20, and the moving body 100 of this embodiment, array control is performed after single-unit control, so that single-unit control, which has a faster obstacle OB detection speed compared to array control, is performed first. Therefore, obstacles OB can be detected more quickly. Furthermore, by performing array control, which has a higher directivity compared to single-unit control, after single-unit control, if an obstacle OB is not detected by single-unit control, it is possible to change direction and detect the obstacle OB, thereby improving the accuracy of obstacle OB detection.

[0070] Furthermore, according to the drive control device 30, the drive control method for the ultrasonic sensor array 20, and the moving body 100 of this embodiment, when array control is performed, the ultrasonic sensor array 20 sweeps at a predetermined angle within its directivity range, making it possible to detect obstacles OB in multiple directions, thereby further improving the accuracy of detecting obstacles OB.

[0071] Furthermore, according to the drive control device 30, the drive control method for the ultrasonic sensor array 20, and the moving body 100 of this embodiment, the ultrasonic sensor array 20 is mounted on the moving body 100, and individual control and array control are performed while the moving body 100 is in operation. Therefore, while the moving body 100 is in operation, it is possible to avoid a false determination that there is no obstacle OB due to the sound waves (transmission waves 40) canceling each other out, and it is possible to avoid a collision with the obstacle OB.

[0072] Furthermore, according to the drive control device 30, the drive control method for the ultrasonic sensor array 20, and the moving body 100 of this embodiment, the ultrasonic sensor array 20 is mounted on the moving body 100, and the direction of travel of the moving body 100 is determined based on the detection result of the obstacle OB by the ultrasonic sensor array 20, so that a collision with the obstacle OB can be avoided.

[0073] [Supplementary Explanation of the Embodiment] In the above-described embodiment, the drive control unit 32 controls the drive of all of the ultrasonic sensors 22 when performing array control, but the present disclosure is not limited to this. For example, the multiple ultrasonic sensors 22 may be divided into two at the center and only the ultrasonic sensors 22 at one end may be controlled and driven, or the multiple ultrasonic sensors 22 may be divided using another division method and only some of the ultrasonic sensors 22 may be controlled and driven. Furthermore, the multiple ultrasonic sensors 22 located in the multiple divided regions may be swept for each region.

[0074] In the above-described embodiment, the drive control unit 32 performs single-unit control and then array control, but the present disclosure is not limited to this. For example, the drive control unit 32 may perform array control and then single-unit control, or may alternate between single-unit control and array control, or other suitable modifications may be made.

[0075] Furthermore, in the above-described embodiment, the obstacle detection unit 34 is configured to detect an obstacle OB when the obstacle OB enters within 2 m of the moving body 100, but the present disclosure is not limited to this. The detection range changes depending on the specifications of the moving body 100, such as the type and size, and the specifications of the ultrasonic sensor array 20 provided on the moving body 100. In this case, the time TR from when the transmission wave 40 is transmitted until when the reflected wave 50 is received can be found based on the above-described equation (2).

[0076] In addition, in the above-described embodiment, the drive control unit 32 performs the single-unit control and the array control while the moving body 100 is in operation, but the present disclosure is not limited to this. The drive control unit 32 may also perform the single-unit control and the array control when the moving body 100 is stationary.

[0077] In the above-described embodiment, the collision avoidance process by the drive control unit 32 is performed as shown in Figures 6 to 8, but the present disclosure is not limited to this. For example, the method of changing the traveling direction, specific values, etc. can be changed as appropriate. Also, the vehicle may simply be stopped without changing its traveling direction.

[0078] In addition, various processors other than a CPU may execute the processes executed by the CPU 70 shown in FIG. 11 after reading software (programs) in the above embodiment. Examples of processors in this case include programmable logic devices (PLDs) (such as field-programmable gate arrays (FPGAs)) whose circuit configuration can be changed after manufacture, and dedicated electrical circuits, such as application-specific integrated circuits (ASICs), which are processors having circuit configurations specifically designed to execute specific processes. Each process may be executed by one of these various processors, or by a combination of two or more processors of the same or different types (e.g., multiple FPGAs, or a combination of a CPU and an FPGA). The hardware structure of these various processors is, more specifically, an electrical circuit that combines circuit elements such as semiconductor devices.

[0079] The programs described in the above embodiments may be provided in a form stored on a non-transitory storage medium such as a CD-ROM (Compact Disc Read Only Memory), a DVD-ROM (Digital Versatile Disc Read Only Memory), or a USB (Universal Serial Bus) memory. The programs may also be downloaded from an external device via a network.

[0080] The above describes one example of the present disclosure, but the present disclosure is not limited to the above, and it goes without saying that it can be implemented in various modifications within the scope of the gist of the present disclosure.

[0081] The disclosure of Japanese Patent Application No. 2023-090335, filed on May 31, 2023, is incorporated herein by reference in its entirety.

[0082] All publications, patent applications, and technical standards mentioned in this specification are herein incorporated by reference to the same extent as if each individual publication, patent application, or technical standard was specifically and individually indicated to be incorporated by reference.

Claims

1. A drive control device that drives and controls an ultrasonic sensor array having multiple ultrasonic sensors that can each be controlled independently, the drive control device including a drive control unit that performs single control to drive and control one of the ultrasonic sensors and array control to drive and control at least two or more of the ultrasonic sensors.

2. The ultrasonic sensor array drive control device according to claim 1, wherein the drive control section drives and controls all of the ultrasonic sensors when performing the array control.

3. An ultrasonic sensor array drive control device according to claim 1, wherein the drive control section performs the array control after performing the individual control.

4. The ultrasonic sensor array drive control device according to claim 1, wherein said array control comprises sweeping at a predetermined angle within the directivity range of said ultrasonic sensor array.

5. An ultrasonic sensor array drive control device as described in claim 1, wherein the ultrasonic sensor array is mounted on a moving body, and the drive control unit performs the individual control and the array control while the moving body is in operation.

6. The ultrasonic sensor array drive control device according to claim 1, wherein the ultrasonic sensor array is mounted on a moving body, and the drive control unit determines the direction of travel of the moving body based on the result of obstacle detection by the ultrasonic sensor array.

7. A drive control method for controlling an ultrasonic sensor array having a plurality of ultrasonic sensors that can be controlled independently, the drive control method performing single control for controlling one of the ultrasonic sensors and array control for controlling the drive of at least two or more of the ultrasonic sensors.

8. A moving object equipped with an ultrasonic sensor array that is driven and controlled by the ultrasonic sensor array drive control method according to claim 7.

Citation Information

Patent Citations

  • Electronic apparatus, method for controlling electronic apparatus, and control program for electronic apparatus

    JP2020034403A

  • Controller, program, control method for moving object, and moving object

    JP2022113198A

  • Sonar system and method

    US20220326377A1

  • Obstacle detection device

    WO2011061785A1