Driving control device
By positioning sensors vertically above the vehicle's center of gravity within a driving control device, the system addresses sensor vibration issues, improving obstacle detection accuracy and autonomous driving reliability.
Patent Information
- Application Number
- JP2023174885
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-10-10
- Publication Date
- 2025-04-22
AI Technical Summary
Existing autonomous driving systems face challenges in accurately detecting obstacles due to sensor vibrations caused by vehicle movements, particularly when sensors like LiDAR are added as afterthoughts.
A driving control device is designed with a housing attached to the vehicle, a sensor (such as LiDAR) positioned vertically above the vehicle's center of gravity, and a circuit for controlling vehicle travel based on sensor detection results. This configuration suppresses sensor shaking and improves detection accuracy.
The solution effectively reduces sensor vibrations, enhancing the accuracy of obstacle detection and improving the overall reliability of autonomous driving systems.
Smart Images

Figure 2025065596000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a cruise control device. [Background technology]
[0002] Patent Document 1 discloses a control device used for remotely monitoring a plurality of automatically-operated vehicles that are configured to be switchable between an autonomous driving mode and a remote control mode. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Patent No. 2022-179577 Summary of the Invention [Problem to be solved by the invention]
[0004] Autonomous driving requires the vehicle to be equipped with sensors that detect obstacles, such as LiDAR. However, if such sensors are added to a vehicle after the fact, the sensors are likely to be subject to significant vibrations from the vehicle.
[0005] In view of the above circumstances, the present invention provides a driving control device and the like that is capable of suppressing vibration of a sensor that is retrofitted to a vehicle. [Means for solving the problem]
[0006] According to one aspect of the present invention, there is provided a driving control device comprising: a housing attached to a vehicle; a sensor attached to the housing and configured to emit electromagnetic waves to detect an obstacle; and a circuit for controlling the driving of the vehicle based on the detection result of the sensor. The sensor is disposed vertically above an area that may be the center of gravity of the vehicle.
[0007] According to this aspect, it is possible to suppress the vibration of the sensor that is retrofitted to the vehicle. [Brief description of the drawings]
[0008] [Figure 1] 1 is a diagram showing an example of an overall configuration of a vehicle system 1. FIG. [Diagram 2] 1 is a diagram showing an example of the configuration of a vehicle 10 and a remote control 20. FIG. [Diagram 3] FIG. 1 is a perspective view of a vehicle system 1. [Figure 4] FIG. 2 is a front view of the vehicle system 1. [Diagram 5] FIG. 2 is a side view of the vehicle system 1. [Figure 6] FIG. 2 is a rear view of the vehicle system 1. [Figure 7] FIG. 2 is a plan view of the vehicle system 1. [Figure 8] FIG. 2 is a diagram showing the mounting position of the LiDAR 42. [Figure 9] 1 is a diagram showing an example of a LiDAR 42 attached to a housing 46. FIG. [Figure 10] 1A and 1B are diagrams showing a method of attaching the LiDAR 42 to the housing 46. [Figure 11] FIG. 13 is a diagram showing an example of an area in which markers are placed. [Figure 12] FIG. 1 is a diagram showing an example of a LiDAR 42 attached to a housing 46a. [Figure 13] FIG. 13 is a diagram showing an example of a LiDAR 42 attached to a housing 46b. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0009] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, embodiments of the present invention will be described with reference to the drawings. Various characteristic features shown in the following embodiments can be combined with each other.
[0010] <Embodiment> FIG. 1 is a diagram showing an example of the overall configuration of a vehicle system 1. The vehicle system 1 is a system for driving a vehicle to perform a predetermined task. The predetermined task is, for example, mowing a grass in a predetermined area such as a field. The vehicle system 1 includes a vehicle 10, a remote control 20, an attachment member 30, and a function addition device 40. Of these, the vehicle 10 and the remote control 20 are existing products, and the vehicle system 1 is configured by later attaching the attachment member 30 and the function addition device 40. The existing product part will be described below first.
[0011] 2 is a diagram showing an example of the configuration of vehicle 10 and remote control 20. Vehicle 10 has a driving function and a working function, and performs a predetermined task while driving. Remote control 20 has a wireless communication function and is a controller that remotely controls vehicle 10. Vehicle 10 includes an operation control circuit 11, a drive unit 12, a driving unit 13, a working unit 14, a fuel supply unit 15, a communication unit 16, and a transmission unit 17. Remote control 20 includes an operation unit 21, a communication unit 22, and a display panel 23.
[0012] The operation control circuit 11 is a circuit that controls the operation of each part of the vehicle 10. The circuit is an electronic component in which electronic components are arranged on a printed circuit board. The circuit can include both electronic circuits and electric circuits. The drive unit 12 is a part that generates a driving force. In the vehicle 10, the engine that rotates by burning fuel generates electric power, charges a battery with the generated electric power, and generates a driving force by rotating an electric motor with the charged electric power. The running unit 13 is mechanically connected to the drive unit 12 via gears or the like, and is a part that receives a driving force from the drive unit 12 to run the vehicle 10. In the vehicle 10, the running unit 13 is an endless track called a caterpillar (registered trademark) or the like.
[0013] The working unit 14 is mechanically connected to the drive unit 12 via gears and the like, and is a part that performs a predetermined work by receiving driving force from the drive unit 12. In the vehicle 10, the working unit 14 is a cutter that cuts grass by rotating a cutting blade. The fuel supply unit 15 stores fuel and supplies the stored fuel to the drive unit 12. The communication unit 16 has a wireless communication function and performs wireless communication with the remote control 20. The communication unit 16 receives an operation signal (described in detail later) transmitted from the remote control 20 and supplies the operation signal to the transmission unit 17.
[0014] The transmission unit 17 is a path for transmitting an electric signal, and transmits the supplied operation signal to the operation control circuit 11. The operation control circuit 11 controls the operation of each unit (the drive unit 12, the traveling unit 13, and the working unit 14) based on the transmitted operation signal. At the same time, the operation control circuit 11 generates status information indicating the operating status of each unit, converts the generated status information into a signal, and transmits it to the remote control 20 via the transmission unit 17 and the communication unit 16. The status information is information indicating the traveling speed, traveling direction, whether the working unit 14 is operating, etc.
[0015] The operation unit 21 has an operation lever, accepts operations of the vehicle 10 by the operator, and generates an operation signal indicating the content of the accepted operation. Operations of the vehicle 10 include moving forward, backward, turning left, turning right, and turning the working unit 14 on and off. The communication unit 22 wirelessly transmits the operation signal generated by the operation unit 21 to the vehicle 10. The communication unit 22 also receives status information transmitted from the vehicle 10. The display panel 23 displays the received status information of the vehicle 10 (e.g., whether it is running or the cutter is operating).
[0016] Returning to FIG. 1, the explanation will be given. The function-adding device 40 can be attached to various vehicles, not limited to the vehicle 10, and an attachment member that matches the shape of the vehicle is used. The attachment member 30 is an attachment member that matches the shape of the vehicle 10. The attachment member 30 includes a common shape portion 31 and an individual shape portion 32. The common shape portion 31 is the portion to which the function-adding device 40 is fixed, and has a common shape regardless of the vehicle to which the attachment member 30 is attached. The individual shape portion 32 is the portion that is fixed to the vehicle, and has a shape that matches the individual vehicle.
[0017] The function adding device 40 is a device that adds a function to the vehicle 10. In the example of FIG. 1, the function adding device 40 functions as a driving control device that adds an autonomous driving function to the vehicle 10. The autonomous driving function is a function that causes the vehicle 10 to drive autonomously without operation by an operator. The function adding device 40 includes a function adding circuit 41, a LiDAR 42, an imaging unit 43, a detouring unit 44, a cable 45, a housing 46, a first vibration isolating member 47, and a second vibration isolating member 48.
[0018] The function addition circuit 41 is a circuit that realizes a function to be added to the vehicle 10. The circuit is an electronic component in which electronic components are arranged on a printed circuit board, similar to the operation control circuit 11, and can include both an electronic circuit and an electric circuit. The function addition circuit 41 can add various functions, but the following describes a case where an autonomous driving function that allows the vehicle 10 to drive autonomously without operating the remote control 20 is added.
[0019] The LiDAR 42 (Light Detection And Ranging) is a sensor that irradiates laser light and measures the distance to an object, its shape, etc., based on information about the reflected light. The LiDAR 42 is a 2D LiDAR (two-dimensional LiDAR) whose optical axis direction is the same plane, and irradiates laser light in a 360-degree direction including the front, back, left, and right directions. The photographing unit 43 is a digital camera that has a lens, an image sensor, etc., and photographs an image represented by light that reaches the image sensor. The function addition circuit 41 controls the autonomous driving of the vehicle 10 based on the measurement results by the LiDAR 42 and the images photographed by the photographing unit 43.
[0020] The detouring unit 44 is electrically connected to the transmission unit 17 of the vehicle 10 by a cable 45, and is a circuit that detours the signal transmitted by the transmission unit 17 so that it passes through the function adding circuit 41. The detouring unit 44 causes both the operation signal supplied to the operation control circuit 11 and the signalized situation information generated by the operation control circuit 11 to pass through the function adding circuit 41.
[0021] The function addition circuit 41 can switch between a manual mode in which the operation signal is returned directly to the transmission unit 17 and supplied to the operation control circuit 11, thereby allowing the vehicle 10 to be operated manually, and an automatic mode in which a control signal that controls the operation of the vehicle 10 is supplied to the operation control circuit 11 via the transmission unit 17 instead of the operation signal, thereby allowing the vehicle 10 to be automatically controlled.
[0022] The function addition circuit 41 converts the image for mode switching into a signal and transmits it to the remote control 20 via the transmission unit 17 and the communication unit 16. The display panel 23 of the remote control 20 displays the image for mode switching, allowing the operator to switch between the manual mode and the automatic mode. Note that the mode switching is not limited to the operation of the remote control 20, and may be performed by, for example, the operation of a physical switch (such as a toggle switch) provided in the function addition device 40.
[0023] The housing 46 is a rectangular box-shaped member made of a water-impermeable material such as metal or plastic, and has a ceiling, four side walls, and a bottom. The housing 46 houses the function addition circuit 41, the LiDAR 42, the imaging unit 43, and the detouring unit 44. An insertion hole 61 is formed in the ceiling of the housing 46. The LiDAR 42 is inserted and fixed in the insertion hole 61 with a portion of it exposed to the external space, and emits laser light from the portion exposed to the external space.
[0024] The housing 46 is fixed to the common shape portion 31 of the mounting member 30 by a first vibration-proof member 47. The first vibration-proof member 47 is a vibration-proof member having the ability to damp vibrations, such as a spring or rubber. The first vibration-proof member 47 damps vibrations in any direction, including the left-right direction, the front-back direction, and the up-down direction. The function additional circuit 41 is fixed to the housing 46 by a second vibration-proof member 48. The second vibration-proof member 48 is also a vibration-proof member having the ability to damp vibrations, such as a spring or rubber, and damps vibrations in any direction, including the left-right direction, the front-back direction, and the up-down direction.
[0025] Next, the external appearance of the vehicle system 1 will be described with reference to FIGS. Fig. 3 is a perspective view of the vehicle system 1. Fig. 4 is a front view of the vehicle system 1. Fig. 5 is a side view of the vehicle system 1. Fig. 6 is a rear view of the vehicle system 1. Fig. 7 is a plan view of the vehicle system 1. For ease of understanding, Figs. 3 to 7 do not show the body of the vehicle 10 but show the inside of the vehicle 10 so that it can be seen.
[0026] 3 to 7, a three-dimensional coordinate system is shown by arrows indicating the X-axis, Y-axis, and Z-axis, respectively. Hereinafter, the X-axis, Y-axis, and Z-axis directions are referred to as the front-rear direction, the left-right direction, and the up-down direction, respectively. The vehicle 10 travels with the direction indicated by the X-axis arrow as the forward direction. The vehicle 10 has a frame 18 and a roll bar 19. The drive unit 12, the traveling unit 13, the working unit 14, the fuel supply unit 15, etc. are attached to the outside of the frame 18. The working unit 14 is attached below the frame 18 so as to cut grass that has slipped under the vehicle 10.
[0027] Additionally, a roll bar 19 is fixed to the outside of the frame 18 with screws or bolts or the like. The roll bar 19 is a portion formed by joining pipes that are arranged to surround the drive unit 12, the fuel supply unit 15, etc. An individual shaped portion 32 having four rod-shaped members (pipes) is fixed to the roll bar 19. One end of each of the four rod-shaped members is fixed to the roll bar 19, and the other end is fixed to the common shaped portion 31.
[0028] A function-adding device 40 is attached to the common shape portion 31. A cable 45 shown in FIG. 1 that is arranged from the inside to the outside of a housing 46 of the function-adding device 40 is fastened to one of the rod-shaped members of the individual shape portion 32. A storage portion 181 that stores the operation control circuit 11 and the transmission portion 17 shown in FIG. 1 is attached to the upper portion of the frame 18. The cable 45 is arranged up to the inside of the storage portion 181 and is connected to the transmission portion 17 as shown in FIG. 1.
[0029] The function adding device 40 is attached so as to be located vertically above the fuel filler opening 51 of the fuel filling section 15. A LiDAR 42 is provided on the ceiling of the housing 46. An imaging hole 62 for allowing light to enter the imaging section 43 is provided on the front side of the housing 46. As shown in FIG. 6 , the function adding device 40 is provided at a position higher and separated from the vehicle 10 by the individual shaped portion 32. Vibrations occurring when the vehicle 10 is traveling are transmitted to the common shaped portion 31 by the individual shaped portion 32.
[0030] Here, the function adding device 40 includes a housing 46 attached to the vehicle 10, a function adding circuit 41 housed in the housing 46 for adding a function to the vehicle 10, and a first vibration isolating member 47 provided between the housing 46 and the vehicle 10 to attenuate vibrations transmitted from the vehicle 10 to the housing 46. Vibrations transmitted to the common shape portion 31 are largely attenuated by this first vibration isolating member 47 before being transmitted to the housing 46. Therefore, only attenuated vibrations are transmitted to the function adding circuit 41 inside the housing 46. According to this embodiment, it is possible to suppress failure of a circuit that is retrofitted to a vehicle, such as the function adding circuit 41, compared to a case in which the first vibration isolating member 47 is not provided.
[0031] The function adding device 40 also includes sensors attached to the housing 46. In the example of FIG. 1, the function adding device 40 includes three sensors, namely, a LiDAR 42, an image capturing unit 43, and an IMU (Inertial Measurement Unit) (the IMU is not shown). The LiDAR 42 is an example of a sensor that detects an obstacle by emitting electromagnetic waves (laser light). The function adding circuit 41 is an example of a circuit for controlling the traveling of the vehicle 10 based on the detection result of the sensor. In the function adding device 40, the first vibration isolating member 47 attenuates vibrations from the vehicle 10, so that the vibrations of the LiDAR 42 and the image capturing unit 43 are suppressed compared to a case where the first vibration isolating member 47 is not provided, and a decrease in measurement accuracy due to vibrations of the sensors can be suppressed.
[0032] As shown in Fig. 7, in the function adding device 40, the housing 46 has a polygonal shape (a square in the example of Fig. 7) when viewed vertically from above. The shape of the housing 46 is not limited to that shown in Fig. 10. For example, the housing 46 may have a polygonal shape other than a rectangle when viewed vertically from above, or may have a shape in which one side of a rectangle is deformed so as to draw an arc rather than a straight line. Furthermore, the housing 46 may have a circular or elliptical shape when viewed vertically from above.
[0033] The position where the LiDAR 42 is attached will be described with reference to FIG. Fig. 8 is a diagram showing the mounting position of the LiDAR 42. Fig. 8(a) shows the vehicle 10 seen from the front, Fig. 8(b) shows the vehicle 10 seen from the left, and Fig. 8(c) shows the vehicle 10 seen from above. Fig. 8 shows an area G1 that may be the center of gravity of the vehicle 10.
[0034] In vehicle 10, the center of gravity changes depending on, for example, the amount of fuel contained in fuel supply unit 15. In addition, in vehicle 10, the center of gravity may also change depending on the type of blade attached to working unit 14. Area G1 is a set of positions that the center of gravity that changes in this way can take. The center of gravity of vehicle 10 can be measured by a well-known method such as a pendulum method, an excitation method, or an experimental mode analysis. Therefore, area G1 can be identified by measuring the position of the center of gravity that has changed by changing the amount of fuel contained in fuel supply unit 15 or by changing the type of blade attached to working unit 14.
[0035] As shown in Fig. 8, the LiDAR 42, which is an example of a sensor, is disposed vertically above an area G1 that may be the center of gravity of the vehicle 10. The "vertically above" here refers to the vertically above the vehicle system 1 when the vehicle system 1 is stationary on a horizontal, flat ground. The LiDAR 42 may be disposed vertically above any position in the area G1. In addition, "disposed vertically above the area G1" means that a part of the LiDAR 42 is located vertically above the area G1.
[0036] When the vehicle 10 travels, various behaviors such as pitching, rolling, and yawing occur due to forces applied to the vehicle 10. Of these, yawing is a rotational motion around the Z axis passing through the center of gravity of the vehicle 10, so the closer to the Z axis, the less the positional movement due to the rotational motion. In the vehicle system 1, the LiDAR 42 is disposed vertically above the region G1 that may be the center of gravity of the vehicle 10 as described above, and therefore the shaking (especially the shaking when yawing occurs) of the sensor (LiDAR 42) retrofitted to the vehicle can be suppressed compared to the case where the LiDAR 42 is not disposed vertically above the region G1.
[0037] A method for attaching the LiDAR 42 to the housing 46 will be described with reference to FIGS. Fig. 9 is a diagram showing an example of the LiDAR 42 attached to the housing 46. Fig. 9 shows the LiDAR 42 and the housing 46 as viewed from the left. The LiDAR 42 includes a base unit 421, a rotating unit 422, and an emitting unit 423. The base unit 421 is the main body of the LiDAR 42, and houses a motor that rotates the rotating unit 422 and a control circuit that controls the operation of the rotating unit 422 and the emitting unit 423.
[0038] The rotating part 422 is a hollow cylindrical part, and is supported rotatably with respect to the base part 421. The irradiating part 423 has a laser oscillator and irradiates the laser light A10. The irradiating part 423 irradiates the laser light A10 while the rotating part 422 rotates, so that the laser light A10 is irradiated 360 degrees in all directions. The laser light A10 advances while slightly expanding the irradiation range around the optical axis A11. FIG. 9 shows a lower end light A12 traveling at the lower end of the irradiation range of the laser light A10, and an upper end light A13 traveling at the upper end of the irradiation range.
[0039] 9, the LiDAR 42 is attached to the housing 46 with an inclination so that the lower end light A12 travels along the horizontal direction. For example, the traveling direction of the lower end light A12 forms an angle of θ1° with respect to the optical axis A11. In this case, the LiDAR 42 is provided with the rotation axis B422 of the rotation unit 422 inclined by θ1° with respect to the vertical direction Z1.
[0040] In this manner, in the function adding device 40, the electromagnetic waves (laser light) emitted by the LiDAR 42, which is an example of a sensor, proceed while expanding the irradiation range starting from the sensor. The LiDAR 42 is provided in front of the vehicle 10 in such a direction that the lower end (lower end light A12 shown in FIG. 9) of the electromagnetic waves with the expanding irradiation range does not hit the ground. Since the LiDAR 42 has an effective range in which it can measure, the traveling direction of the lower end light A12 may be tilted slightly downward from the horizontal direction as long as the ground does not fall within the effective range.
[0041] When a sensor such as LiDAR 42 is used to measure obstacles, if the ground is measured, it will be determined that an obstacle exists in a direction where there is no obstacle, resulting in erroneous driving control. Therefore, by tilting the sensor as described above, it is possible to suppress the detection of the ground as an obstacle compared to a case where the sensor is not tilted, and it is possible to suppress erroneous driving control.
[0042] Fig. 10 is a diagram showing a method of mounting the LiDAR 42 to the housing 46. Fig. 10(a) shows a cross section of the housing 46 before the LiDAR 42 is mounted, as seen from the left. As described in the explanation of Fig. 1, the housing 46 is formed with an insertion hole 61 for inserting the LiDAR 42. The insertion hole 61 is provided in a ceiling portion 64 that covers the upper portion of the housing 46, and is shaped so that the base portion 421 of the LiDAR 42 can be inserted at an angle.
[0043] As shown in FIG. 10(b), the base 421 is inserted and fixed in the insertion hole 61. A gap filling member is sandwiched between the base 421 inserted in the insertion hole 61 and the housing 46 to prevent a gap from occurring. The gap filling member is preferably an elastic and waterproof material like rubber used for packing. A wiring 424 is connected to the base 421 inside the housing 46. The wiring 424 is connected to the function addition circuit 41 and transmits a signal indicating the measurement result of the LiDAR 42 to the function addition circuit 41. The function addition circuit 41 is fixed to the housing 46 by a second vibration isolating member 48.
[0044] Thus, in the function adding device 40, the housing 46 has a box shape with a ceiling portion 64 that is a plate-like member vertically above, and the ceiling portion 64 is provided with an insertion hole 61 in the shape of the LiDAR 42, which is an example of a sensor. The LiDAR 42 is inserted and fixed in the insertion hole 61, and is connected to the function adding circuit 41 via the wiring 424 inside the housing 46. According to this embodiment, the sensor and the wiring are connected inside the housing and the wiring is not exposed to the outside of the housing, so that it is possible to expose a part of the sensor to the outside of the housing to enable detection by electromagnetic waves, while making it difficult for the wiring to get wet compared to the case where the entire sensor is exposed to the outside of the housing.
[0045] Moreover, LiDAR 42, which is an example of a sensor, has a portion (hereinafter referred to as "emitting portion") that emits electromagnetic waves (laser light) in a direction of a predetermined range along the horizontal direction. The emitting portion is, for example, a rotating portion 422 and an irradiating portion 423. The predetermined range is, for example, the entire range of 360 degrees. Note that the predetermined range does not have to be the entire 360 degrees, and may be, for example, the entire range excluding a certain range in the rearward direction where there is little need to detect obstacles.
[0046] The emission portion is provided at a position higher than the highest upper end of the vehicle 10 and the housing 46. In the vehicle system 1, the highest upper end of the vehicle 10 and the housing 46 is the ceiling part 64 shown in FIG. 10(a). As shown in FIG. 10(b), the LiDAR 42 has a rotation part 422 and an irradiation part 423 provided at a position higher than the ceiling part 64. According to this embodiment, it is possible to prevent detection by the sensor from being hindered by the vehicle and the housing.
[0047] Moreover, the LiDAR 42, which is an example of a sensor, has a function of detecting the position of a predetermined marker. The marker is installed near the boundary of the area in which the vehicle 10 travels as a mark indicating the boundary of the area in which the vehicle 10 travels. The marker is, for example, a board or a stick of a specific shape, and is desirably installed at a position higher than the height of the weeds to be cut by the vehicle 10. Moreover, the LiDAR 42 is desirably installed at a position lower than the upper end of the marker. By installing the LiDAR 42 in this way, it is possible to more reliably detect the marker compared to a case in which the LiDAR 42 is installed at a position higher than the upper end of the marker.
[0048] Moreover, "near the boundary" means a position within a predetermined distance from the boundary. The predetermined distance is a distance for preventing the vehicle 10 from coming into contact with the marker 70 when traveling around the edge or corner of the working area A1, and is set to, for example, about several tens of centimeters to several meters. In this way, the marker 70 is installed as a guide for the boundary of the working area A1.
[0049] FIG. 11 is a diagram showing an example of an area where markers are installed. In the example of FIG. 11, a rectangular work area C1 is shown in which ten markers 70, 701 to 710 (when not distinguishing between them, they are referred to as "markers 70"). The function addition circuit 41 measures the distance and direction to each marker 70 by the LiDAR 42. In the example of FIG. 11, it is assumed that the markers 70 are installed on the boundary of the work area A1 for ease of explanation. In the example of FIG. 11, it is assumed that the markers 701, 702, 703, 708, 709, and 710 within the detection range of the LiDAR 42 are detected, and the markers 704, 705, 706, and 707 outside the detection range are not detected.
[0050] The function addition circuit 41 may control the vehicle 10 to rotate when detecting the marker 70. For example, depending on how the LiDAR 42 is attached, the limit distance at which the marker 70 can be detected may differ depending on the orientation. For example, if the marker 70 can be detected farthest in the forward direction and the limit distance is set as the maximum detection distance, the marker 70 can be detected up to the maximum detection distance in any orientation by rotating the vehicle 10.
[0051] The function addition circuit 41 controls the vehicle 10 to travel within an area whose boundary is near the position of the marker detected by the LiDAR 42. The function addition circuit 41 first identifies an area surrounded by the detected markers 701, 702, 703, 708, 709, and 710, and travels within the identified area. When the vehicle 10 travels close to the marker 703, which is the edge of the identified area, the function addition circuit 41 stops the vehicle 10 once and detects the marker 70 by the LiDAR 42 again.
[0052] In this case, since markers 704, 705, 706, and 707 are also within the detection range, the distance and direction are measured by the LiDAR 42. In this way, the function addition circuit 41 detects all markers 70 by repeating the process of detecting the marker 70 again when the function addition circuit 41 travels to the edge of the area whose boundary is the position of the detected marker, and specifies the working area C1 whose boundaries are all the detected markers 70. According to this embodiment, it is possible to travel within a predetermined area (for example, the working area C1) without a position sensor. Furthermore, in the function addition device 40, the first vibration isolation member 47 also attenuates the vibration of the LiDAR 42, so that the accuracy of the detection result of the LiDAR 42 can be improved and the accuracy of the autonomous traveling can also be improved compared to the case where the first vibration isolation member 47 is not provided.
[0053] The number of markers 70 is not limited to ten as shown in FIG. 11. For example, four markers 70 may be placed at the four corners of the working area C1. In this case, it is desirable that all four markers 70 can be detected from anywhere in the working area C1. If the working area C1 is large and some of the markers 70 cannot be detected, for example, a string-like object (rope, belt, etc.) may be attached between the markers 70 to indicate the boundary line of the working area. In this case, the LiDAR 42 detects the string-like object in addition to the markers 70.
[0054] Furthermore, the function adding device 40 includes a photographing unit 43 (more specifically, an image sensor included in the photographing unit 43) which is an example of a second sensor provided in the housing 46. The photographing unit 43 (image sensor) is a sensor that detects an image represented by visible light. When the function adding circuit 41 performs pattern recognition processing or the like on the image photographed by the photographing unit 43, it is possible to detect specific objects such as people and cars that are obstacles to the vehicle 10. In this way, the photographing unit 43 cooperates with the function adding circuit 41 to exhibit the function of detecting obstacles.
[0055] When the photographing unit 43 detects an obstacle, the function addition circuit 41 controls the vehicle 10 to avoid collision with the obstacle. When the function addition circuit 41 detects an obstacle, for example, the function addition circuit 41 stops the vehicle 10 to avoid collision with the obstacle. When the function addition circuit 41 detects an obstacle, it changes direction to a direction where there is no obstacle to avoid collision with the obstacle. According to this embodiment, it is possible to avoid collision of the vehicle 10 with an obstacle. In addition, in the function addition device 40, the first vibration isolating member 47 also attenuates vibration of the photographing unit 43, so that the accuracy of the detection result (photographed image) of the photographing unit 43 can be improved and the accuracy of the collision avoidance process can also be improved compared to a case where the first vibration isolating member 47 is not provided.
[0056] <Configuration variations> The method of mounting the LiDAR 42 on the housing 46 is not limited to the method described with reference to FIG. Fig. 12 is a diagram showing an example of the LiDAR 42 attached to the housing 46a. Fig. 12 shows the LiDAR 42 and the housing 46a as viewed from the left. The upper surface 461 of the housing 46a does not have the insertion hole 61 shown in Fig. 10, and a base part 425 is fixed at the same position as the insertion hole 61.
[0057] When the base 425 is fixed to the upper surface 461, the base 425 has an inclined surface 426 that is inclined by θ1° as shown in FIG. 9 with respect to the upper surface 461. The inclined surface 426 is fixed so that the front is higher and the rear is lower. The LiDAR 42 is fixed by closely contacting the bottom surface of the base 421 with the inclined surface 426. By fixing in this manner, the rotation axis B422 of the rotation part 422 of the LiDAR 42 is inclined by θ1° with respect to the vertical direction Z1, and the optical axis A11 of the laser light irradiated by the LiDAR 42 is inclined upward by θ1° with respect to the horizontal direction.
[0058] As a result, when the vehicle 10 is kept horizontal, the lower end of the laser light (lower end light A12) travels horizontally and does not hit the ground. In this way, in the example of Fig. 12, as in the example of Fig. 9, the LiDAR 42 is provided in an orientation such that the lower end light A12 does not hit the ground, and it is possible to suppress detection of the ground as an obstacle. The cable of the LiDAR 42 is arranged inside the housing 46a from a hole (not shown) provided in the upper surface 461.
[0059] Fig. 13 is a diagram showing an example of the LiDAR 42 attached to the housing 46b. Fig. 13 shows the LiDAR 42 and the housing 46b as viewed from the left. The insertion hole 61 shown in Fig. 10 is not provided on the upper surface 461 of the housing 46b. The housing 46b is attached to the vehicle 10 with the upper surface 461 tilted by θ1° with respect to the horizontal direction X1. More specifically, the housing 46b is tilted so that the front of the upper surface 461 is higher than the rear.
[0060] The inclination of the housing 46b is generated, for example, by making the upper end of the rear individual shaped portion 32 lower than the upper end of the front individual shaped portion 32 among the individual shaped portions 32 shown in Fig. 5. By attaching the housing 46b in this manner, the rotation axis B422 of the rotation portion 422 of the LiDAR 42 is inclined by θ1° with respect to the vertical direction Z1, and the optical axis A11 of the laser light irradiated by the LiDAR 42 is inclined upward by θ1° with respect to the horizontal direction.
[0061] As a result, when the vehicle 10 is kept horizontal, the lower end of the laser light (lower end light A12) travels horizontally and does not hit the ground. In this way, in the example of Fig. 13, as in the example of Fig. 9, the LiDAR 42 is provided in an orientation such that the lower end light A12 does not hit the ground, and it is possible to suppress detection of the ground as an obstacle. The cable of the LiDAR 42 is arranged inside the housing 46b from a hole (not shown) provided in the upper surface 461.
[0062] The method of identifying the working area C1 is not limited to the method shown in Fig. 11. For example, a predetermined beacon may be installed at the boundary of the area in which the vehicle 10 travels. A beacon is a device that transmits a wireless signal indicating unique identification information or the like at regular intervals. The function adding device 40 includes a sensor that has a function of detecting a signal from the predetermined beacon.
[0063] Then, the function addition circuit 41 controls the vehicle 10 to travel within an area (work area C1) whose boundary is the position of the beacon indicated by the signal detected by the sensor. For example, the function addition circuit 41 identifies the relative position of the sensor with respect to the beacon based on the signal detected by the sensor, and travels the vehicle 10 so that the identified relative position of the sensor falls within the area surrounded by the beacons. The relative position of the sensor with respect to the beacon is identified, for example, by three-point positioning that calculates the distances to three beacons based on the detected signal.
[0064] The function addition circuit 41 may also use a sensor having multiple antennas to identify the direction of the beacon using the phase difference of the wireless signals received by the multiple antennas. In this case, the function addition circuit 41 can identify the relative position with respect to the beacon by using the identified direction of the beacon. According to this embodiment, even if there is an obstacle between the beacon and the sensor, the wireless signal can be received and the relative position can be identified, so that the driving control can be less affected by the obstacle than when a sensor that uses the reflection of electromagnetic waves such as LiDAR is used.
[0065] In the above example, the function addition circuit 41 controls the traveling by identifying the relative position with respect to the marker or beacon, but the present invention is not limited to this, and the absolute position (e.g., latitude and longitude) of the marker or beacon may be identified to control the traveling. In this case, for example, the marker indicates a code indicating the absolute position of the marker itself, and the LiDAR 42 or the image capturing unit 43 detects the code to identify the absolute position of the marker. Also, when the beacon transmits position information indicating the absolute position of the device itself, the absolute position of the beacon is identified based on the position information received by the sensor.
[0066] The function addition device 40 includes a sensor (e.g., GNSS: Global Navigation Satellite System) that has a function of detecting the position of the vehicle 10. Then, the function addition circuit 41 controls the traveling of the vehicle 10 based on the position detected by the sensor. In detail, the function addition circuit 41 specifies the absolute position of each marker or each beacon based on the detection result of the sensor for the marker or beacon, and specifies the boundary of a working area surrounded by multiple markers or multiple beacons.
[0067] Then, the function addition circuit 41 controls the traveling direction, speed, etc. of the vehicle 10 so that the position of the vehicle 10 detected by the sensor is inside the work area. According to this embodiment, once the boundary of the work area is identified, the vehicle can be driven thereafter based only on the detection results of the sensor.
[0068] The configuration of the vehicle 10 is not limited to that described in FIG. 2. The vehicle 10 may have normal wheels instead of caterpillar tracks. The vehicle 10 may be driven by directly transmitting the rotational force of an engine to the traveling unit 13 and the working unit 14, or may not be equipped with an engine but only an electric motor to generate driving force. In the latter case, the vehicle 10 has a battery instead of the fuel supply unit 15. The vehicle 10 may be used not only for mowing but also for spraying pesticides, plowing, planting rice, harvesting, etc. The vehicle 10 may be used not only for remote control but also for a person to ride and drive, or for an autonomous driving function.
[0069] The functions added by the function adding device 40 are not limited to those described above (autonomous driving function). For example, the function adding device 40 may add not only driving but also a function of autonomously controlling the operation of the working unit 14. The function adding device 40 may also add a remote operation support function that displays an image captured by the photographing unit 43 on the display panel 23 of the remote control 20, enabling remote operation even when the vehicle 10 cannot be seen. In short, the function adding device 40 may add any function that the vehicle 10 does not have.
[0070] In the embodiment, the LiDAR 42 detects the marker 70 shown in Fig. 11 or the string-like object described above, but is not limited thereto. The LiDAR 42 may detect obstacles such as people, trees, and other vehicles, or may detect work targets such as grass. In addition, the LiDAR 42 is a 2D LiDAR with the same plane as the optical axis direction in the embodiment, but may be a 3D LiDAR (three-dimensional LiDAR) with a wider scanning range.
[0071] In the embodiment, the photographing unit 43 detects an obstacle by cooperating with the function addition circuit 41, but this is not limited thereto. The photographing unit 43 may detect, for example, the marker 70 or the string-like object described above. The photographing unit 43 may also detect a work target such as grass. The photographing unit 43 may also detect the type of person (worker, other person, etc.) by cooperating with the function addition circuit 41. For example, the photographing unit 43 and the function addition circuit 41 may perform pattern recognition of a specific work uniform and detect a person wearing the work uniform as a worker.
[0072] The photographing unit 43 and the function adding circuit 41 may detect the state of the ground (wet or dry, etc.) based on the brightness and hue of each pixel of the image of the ground. If the photographing unit 43 has a depth camera or a stereo camera, the photographing unit 43 can detect the distance and direction to an object. The function adding circuit 41 controls the operation of the vehicle 10, such as traveling and work, based on the various detection results of the LiDAR 42 and the photographing unit 43 described above.
[0073] In addition, the housing 46 is not limited to that shown in Fig. 3 and the like. For example, the housing 46 is a rectangular box-shaped member, but may be a triangular prism, a pentagonal prism, a hexagonal prism, a cylinder, or the like. In addition, the position at which the LiDAR 42 and the image capturing unit 43 are provided in the housing 46 may be different. In short, the housing 46 may be of any shape or material as long as the function addition circuit 41, the bypass unit 44, and the like are stored therein, and the LiDAR 42 and the image capturing unit 43 can be attached so as to be able to measure a required object.
[0074] <Additional Notes> Furthermore, it may be provided in the following aspects:
[0075] (1) A driving control device comprising: a housing to be attached to a vehicle; a sensor attached to the housing and emitting electromagnetic waves to detect obstacles; and a circuit for controlling the driving of the vehicle based on the detection results of the sensor, wherein the sensor is positioned vertically above an area that may be the center of gravity of the vehicle.
[0076] According to this aspect, it is possible to suppress the vibration of the sensor that is retrofitted to the vehicle.
[0077] (2) In the driving control device described in (1) above, the electromagnetic waves travel while expanding their irradiation range from the sensor as a starting point, and the sensor is installed in front of the vehicle in an orientation such that the lower end of the electromagnetic waves with a expanding irradiation range does not hit the ground.
[0078] According to this aspect, it is possible to suppress detection of the ground as an obstacle.
[0079] (3) In the driving control device described in (1) or (2) above, the housing is shaped like a box having a plate-shaped member vertically above, the plate-shaped member has a hole in the shape of the sensor, the sensor is inserted and fixed in the hole, and is connected to the circuit via wiring inside the housing.
[0080] According to this embodiment, the wiring can be made less susceptible to getting wet.
[0081] (4) In the driving control device described in any one of (1) to (3) above, the sensor has a function of detecting the position of a predetermined marker, the marker is installed near the boundary of an area in which the vehicle drives, the circuit controls the vehicle to drive within an area whose boundary is near the position of the marker detected by the sensor, and the sensor is installed at a position lower than the upper end of the marker.
[0082] According to this embodiment, the marker can be detected more reliably.
[0083] (5) A driving control device according to any one of (1) to (4) above, wherein the sensor has a portion that emits the electromagnetic waves in a direction of a predetermined range along the horizontal direction, and the portion is provided at a position higher than the highest end of the vehicle and the housing.
[0084] According to this aspect, it is possible to prevent the detection by the sensor from being impeded.
[0085] (6) In the driving control device described in (1) above, the sensor has a function of detecting a signal from a specified beacon, the beacon is installed at the boundary of an area in which the vehicle drives, and the circuit controls the vehicle to drive within an area whose boundary is the position of the beacon indicated by the signal detected by the sensor.
[0086] According to this aspect, the driving control can be made less susceptible to the influence of obstacles.
[0087] (7) In the driving control device described above in (1), the sensor has a function of detecting the position of the vehicle, and the circuit controls the driving of the vehicle based on the position detected by the sensor.
[0088] According to this embodiment, once the boundary of the working area is identified, the vehicle can be driven thereafter based solely on the detection results of the sensor. Of course, this is not the case. Furthermore, the above-described embodiments and modifications may be combined in any desired manner.
[0089] Finally, although various embodiments of the present invention have been described, these are presented as examples and are not intended to limit the scope of the invention. The new embodiments can be implemented in various other forms, and various omissions, substitutions, and modifications can be made without departing from the spirit of the invention. The embodiments and their modifications are within the scope and spirit of the invention, and are included in the scope of the invention and its equivalents described in the claims. [Explanation of symbols]
[0090] 1: Vehicle system 10: Vehicle 11: Operation control circuit 12: Drive unit 13: Running part 14: Working section 15: Refueling Department 16: Communications Department 17: Transmission section 18: Frame 19: Roll bar 20: Remote control 21:Operation section 22: Communications Department 23: Display panel 30: Mounting material 31: Common shape part 32: Individual shape part 40: Function addition device 41: Additional function circuit 42: LiDAR 43: Photography Department 44: Detour section 45: Cable 46: Housing 47: First vibration-isolating member 48: Second vibration-isolating member 51: Fuel filler 61: Insertion hole 62: Shooting hole 64: Ceiling 70: Marker 421: Base 422: Rotating part 423: Irradiation unit 424: Wiring 425: Base 426: Inclined surface
Claims
1. A driving control device, A housing that is attached to a vehicle; a sensor attached to the housing and emitting electromagnetic waves to detect an obstacle; a circuit for controlling the running of the vehicle based on the detection result of the sensor; Equipped with The sensor is disposed vertically above an area that may be the center of gravity of the vehicle. Cruise control device.
2. The travel control device according to claim 1, The electromagnetic waves travel while expanding the irradiation range from the sensor as a starting point, The sensor is provided in front of the vehicle in such a direction that the lower end of the electromagnetic wave having a wide irradiation range does not hit the ground. Cruise control device.
3. The travel control device according to claim 1, The housing has a box shape having a plate-like member vertically above it, The plate-like member is provided with a hole having a shape of the sensor, The sensor is inserted into the hole and fixed therein, and is connected to the circuit via wiring inside the housing. Cruise control device.
4. The travel control device according to claim 1, The sensor has a function of detecting a position of a predetermined marker, The marker is installed near a boundary of an area in which the vehicle travels, the circuit controls the vehicle to travel within an area bounded by a location of the marker detected by the sensor; The sensor is provided at a position lower than the upper end of the marker. Cruise control device.
5. The travel control device according to claim 1, the sensor has a portion that emits the electromagnetic wave in a direction of a predetermined range along a horizontal direction, and the portion is provided at a position higher than the highest end of the vehicle and the housing. Cruise control device.
6. The travel control device according to claim 1, The sensor has a function of detecting a signal from a predetermined beacon, The beacon is installed at a boundary of an area in which the vehicle travels, The circuit controls the vehicle to travel within an area bounded by the location of the beacon as indicated by the signal detected by the sensor. Cruise control device.
7. The travel control device according to claim 1, The sensor has a function of detecting a position of the vehicle, The circuit controls travel of the vehicle based on the position detected by the sensor. Cruise control device.
Citation Information
Patent Citations
Control device, control method, control program, and control system
JP2022179577A