Mobile body control device, mobile body control method, and storage medium
Through road type identification and speed adjustment technology, the problem of improper speed control between the sidewalk and the lane of electric wheelchairs is solved, appropriate speed management in different areas is achieved, and safety and adaptability are improved.
Patent Information
- Application Number
- CN202280094383.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2022-03-30
- Publication Date
- 2024-11-15
AI Technical Summary
Electric wheelchairs cannot properly control speed between sidewalks and driveways, resulting in unavailability to adapt to speed requirements in different areas.
The road type identification unit and the control unit are used to identify whether the moving body moves in the lane or the sidewalk through the external detection device, and adjust the speed according to the lane score and the width of the driving road, limit the first speed when the lane moves, and reduce the sidewalk when the sidewalk moves. to the second speed.
Appropriate speed control between the lane and the sidewalk is achieved, ensuring that high speed can be driven on the lane, while the speed is reduced on the sidewalk is improved, and the safety and adaptability of the moving body in different areas is improved.
Smart Images

Figure CN118973882A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a control device for a mobile object, a control method for a mobile object, and a storage medium. Background Art
[0002] Conventionally, practical applications have been promoted for mobile bodies that can move on both sidewalks and roadways, and in such mobile bodies, it is necessary to set different upper speed limits on sidewalks and roadways. In connection with this, there is a document that describes the following matters: in speed control of an electric wheelchair, an upper speed limit is set according to a road width, and when it is detected that the vehicle is traveling at the end of a road without a sidewalk, the upper speed limit is lowered (Patent Document 1).
[0003] Prior art literature
[0004] Patent Literature
[0005] Patent Document 1: Japanese Patent Application Publication No. 2017-100490 Summary of the invention
[0006] Problems to be solved by the invention
[0007] Electric wheelchairs are designed to move exclusively on sidewalks, and conventional technologies may not be able to appropriately control the speed of a moving body that can move on a lane and a predetermined area different from a lane.
[0008] The present invention has been completed in consideration of such a situation, and one of its purposes is to provide a control device, a control method and a storage medium for a mobile body that can appropriately control the speed of a mobile body that can move in a lane and a specified area different from the lane.
[0009] Solutions to Solve Problems
[0010] The control device for a moving object, the control method for a moving object, and the storage medium of the present invention employ the following configurations.
[0011] (1): A control device for a mobile body according to one embodiment of the present invention is a control device for a mobile body capable of moving in both a lane and a prescribed area different from the lane, wherein the control device for the mobile body comprises: a road type recognition unit, which recognizes whether the mobile body is moving in the lane or in the prescribed area based on the output of an external detection device that detects the external condition of the mobile body; and a control unit, which limits the speed of the mobile body when moving in the lane to a first speed, and limits the speed of the mobile body when moving in the prescribed area to a second speed lower than the first speed, wherein the control unit adjusts the first speed based on the width of the road on which the mobile body is moving.
[0012] (2): Based on the scheme of (1) above, the road type recognition unit recognizes whether the moving body is moving in the lane or in the specified area based on a lane score indicating the possibility that the moving body is moving in the lane, the lane score being calculated based on the output of the external detection device, and the control unit adjusting the first speed based on the lane score.
[0013] (3): In the above aspect (2), the control unit sets the first speed to a higher value as the lane score is higher.
[0014] (4): Based on the scheme of (2) or (3) above, the control unit compares the adjustment amount of the first speed based on the width of the driving road with the adjustment amount of the first speed based on the lane score. If the adjustment amount of the first speed based on the width of the driving road is greater than the adjustment amount of the first speed based on the lane score, the control unit adjusts the first speed based on the width of the driving road. If the adjustment amount of the first speed based on the width of the driving road is less than the adjustment amount of the first speed based on the lane score, the control unit adjusts the first speed based on the lane score.
[0015] (5): In another embodiment of the present invention, a computer controls a moving body that can move in both a lane and a specified area different from the lane. The moving body control method causes the computer to perform the following processing: based on the output of an external detection device that detects the external condition of the moving body, identifying whether the moving body is moving in the lane or in the specified area; and limiting the speed of the moving body when moving in the lane to a first speed, and limiting the speed of the moving body when moving in the specified area to a second speed lower than the first speed, wherein the processing of limiting the speed of the moving body when moving in the lane to the first speed includes the processing of adjusting the first speed based on the width of the road on which the moving body is moving.
[0016] (6): A storage medium of another embodiment of the present invention stores a program, wherein a computer controls a moving body that can move in both a lane and a specified area different from the lane, and the program causes the computer to perform the following processing: based on the output of an external detection device that detects the external condition of the moving body, identifying whether the moving body is moving in the lane or in the specified area; and limiting the speed of the moving body when moving in the lane to a first speed, and limiting the speed of the moving body when moving in the specified area to a second speed lower than the first speed, wherein the processing of limiting the speed of the moving body when moving in the lane to the first speed includes the processing of adjusting the first speed based on the width of the road on which the moving body is moving.
[0017] Effects of the Invention
[0018] According to the above aspects (1) to (6), it is possible to appropriately perform speed control of a moving object that can move in a lane and a predetermined area different from the lane. BRIEF DESCRIPTION OF THE DRAWINGS
[0019] Figure 1 It is a diagram showing an example of the configuration of a moving object and a control device according to an embodiment.
[0020] Figure 2 This is a perspective view of a moving object as viewed from above.
[0021] Figure 3 2 is a diagram illustrating a plurality of first phenomena.
[0022] Figure 4 2 is a diagram illustrating a plurality of second phenomena.
[0023] Figure 5 This is a diagram illustrating a second surface 207b of the guardrail 207 that faces the sidewalk.
[0024] Figure 6 This is a flowchart showing an example of the flow of processing executed by the road type identification unit 120 according to the embodiment.
[0025] Figure 7 1 is a diagram showing an example of the relationship between the width W of the travel path and the correction value ΔV1-1.
[0026] Figure 8 : is a diagram showing an example of the relationship between the lane score Sc and the correction value ΔV1-2.
[0027] Fig. 9 It is a diagram showing an example of the flow of processing executed by the control unit 140 according to the embodiment. DETAILED DESCRIPTION
[0028] Hereinafter, the implementation methods of the control device of the mobile body, the control method of the mobile body, and the program of the present invention will be described with reference to the accompanying drawings. The mobile body moves in both a lane and a prescribed area different from the lane. There is a case where the mobile body is called a micro mobile body. An electric scooter is a type of micro mobile body. In addition, the mobile body can be a means of transportation that passengers can take, or it can be an autonomous mobile body that can travel autonomously in an unmanned manner. The latter autonomous mobile body is used, for example, for transporting goods, etc. The prescribed area is, for example, a sidewalk. In addition, the prescribed area may also be part or all of a roadside area, a bicycle lane, an open space, etc., or may include all of a sidewalk, a roadside area, a bicycle lane, an open space, etc. In the following description, the prescribed area is set to a sidewalk. The part recorded as "sidewalk" in the following description can be appropriately replaced with "prescribed area".
[0029] Figure 1 1 is a diagram showing an example of the structure of a moving body 1 and a control device 100 according to an embodiment. The moving body 1 is equipped with, for example, an external detection device 10, a moving body sensor 12, an operating member 14, an internal camera 16, a positioning device 18, a mode switching switch 22, a moving mechanism 30, a driving device 40, an external reporting device 50, a storage device 70, and a control device 100. It should be noted that some of these structures that are not necessary for realizing the functions of the present invention may be omitted.
[0030] The external detection device 10 is a variety of devices that use the moving direction of the moving body 1 as a detection range. The external detection device 10 includes an external camera, a radar device, LIDAR (Light Detection and Ranging), a sensor fusion device, etc. The external detection device 10 outputs information (images, object positions, etc.) indicating the detection results to the control device 100.
[0031] The moving body sensor 12 includes, for example, a speed sensor, an acceleration sensor, a yaw rate (angular velocity) sensor, an orientation sensor, and an operation amount detection sensor installed on the operating member 14. The operating member 14 includes, for example, an operating member for indicating acceleration and deceleration (for example, an accelerator pedal, a brake pedal) and an operating member for indicating steering (for example, a steering wheel). In this case, the moving body sensor 12 may also include an accelerator opening sensor, a brake pedal amount sensor, a steering torque sensor, etc. The moving body 1 may also have an operating member other than the above as the operating member 14 (for example, a rotating operating member, a joystick, a button, etc. that is not annular).
[0032] The interior camera 16 captures at least the head of the occupant of the moving object 1 from the front. The interior camera 16 is a digital camera using an imaging element such as a CCD (Charge Coupled Device) or a CMOS (Complementary Metal Oxide Semiconductor). The interior camera 16 outputs the captured image to the control device 100 .
[0033] The positioning device 18 is a device for measuring the position of the mobile body 1. The positioning device 18 is, for example, a GNSS (Global Navigation Satellite System) receiver, which determines the position of the mobile body 1 based on the signal received from the GNSS satellite and outputs it as position information. It should be noted that the position information of the mobile body 1 can also be estimated based on the position of the Wi-Fi base station to which the communication device described later is connected.
[0034] The mode switching switch 22 is a switch operated by the passenger. The mode switching switch 22 may be a mechanical switch or a GUI (Graphical User Interface) switch set on a touch panel. The mode switching switch 22, for example, accepts an operation to switch the driving mode to any one of Mode A, Mode B, and Mode C, wherein Mode A is an assist mode in which one of the steering operation and acceleration / deceleration control is performed by the passenger and the other is performed automatically, and there may be Mode A-1 in which the steering operation is performed by the passenger and the acceleration / deceleration control is performed automatically, and Mode A-2 in which the acceleration / deceleration operation is performed by the passenger and the steering control is performed automatically, Mode B is a manual driving mode in which the steering operation and acceleration / deceleration operation are performed by the passenger, and Mode C is an automatic driving mode in which the operation control and acceleration / deceleration control are performed automatically.
[0035] The moving mechanism 30 is a mechanism for moving the moving body 1 on the road. The moving mechanism 30 is, for example, a wheel set including a steering wheel and a driving wheel. In addition, the moving mechanism 30 may also be a leg for multi-legged walking.
[0036] The drive device 40 outputs force to the moving mechanism 30 to move the moving body 1. For example, the drive device 40 includes a motor that drives the drive wheels, a battery that stores power supplied to the motor, a steering device that adjusts the steering angle of the steering wheel, etc. The drive device 40 may also include an internal combustion engine, a fuel cell, etc. as a drive force output mechanism or a power generation mechanism. In addition, the drive device 40 may also include a braking device that brakes by friction or air resistance.
[0037] The external reporting device 50 is, for example, a lamp, a display device, a speaker, etc., which is provided on the outer plate of the moving body 1 and is used to report information to the outside of the moving body 1. The external reporting device 50 performs different actions when the moving body 1 is moving on a sidewalk and when it is moving on a lane. For example, the external reporting device 50 is controlled to light a lamp when the moving body 1 is moving on a sidewalk, and not to light a lamp when the moving body 1 is moving on a lane. Preferably, the light color of the lamp is a color prescribed by law. The external reporting device 50 may also be controlled to light a lamp in green when the moving body 1 is moving on a sidewalk, and to light a lamp in blue when the moving body 1 is moving on a lane. When the external reporting device 50 is a display device, the external reporting device 50 displays the meaning of "driving on the sidewalk" in text or graphics when the moving body 1 is moving on the sidewalk.
[0038] Figure 2 It is a perspective view of the mobile body 1 observed from above. In the figure, FW is a steering wheel, RW is a driving wheel, SD is a steering device, MT is a motor, and BT is a battery. The steering device SD, the motor MT, and the battery BT are included in the driving device 40. In addition, AP is an accelerator pedal, BP is a brake pedal, WH is a steering wheel, SP is a speaker, and MC is a microphone. The mobile body 1 shown in the figure is a single-passenger mobile body, and the passenger P is sitting in the driver's seat DS and wearing a seat belt SB. The arrow D1 is the direction of travel (speed vector) of the mobile body 1. The external detection device 10 is arranged near the front end of the mobile body 1, the internal camera 16 is arranged at a position that can photograph the head of the passenger P from the front of the passenger P, and the mode switching switch 22 is arranged on the hub of the steering wheel WH. In addition, an external reporting device 50 as a display device is arranged near the front end of the mobile body 1.
[0039] return Figure 1 The storage device 70 is a non-temporary storage device such as a HDD (Hard Disk Drive), a flash memory, or a RAM (Random Access Memory). The storage device 70 stores map information 72, a program 74 executed by the control device 100, and the like. Although the storage device 70 is shown outside the frame of the control device 100 in the figure, the storage device 70 may also be included in the control device 100. In addition, the storage device 70 may also be set on a server not shown in the figure.
[0040] [Control device]
[0041] The control device 100 includes, for example, a road type recognition unit 120, an object recognition unit 130, and a control unit 140. These components are implemented by, for example, a hardware processor such as a CPU (Central Processing Unit) executing a program (software) 74. Some or all of these components can be implemented by hardware (including circuitry) such as LSI (Large Scale Integration), ASIC (Application Specific Integrated Circuit), FPGA (Field-Programmable Gate Array), GPU (Graphics Processing Unit), etc., or can be implemented by the cooperation of software and hardware. The program can be stored in the storage device 70 in advance, or can be stored in a removable storage medium (non-temporary storage medium) such as a DVD or CD-ROM, and installed in the storage device 70 by assembling the storage medium in a drive device.
[0042] The road type recognition unit 120 recognizes whether the moving object 1 is moving in a lane or on a sidewalk. The road type recognition unit 120 recognizes whether the moving object 1 is moving in a lane or on a sidewalk by, for example, analyzing an image captured by an external camera of the external detection device 10. It should be noted that the output of a radar device, LIDAR, a sensor fusion device, etc. may also be used as an auxiliary.
[0043] Whenever the road type recognition unit 120 recognizes each of the first phenomena among the plurality of first phenomena indicating that the mobile body 1 is moving in the lane in the image captured by the external camera, the score is added to the lane score Sr. When the lane score Sr is greater than the first threshold value, it is recognized that the mobile body 1 is moving in the lane. At this time, the road type recognition unit 120 weights the score according to the confidence when each of the first phenomena among the plurality of first phenomena is recognized, and adds it to the lane score Sr. The scores corresponding to the first phenomena are set to P1~Pn (n is a natural number, which is equal to the number of phenomena assumed to be the first phenomenon). The scores P1~Pn can be the same value or different values depending on the type of the first phenomenon. In addition, the weights corresponding to the confidence of the recognition process are set to α1~αn. The confidence of the recognition process is output in conjunction with the process of recognizing the first phenomenon (for example, including the discrimination process using the learned model obtained by machine learning). The lane score Sr is represented by formula (1).
[0044] Sr=α1×P1+α1+P2+…+αn×Pn (1)
[0045] (When the corresponding first phenomenon k is not identified, Pk=0 (k=1~n))
[0046] However, when the road type recognition unit 120 recognizes any second phenomenon among the plurality of second phenomena indicating that the moving object 1 is moving on a sidewalk in the image captured by the external camera, the road type recognition unit 120 recognizes that the moving object 1 is moving on a sidewalk regardless of the lane score Sr.
[0047] To explain more specifically. First, the road type recognition unit 120 classifies each pixel in the frame of the image into categories and assigns labels by semantic segmentation, assuming multiple areas and their boundaries that are virtually divided. The road type recognition unit 120 classifies at least the area of the image captured by the external camera into an area where the moving body 1 exists (hereinafter, the current area) and an area adjacent to the current area and where the moving body 1 does not exist (hereinafter, the adjacent area) and performs processing.
[0048] Figure 3 is a diagram illustrating a plurality of first phenomena. It should be noted that Figure 3 as well as Figure 4 For the purpose of explanation, a bird's-eye view is used for representation, but the processing of the road type recognition unit 120 may also be performed on the image plane. As shown in the figure, the first phenomenon includes two or more phenomena, for example, (A) there is no static obstacle 204 other than the vehicle 203 in the area 200 (i.e., the area where the moving body 1 is located inside the outer edge), (B) the vehicle 203 is moving in the area 200, (C) there is a road marking 205 on the road surface of the area 200, (D) there is a crosswalk 206 in the area 200, and (E) the area 200 is located on the lower step side relative to the step 202. Static obstacles are obstacles such as standing signs, mailboxes, telephone poles, and trash cans that are not classified as moving bodies or traffic participants. Generally, static obstacles are rarely placed in lanes, so when there is no static obstacle 204 in the area 200, the road type recognition unit 120 increases the value of the lane score. In addition, the area where the vehicle 203 is moving is likely to be a lane, so the road type recognition unit 120 increases the value of the lane score when the vehicle 203 is moving in the area 200. In addition, the road surface marking 205 is usually drawn on the lane, so the road type recognition unit 120 increases the value of the lane score when the road surface marking 205 exists in the area 200. In addition, the pedestrian crossing 206 is usually drawn on the lane, so the road type recognition unit 120 increases the value of the lane score when the pedestrian crossing 206 exists in the area 200. In addition, the sidewalk is usually located on the upper step side of the steps relative to the lane, so the road type recognition unit 120 increases the value of the lane score when the area 200 is located on the lower step side of the steps 202.
[0049] Figure 4 is a diagram illustrating a plurality of second phenomena. Figure 4In the figure, the relationship between the area 200 and the adjacent area 201 becomes reversed according to the position of the moving body 1. As shown in the figure, the second phenomenon includes, for example, one or more of the following phenomena: (a) the second surface 207b facing the sidewalk of the two surfaces of the guardrail 207 is photographed by the external camera, (b) there is a blind brick 208 on the road surface of the area 200, (c) there is a static obstacle 204 other than the vehicle 203 in the area 200, and (d) the area 200 is located on the upper step side relative to the step 202. The guardrail 207 has a first surface 207a facing the lane side and a second surface 207b facing the sidewalk side, and the first surface 207a and the second surface 207b are arranged on the road in such a manner as to follow the orientation. When the second surface 207b is photographed by the external camera, it is inferred that the moving body 1 is moving on the sidewalk with a high probability. In addition, the blind brick is usually laid only on the sidewalk. The static obstacle 204 and the step 202 are as described in the first phenomenon.
[0050] Figure 5 This is a diagram illustrating the second surface 207b of the sidewalk side of the guardrail 207. As shown in the figure, the second surface 207b has a feature that the support 207c is located on the front side compared to the first surface, and is curved from the upper end to the bottom in the order of concave → convex → concave. By, for example, having a learned model learn this feature in advance, discrimination using image analysis can be achieved.
[0051] In this way, by setting the first phenomenon as a factor that increases the lane score Sr, when the lane score Sr is above the first threshold Th1 and the second phenomenon is not identified, it is identified as the moving body 1 moving in the lane, and it is possible to appropriately identify whether the moving body 1 is moving in the lane or in a specified area different from the lane. As described later, when the moving body 1 is moving in the lane, it is allowed to move at a higher speed than when it is moving on the sidewalk. Therefore, the condition for identifying that the moving body 1 is moving in the lane is preferably set conservatively compared to the condition for identifying that it is moving on the sidewalk in consideration of safety. In this regard, according to an embodiment, by setting the first phenomenon not as a condition for direct identification as a lane but as a condition for increasing the score, and setting the second phenomenon as a condition for direct identification as a sidewalk, the appropriateness of the identification result can be ensured.
[0052] The road type recognition unit 120 may also compare the position information of the moving body 1 with the map information 72 to recognize whether the moving body 1 is moving on a lane or a sidewalk. In this case, the map information needs to have a degree of accuracy that can distinguish the sidewalk from the lane based on the position coordinates. In addition, when the "prescribed area" is not only the sidewalk, the road type recognition unit 120 also performs the same processing on the roadside area, bicycle lane, open space, etc.
[0053] Figure 61 is a flowchart showing an example of the flow of processing executed by the road type recognition unit 120 according to the embodiment. First, the road type recognition unit 120 acquires information for recognition, such as an image from an external camera (step S300 ).
[0054] Next, the road type recognition unit 120 performs the processing of steps S302 and S304 on the first phenomenon k (k=1~n). The independent variable k is the identification information of the first phenomenon. The road type recognition unit 120 determines whether the first phenomenon k is recognized (step S302). If the first phenomenon k is recognized, the product of the coefficient αk and the score Pk is added to the lane score Sr (step S304).
[0055] Next, the road type identification unit 120 determines whether the second phenomenon j is identified for each second phenomenon j (j=1 to m) (step S306 ). The independent variable j is identification information of the second phenomenon, and m is a natural number.
[0056] When a positive determination result is obtained at least once in the determination process of step S306 which is performed a maximum of m times, the road type identification unit 120 recognizes that the moving object 1 is moving on a sidewalk (step S312 ).
[0057] When a negative determination result is obtained in all the determination processes of step S306, the road type recognition unit 120 determines whether the lane score Sr is greater than the first threshold value Th1 (step S308). When it is determined that the lane score Sr is greater than the first threshold value Th1, the road type recognition unit 120 recognizes that the moving body 1 is moving in the lane (step S310). When the lane score Sr is less than the first threshold value Th1, strictly speaking, it is not recognized with sufficient confidence whether the moving body 1 is moving in the lane or on the sidewalk, but the road type recognition unit 120 recognizes that the moving body 1 is moving on the sidewalk in consideration of safety (step S312).
[0058] The object recognition unit 130 recognizes objects existing around the mobile body 1 based on the output of the external detection device 10. Objects include some or all of mobile bodies such as vehicles, bicycles, pedestrians, road boundaries such as road dividing lines, steps, guardrails, shoulders, and central medians, road signs, signs, and other structures set on the road, and obstacles such as (fallen) fallen objects existing on the road. The object recognition unit 130 obtains information such as the existence, position, and category of other mobile bodies by, for example, inputting an image captured by an external camera to a learned model that has been learned in a manner that outputs information such as the existence, position, and category of objects when an image captured by an external camera of the external detection device 10 is input. The category of other mobile bodies can also be estimated based on the size in the image, the intensity of the reflected wave received by the radar device of the external detection device 10, and the like. In addition, the object recognition unit 130 can obtain, for example, the speed of other mobile bodies detected by the radar device using Doppler shift or the like.
[0059] The control unit 140 controls the drive device 40 according to the set driving mode, for example. It should be noted that the mobile body 1 may also execute only a part of the following driving modes, but the control unit 140 makes the speed limit value different when the mobile body 1 moves in a lane and when it moves on a sidewalk. In this case, the mode switching switch 22 can be omitted.
[0060] In mode A-1, the control unit 140 refers to the information of the travel path and the object obtained based on the output of the object recognition unit 130, and when the moving body 1 moves in the lane, the control unit 140 controls the motor MT of the drive device 40 in such a manner that the distance to the object existing in front of the moving body 1 is maintained at a certain distance or more, and when the distance to the object existing in front of the moving body 1 is sufficiently long, the moving body 1 moves at the first speed V1. The first speed V1 is, for example, a speed of more than ten [km / h] and less than several tens [km / h], and is adjusted based on the width of the travel path on which the moving body 1 moves, etc. as described later. When the moving body 1 moves on the sidewalk, the control unit 140 controls the motor MT of the drive device 40 in such a manner that the distance to the object existing in front of the moving body 1 is maintained at a certain distance or more, and when the distance to the object existing in front of the moving body 1 is sufficiently long, the moving body 1 moves at the second speed V2 (for example, a speed less than ten [km / h]). This function is the same as the ACC (Adaptive Cruise Control) function of a vehicle that sets the first speed V1 or the second speed V2 to a set speed, and the technology used in ACC can be used. In addition, in mode A-1, the control unit 140 controls the steering device SD in a manner that changes the steering angle of the steering wheel based on the amount of operation of the operating member 14 such as the steering wheel. This function is the same as the function of the power steering device, and the technology used in the power steering device can be used. It should be noted that it is also possible that the steering is not electronically controlled, and the mobile body 1 has a steering device in which the operating member 14 is mechanically connected to the steering mechanism.
[0061] In mode A-2, the control unit 140 refers to the information of the travel path and the object obtained based on the output of the object recognition unit 130, generates a target trajectory that allows the vehicle 1 to move while avoiding the object in the travel path, and controls the steering device SD of the drive device 40 so that the vehicle 1 moves along the target trajectory. Regarding acceleration and deceleration, the control unit 140 controls the motor MT of the drive device 40 based on the speed of the vehicle 1 and the operation amount of the accelerator pedal or the brake pedal. The control unit 140 controls the motor MT of the drive device 40 by setting the first speed V1 as the upper limit speed when the vehicle 1 is moving in the lane (which means that in the case of mode A-2, the vehicle 1 is not accelerated even if there is a further acceleration instruction when the upper limit speed is reached), and controls the drive device 40 by setting the second speed V2 as the upper limit speed when the vehicle 1 is moving on the sidewalk.
[0062] In mode B, the control unit 140 controls the motor MT of the drive device 40 based on the speed of the vehicle 1 and the amount of operation of the accelerator pedal or the brake pedal. When the vehicle 1 is moving in a lane, the control unit 140 controls the motor MT of the drive device 40 with the first speed V1 as the upper limit speed (which means that in mode B, when the upper limit speed is reached, even if there is a further acceleration instruction, the vehicle 1 is not accelerated), and when the vehicle 1 is moving on a sidewalk, the control unit 140 controls the motor MT of the drive device 40 with the second speed V2 as the upper limit speed. With regard to steering, it is the same as mode A-1.
[0063] In mode C, the control unit 140 refers to the information of the travel path and the object obtained based on the output of the object recognition unit 130, generates a target trajectory that can move in the travel path while avoiding the object, and controls the drive device 40 so that the moving body 1 moves along the target trajectory. In mode C as well, the control unit 140 controls the drive device 40 by setting the first speed V1 as the upper limit speed when the moving body 1 is moving in the lane, and controls the drive device 40 by setting the second speed V2 as the upper limit speed when the moving body 1 is moving on the sidewalk.
[0064] [Speed Adjustment]
[0065] The following is a description of the adjustment process of the first speed V1 performed by the control unit 140. The control unit 140 adjusts the first speed V1 based on the width of the travel path on which the mobile body 1 moves, etc. The travel path refers to an area sandwiched by the travel path boundaries such as road dividing lines, steps, guardrails, shoulders, and central median strips. In the case where the mobile body 1 moves in a lane of a road with multiple lanes, the travel path may mean a single lane or a single-side road including multiple lanes.
[0066] The control unit 140 determines the first speed V1 by performing adjustment such as subtracting the correction value ΔV1-1 from the upper limit value V1max of the first speed V1. Figure 7 : is a diagram showing an example of the relationship between the width W of the travel path and the correction value ΔV1-1. This information is stored in the storage device 70 as part of the program that specifies the control unit 140 or as table information referenced by the program. The smaller (narrower) the width W of the travel path, the more the control unit 140 increases the correction value ΔV1-1. It should be noted that the numerical values illustrated are just simple examples and do not define the invention. In addition, instead of determining the first speed V1 by adjusting the correction value ΔV1-1 from the upper limit value V1max of the first speed V1, the first speed V1 can be determined by multiplying the upper limit value V1max of the first speed V1 by a coefficient γ-1 that is less than 1. In this case, "increasing the correction value ΔV1-1" can be replaced with "reducing the coefficient γ-1".
[0067] By adjusting the first speed V1 in this way, the speed control of the moving body that can move on the lane and the sidewalk can be appropriately performed. This is because the fact that the width W of the travel path is small indicates that the lane and the sidewalk are separated only by the road dividing line, or the width of the sidewalk is narrow, or the legal speed is relatively low. In such a case, it is preferable to appropriately limit the first speed V1 and move.
[0068] In addition, the control unit 140 may adjust the first speed V1 based on the lane score Sc calculated by the road type recognition unit 120. For example, the higher the lane score, the higher the first speed V1 is set by the control unit 140. In this case, the control unit 140 determines the first speed V1 by, for example, further subtracting a correction value ΔV1-2, which becomes a larger value as the lane score is lower, from the adjusted first speed V1. Figure 8 1-2 is a diagram showing an example of the relationship between the lane score Sc and the correction value ΔV1-2. Here, it is assumed that the lane score is calculated within the range of 0 to 100, and the threshold Th is 60. This information is stored in the storage device 70 as part of the program that specifies the control unit 140 or as table information referenced by the program. It should be noted that the numerical values exemplified are just simple examples and do not define the invention.
[0069] By adjusting the first speed V1 in this way, the speed control of the moving body that can move in the lane and the sidewalk can be appropriately performed. This is because the low lane score Sc means that even if the moving body 1 is recognized as moving in the lane, the possibility is relatively low. In such a case, it is preferable to appropriately limit the first speed V1 and move.
[0070] In the above description, the first speed V1 is determined by reducing the value based on various phenomena with reference to the upper limit value V1max of the first speed V1. However, the first speed V1 may be increased according to conditions.
[0071] Fig. 9 1 is a diagram showing an example of a process flow executed by the control unit 140 of the embodiment. The process of this flowchart is executed when the road type recognition unit 120 recognizes that the moving object 1 is moving in the lane. First, the control unit 140 obtains the width W of the travel path from the road type recognition unit 120 or the object recognition unit 130 (step S200), and determines the correction value ΔV1-1 based on the width W of the travel path (step S202).
[0072] Next, the control unit 140 obtains the lane score Sc from the road type recognition unit (step S204 ), and determines the correction value ΔV1 - 2 based on the lane score Sc (step S206 ).
[0073] Then, the control unit 140 subtracts the correction value ΔV1 - 1 and the correction value ΔV1 - 2 from the upper limit value V1max of the first speed V1 to determine the first speed V1 (step S208 ).
[0074] It should be noted that the control unit 140 may selectively perform any one of the correction based on the width W of the travel path and the correction based on the lane score Sc. In this case, the control unit 140 may perform a correction to make the upper limit value V1max of the first speed V1 smaller. That is, the control unit 140 may compare the correction value ΔV1-1, which is the adjustment amount of the first speed V1 based on the width W of the travel path, with the correction value ΔV1-2, which is the adjustment amount of the first speed based on the lane score Sc. When the correction value ΔV1-1 is larger than the correction value ΔV1-2, the control unit 140 may determine the first speed V1 by subtracting only the correction value ΔV1-1 from the upper limit value V1max of the first speed V1. When the correction value ΔV1-1 is less than the correction value ΔV1-2, the control unit 140 may determine the first speed V1 by subtracting only the correction value ΔV1-2 from the upper limit value V1max of the first speed V1. In this way, the vehicle 1 can be driven at an appropriate speed without excessively reducing the speed.
[0075] According to the embodiment described above, it is possible to appropriately perform speed control of a moving object that can move in a lane and a predetermined area different from the lane.
[0076] <Modification>
[0077] In the above embodiment, when a second phenomenon is recognized, the moving body 1 is recognized as moving on the sidewalk, but when the second phenomenon is recognized and the lane score Sr is greater than or equal to the second threshold Th2 (Th1<Th2), an exception process may be performed.
[0078] The case where the second phenomenon is recognized and the lane score Sr is greater than or equal to the second threshold value Th2 means that one or more second phenomena are recognized even though the possibility that the moving object 1 is moving in the lane is high due to the lane score Sr reaching a large value. In such a case, there is a possibility that the recognition of the second phenomenon is erroneous, or the second phenomenon is recognized because a static obstacle is accidentally placed in the lane, or the lane is located on the upper side of a step in an irregular road structure.
[0079] Therefore, in such a case, the road type identification unit 120 may not directly determine that the moving object 1 is moving on the sidewalk, but may perform the following exceptional processing.
[0080] For example, the exception processing means that (1) if the immediately previous recognition result is "the moving object 1 is moving in the lane", the recognition result is maintained for a certain period of time, and if the immediately previous recognition result is "the moving object 1 is moving on the sidewalk", it is recognized that the moving object 1 is moving on the sidewalk. It should be noted that, after a certain period of time, when the state of "the second phenomenon is recognized and the lane score Sr is greater than the second threshold value Th2" continues, the road type recognition unit 120 may recognize that the moving object 1 is moving on the sidewalk.
[0081] In addition, the exception processing may also mean that (2) information is outputted to the occupant P of the moving body 1 in some form to inquire whether the moving body 1 is moving on a lane or a sidewalk, and whether the moving body 1 is moving on a lane or a sidewalk is identified based on the answer of the occupant P. In this case, the answer of the occupant P may be made, for example, via a road type input switch (not shown) provided on the moving body 1 or by voice.
[0082] The above-described embodiment can be expressed as follows.
[0083] A control device for a moving object, wherein:
[0084] The control device of the mobile body comprises:
[0085] a storage medium that stores computer-readable instructions; and
[0086] a processor connected to the storage medium,
[0087] The processor performs the following processing by executing the computer-readable instructions:
[0088] Based on the output of an external detection device that detects the external condition of a moving body that can move both in a lane and in a predetermined area different from the lane, identifying whether the moving body is moving in the lane or in the predetermined area; and
[0089] limiting the speed of the moving object when it moves in the lane to a first speed, and limiting the speed of the moving object when it moves in the prescribed area to a second speed lower than the first speed,
[0090] The process of limiting the speed of the moving object to a first speed when the moving object moves in the lane includes a process of adjusting the first speed based on a width of a travel path on which the moving object moves.
[0091] Although specific embodiments of the present invention have been described above using the embodiments, the present invention is not limited to such embodiments at all, and various modifications and substitutions can be made without departing from the gist of the present invention.
[0092] Description of Reference Numerals
[0093] 10 External Detection Device
[0094] 12 Moving body sensor
[0095] 14 Operating parts
[0096] 16 Internal Camera
[0097] 18 Positioning device
[0098] 22 Mode switch
[0099] 30 Mobile mechanism
[0100] 40 Drive unit
[0101] 50 External reporting device
[0102] 70 Storage Device
[0103] 100 Control device
[0104] 120 Road type identification unit
[0105] 130 Object Recognition Unit
[0106] 140 Control Department.
Claims
1. A control device for a mobile object, wherein the mobile object can move in both a lane and a predetermined area different from the lane, wherein: The control device of the mobile body comprises: a road type recognition unit that recognizes whether the moving body is moving in a lane or in the prescribed area based on an output of an external detection device that detects an external condition of the moving body; and a control unit that limits the speed of the moving body to a first speed when the moving body moves in the lane, and limits the speed of the moving body to a second speed lower than the first speed when the moving body moves in the predetermined area, The control unit adjusts the first speed based on a width of a travel path along which the moving body moves.
2. The control device for a moving object according to claim 1, wherein: The road type recognition unit recognizes whether the moving object is moving in the lane or in the predetermined area based on a lane score indicating the possibility that the moving object is moving in the lane, the lane score being calculated based on the output of the external environment detection device. The control portion adjusts the first speed based on the lane score.
3. The control device for a moving object according to claim 2, wherein: The control unit sets the first speed to a higher value as the lane score is higher.
4. The control device for a moving object according to claim 2 or 3, wherein: the control unit compares an adjustment amount of the first speed based on the width of the travel path with an adjustment amount of the first speed based on the lane score, When the adjustment amount of the first speed based on the width of the travel road is greater than the adjustment amount of the first speed based on the lane score, the first speed is adjusted based on the width of the travel road, When the adjustment amount of the first speed based on the width of the travel path is equal to or smaller than the adjustment amount of the first speed based on the lane score, the first speed is adjusted based on the lane score.
5. A method for controlling a moving object, wherein a computer controls the moving object, the moving object being capable of moving in both a lane and a predetermined area different from the lane, wherein: The control method of the mobile body causes the computer to perform the following processing: Based on the output of the external detection device that detects the external condition of the moving body, identifying whether the moving body is moving in the lane or in the prescribed area; and limiting the speed of the moving object when it moves in the lane to a first speed, and limiting the speed of the moving object when it moves in the prescribed area to a second speed lower than the first speed, The process of limiting the speed of the moving object to a first speed when the moving object moves in the lane includes a process of adjusting the first speed based on a width of a travel path on which the moving object moves.
6. A storage medium storing a program for controlling a moving object by a computer, wherein the moving object can move in both a lane and a predetermined area different from the lane, wherein: The program causes the computer to perform the following processing: Based on the output of the external detection device that detects the external condition of the moving body, identifying whether the moving body is moving in the lane or in the prescribed area; and limiting the speed of the moving object when it moves in the lane to a first speed, and limiting the speed of the moving object when it moves in the prescribed area to a second speed lower than the first speed, The process of limiting the speed of the moving object to a first speed when the moving object moves in the lane includes a process of adjusting the first speed based on a width of a travel path on which the moving object moves.
