WO2021199608A1 - 移動体制御システム - Google Patents

移動体制御システム Download PDF

Info

Publication number
WO2021199608A1
WO2021199608A1 PCT/JP2021/002149 JP2021002149W WO2021199608A1 WO 2021199608 A1 WO2021199608 A1 WO 2021199608A1 JP 2021002149 W JP2021002149 W JP 2021002149W WO 2021199608 A1 WO2021199608 A1 WO 2021199608A1
Authority
WO
WIPO (PCT)
Prior art keywords
moving body
acceleration
occupant
control
information
Prior art date
Application number
PCT/JP2021/002149
Other languages
English (en)
French (fr)
Inventor
剛 酒寄
絢也 高橋
Original Assignee
株式会社日立製作所
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社日立製作所 filed Critical 株式会社日立製作所
Priority to US17/640,888 priority Critical patent/US12005898B2/en
Priority to EP21782308.7A priority patent/EP4129790A4/en
Publication of WO2021199608A1 publication Critical patent/WO2021199608A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14Adaptive cruise control
    • B60W30/16Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/22Platooning, i.e. convoy of communicating vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18145Cornering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/0098Details of control systems ensuring comfort, safety or stability not otherwise provided for
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0022Gains, weighting coefficients or weighting functions
    • B60W2050/0024Variable gains
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/06Direction of travel
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/225Direction of gaze
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/30Road curve radius
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4041Position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2720/00Output or target parameters relating to overall vehicle dynamics
    • B60W2720/10Longitudinal speed
    • B60W2720/106Longitudinal acceleration

Definitions

  • the present invention relates to a mobile control system.
  • ADAS advanced driver assistance systems
  • Adaptive cruise control, lane keep assist system, emergency automatic braking, etc. have been put into practical use as functions for automating a part of driving operation.
  • all of these are systems that automatically control only one of the front-back movement and the lateral movement of the vehicle.
  • Linked control of motion and lateral motion is required.
  • the linkage between the back-and-forth motion and the lateral motion generated in the vehicle is determined in advance from the velocity (V) and the lateral acceleration (Gy) in the lateral jerk (Gy_dot) of the vehicle input in Patent Document 1.
  • a vehicle motion control method that multiplies the calculated gain (Cxy), generates a control command for controlling the front-rear acceleration of the vehicle based on the multiplied value, and outputs the generated control command is disclosed.
  • the trajectory of the combined acceleration vector (G) of the longitudinal acceleration and the lateral acceleration is oriented so as to draw a smooth curve in the coordinate system where the center of gravity of the vehicle is fixed (Vectoring), and G-Vectoring control (GVC: G-). It is called Vectoring Control).
  • this GVC it has been reported that the emergency avoidance performance is significantly improved (see Non-Patent Document 1).
  • Patent Document 2 discloses a method of accelerating or decelerating based on a time change of a curve curvature in a traveling course in front of the own vehicle. According to this method, it is possible to realize continuous deceleration from before the lateral acceleration is generated in the own vehicle to the turning transient period in which the absolute value of the lateral acceleration increases.
  • This technology is called Preview G-Vectoring Control (PGVC: Preview G-Vectoring Control) because it adds forward gaze information to the G-Vectoring control (see Non-Patent Document 2).
  • Patent Documents 1 and 2 describe a method of linking a back-and-forth motion and a lateral motion when traveling on a curved road to smoothly travel in a single vehicle. Neither document mentions acceleration / deceleration methods when a plurality of vehicles are traveling in a platoon.
  • Patent Document 3 describes a platooning speed pattern based on the target speed pattern of the own vehicle and the target speed pattern of another vehicle.
  • a method of generating the vehicle at any time and controlling the traveling of the vehicle according to the platoon traveling speed pattern is disclosed.
  • Patent Document 4 discloses a method of sharing a travel plan set in advance for vehicles in a platoon and changing the order of the platoon of vehicles in order from a vehicle having a later start timing of deceleration control.
  • Japanese Unexamined Patent Publication No. 2009-262701 Japanese Unexamined Patent Publication No. 2012-030674 Japanese Unexamined Patent Publication No. 2008-110620 Japanese Unexamined Patent Publication No. 2008-204094
  • a platoon is formed by a plurality of moving bodies
  • the plurality of moving bodies include an empty vehicle on which the occupant is not on board or a carrier that carries luggage, the occupant's It is necessary to carry out exercises that prioritize transportation efficiency such as the movement speed and number of platoons over ride comfort.
  • the present invention has been made in view of the above circumstances, and an object of the present invention is both the comfort of a occupant on a moving body and the efficiency of transporting luggage when traveling in a platoon with a plurality of moving bodies.
  • the purpose is to provide a mobile control system that can improve the above.
  • the mobile body control system is a mobile body control system for platooning a plurality of mobile bodies along a preset traveling path, and is a preceding moving body and a succeeding moving body.
  • the front-rear acceleration calculation unit is provided with a front-rear acceleration calculation unit that calculates the front-rear acceleration in the traveling path of the vehicle, and the front-rear acceleration calculation unit adjusts the gain of the calculation formula for calculating the front-rear acceleration based on the information of the transported object conveyed by each moving body. It is characterized by doing.
  • the relationship between the anteroposterior acceleration and the lateral acceleration generated before a group of moving bodies traveling in a straight section in a platoon reaches a steady turning state is suitably changed for all moving bodies in the platoon. It can be controlled so that it can be controlled, and the effect of improving the comfort of the occupants of each moving body and the transportation efficiency of luggage can be expected.
  • the figure which showed a part of the shape of the road including a curved section The figure which showed the traveling state at the time of traveling on a curved road when the anteroposterior acceleration control with respect to the platooning by the reference method 1 is shown, (a) shows the lateral acceleration and the anteroposterior acceleration of each moving body, and (b) shows the separation distance.
  • the figure which showed the relationship between the lateral acceleration and the front-back acceleration of each moving body at the time of traveling on a curved road when the front-back acceleration control for platooning by the reference method 2 was performed.
  • the running state during traveling on a curved road when negative forward / backward acceleration control with respect to platooning is performed (a) shows the lateral acceleration and the front-back acceleration of each moving body, and (b) shows the separation distance. ..
  • the traveling state at the time of traveling on a curved road when positive longitudinal acceleration control for platooning is performed (a) is the lateral acceleration and the longitudinal acceleration of each moving body, (b) is the separation distance, and (c).
  • the figure provided for the operation example when the moving body traveling direction and the occupant direction are different.
  • FIG. 24D shows the change in the front-back acceleration
  • FIG. 24D is a diagram showing the change in the front-back acceleration between the leading moving body and the following moving body when the occupant of the leading moving body is looking backward.
  • FIG. -G shows the relationship between the front-rear acceleration and the lateral acceleration when the front-back acceleration control in the present embodiment is applied
  • FIG. -G diagram
  • FIG. 25 (b) is the" g "diagram when the occupant of the following moving object is looking forward
  • FIG. 25 (c) is the case where the occupant of the preceding moving object is looking backward.
  • “Gg” diagram It is a flowchart explaining the content of the back-and-forth acceleration control in this embodiment. The figure explaining the modification of this embodiment.
  • FIGS. 1 to 11 four platooning mobile groups (moving body 0, moving body 1, moving body). 2.
  • the acceleration control method for the moving body 3) from a straight road to a curve entry and a steady turning state will be described while comparing the differences between the reference method 1, the reference method 2, and the method according to the method of the present invention.
  • the acceleration in the x direction is the front-back acceleration.
  • the acceleration in the y direction is the lateral acceleration.
  • the front-back acceleration is positive in the front direction of the moving body, that is, the front-back acceleration that increases the speed of the moving body when the moving body is moving in the front direction is positive.
  • the lateral acceleration when the moving body is moving in the forward direction, the lateral acceleration generated when turning counterclockwise (counterclockwise) is positive, and the reverse direction is negative.
  • the counterclockwise turning radius is defined as positive, and the reciprocal thereof is defined as the traveling curvature of the moving body.
  • the counterclockwise turning radius is positive, and the reciprocal is the target path curvature (curvature of the traveling path).
  • the steering angle in the counterclockwise direction is positive.
  • each moving body in the platoon independently performs the G-Vectoring control as a front-back acceleration control for a curved road and as a front-back acceleration control linked to a lateral motion from the start of turning to a steady turning. Shall be done.
  • the speed profile is shared within the platoon, and the same front-rear acceleration control is performed at the same timing for all the moving bodies in the platoon to change the separation distance between the front-rear moving bodies. It shall run without.
  • G-Vectoring control is performed as in the reference method 1 as the front-rear acceleration control for the curved road.
  • FIG. 1 is a diagram showing a part of the shape of the road including the curved section.
  • FIG. 1 shows a straight section (curvature 0) and a curvature monotonous change section (curvature monotonous acceleration) which is a relaxation curve section. (Change), curved road with constant curvature section (steady turning) (road including curved section), and multiple moving bodies (moving body 0, moving body 1, moving body 2, moving body) running there (platooning)
  • the conceptual diagram of 3 is shown.
  • the traveling path of the moving body is assumed to be a curved road where lateral acceleration is generated.
  • Each moving body forms a platoon in the front-rear direction (traveling direction), follows each target route (traveling route) according to the course shape (road shape), and has a predetermined separation distance (d1: moving body 1-moving body 0).
  • D2 Moving body 2-moving body 1
  • d3 Moving body 3-moving body 2, for example, d1 ⁇ d2 ⁇ d3) Become.
  • FIG. 2 shows a running state during traveling on a curved road when the front-back acceleration control for platooning is performed by the reference method 1, (a) shows the lateral acceleration and the front-back acceleration of each moving body, and (b) shows the separation distance.
  • FIGS. 2A and 2B show the reference method 1 when the moving body 0, the moving body 1, the moving body 2 and the moving body 3 each travel on a curved road as shown in FIG. That is, when G-Vectoring control is performed independently for each moving body, the front-back acceleration and lateral acceleration of each moving body, and the separation distance between each moving body (moving body 1-moving body 0, moving body 2-moving body). 1. Moving body 3-moving body 2) is shown.
  • the curvature of the traveling path increases in each of the moving body 0, the moving body 1, the moving body 2, and the moving body 3, and the lateral acceleration (absolute value) is increased.
  • the longitudinal acceleration control G-Vectoring control
  • the separation distance between the moving bodies is gradually reduced as shown in FIG. 2 (b). ..
  • FIG. 3 shows the "gg" diagram, which is the relationship between the longitudinal acceleration and the lateral acceleration at this time.
  • FIG. 3 is a diagram showing the relationship between the lateral acceleration and the front-back acceleration of each moving body during traveling on a curved road when the front-back acceleration control for platooning is performed by the reference method 1.
  • the changes are the same for all moving bodies, and all moving bodies realize a smooth transition from longitudinal acceleration to lateral acceleration. Therefore, when the moving body does not move suddenly, for example, when a occupant is on the moving body, the riding comfort is preferable, and when a load is loaded on the moving body, the load collapse is prevented.
  • the separation distance decreases when entering a curve, so that there is a risk of collision between moving bodies traveling in a platoon.
  • the effect of improving the transportation density by platooning is reduced, and the scene is the same as the scene in which each moving body travels independently.
  • the separation distance suddenly decreases when entering a curve, for example, when an occupant is on a following moving object and the occupant's line of sight is facing forward, the preceding moving object appears to be approaching and collides. There is a risk of giving the occupants a feeling of anxiety and oppression that they may do so.
  • FIG. 4 shows a running state during traveling on a curved road when the front-back acceleration control for platooning is performed by the reference method 2, (a) shows the lateral acceleration and the front-back acceleration of each moving body, and (b) shows the separation distance.
  • FIGS. 4A and 4B show the reference method 2 when the moving body 0, the moving body 1, the moving body 2 and the moving body 3 each travel on a curved road as shown in FIG. That is, when the moving bodies in the platoon perform the front-back acceleration control with the same speed profile, the front-back acceleration and the lateral acceleration of each moving body, and the separation distance between each moving body (moving body 1-moving body 0, moving).
  • Body 2-moving body 1 and moving body 3-moving body 2 are shown.
  • the curvature of the traveling path of the moving body 0 increases in all of the moving body 0, the moving body 1, the moving body 2, and the moving body 3, and the movement
  • the same longitudinal acceleration control as the G-Vectoring control which starts at the timing when the lateral acceleration (absolute value) of the body 0 increases.
  • the separation distance between the moving bodies does not change, and the separation distance before the front-back acceleration control is performed. Can be maintained. Therefore, for example, even when the occupant is on the following moving body and the line of sight of the occupant is facing forward, the approaching movement of the preceding moving body does not give the occupant a feeling of anxiety or oppression.
  • FIG. 5 shows a “gg” diagram showing the relationship between the longitudinal acceleration and the lateral acceleration at this time.
  • FIG. 5 is a diagram showing the relationship between the lateral acceleration and the front-back acceleration of each moving body during traveling on a curved road when the front-back acceleration control for platooning is performed by the reference method 2.
  • the moving body 0 realizes a motion that smoothly transitions from the front-back acceleration to the lateral acceleration, the moving body 0 becomes lateral (moving body 1, moving body 2, moving body 3).
  • the negative front-back acceleration that occurs in the region where the acceleration is small increases, and the section where the front-back acceleration and the lateral acceleration are not linked increases. Therefore, the moving body (moving body 1, moving body 2, moving body 3) moves more rapidly as the distance from the moving body 0 increases, and the riding comfort deteriorates when an occupant is on the following moving body, for example.
  • a load is loaded on the following moving body, it may cause the load to collapse.
  • the occupant is riding in the platoon when traveling on a curved road while maintaining an appropriate separation distance during platooning so that the occupant does not feel anxiety or oppression due to the approach of other moving objects.
  • a plurality of moving bodies in the formation move the preceding moving bodies that travel in advance.
  • the following moving body that follows the body n and the moving body n (runs behind the moving body n) is defined as the moving body n + 1, and the separation distance between the two is dn + 1 (where n is a positive integer of 0 or more).
  • FIGS. 7 (a) and 7 (b) the front-rear acceleration control in a traveling scene (from a front of FIG. 1 to b of FIG. 1) in which a straight-ahead state transitions to a steady turning state will be described.
  • 7 (a) shows the time change of the lateral acceleration and the front-back acceleration of the moving body n in the formation and the moving body n + 1 which is the succeeding moving body that moves following the moving body n
  • FIG. 7 (b) shows both of them. It shows the time change of the separation distance dn + 1. As shown in FIG.
  • the moving body n + 1 which is the succeeding moving body, starts decelerating before the absolute value of its lateral acceleration increases, that is, starts turning, and the back-and-forth acceleration at the time t1 when the deceleration starts increases.
  • It is smaller than the front-back acceleration generated in the moving body n at the same time. That is, it is characterized in that the forward / backward acceleration control is performed so that the deceleration occurring in the moving body n + 1 which is the succeeding moving body at the same time becomes larger than the deceleration occurring in the moving body n which is the preceding moving body.
  • the moving body n + 1 which is the succeeding moving body, can acquire the traveling information of the moving body n, and the absolute value of the lateral acceleration of the moving body n increases, that is, the moving body n.
  • a negative forward / backward acceleration is generated and deceleration is started at a time t1 before the time t3 when the curvature of the traveling path ( ⁇ road curvature) increases and the turning is started.
  • the absolute value of the lateral acceleration of the moving body n also increases, that is, it is negative before turning.
  • the deceleration is started by generating the back-and-forth acceleration of Negative back-and-forth acceleration is generated in the body n and the moving body n + 1 to decelerate.
  • the separation distance dn + 1 between the two is increased.
  • the moving body n performs front-back acceleration control such as G-Vectoring control, which is a back-and-forth movement linked to a lateral movement.
  • front-back acceleration control such as G-Vectoring control, which is a back-and-forth movement linked to a lateral movement.
  • the back-and-forth acceleration control which is the back-and-forth movement linked to the lateral movement such as the G-Vectoring control is performed. If the deceleration occurring in the moving body n at this time is larger than the deceleration occurring in the moving body n + 1 (for example, as shown in FIG. 7A), the movement occurring in the section from the time t3 to the time t5. If the minimum value of the front-back acceleration of the moving body n + 1 generated in the section from the time t4 to the time t6 is controlled to be larger than the minimum value of the front-back acceleration of the body n), the separation distance dn + 1 between the two starts to decrease.
  • the separation distance dn + 1 between the two decreases.
  • the (negative) anteroposterior acceleration of the moving body n and / or the moving body n + 1 is controlled.
  • the distance between the two is separated at the time t6 when the moving body n + 1 starts a steady turn.
  • the distance dn + 1 can be the same as the separation distance before the time t1.
  • the separation distance at the time of steady turning can be set as the separation distance before the start of turning while realizing the front-back acceleration control that generates the back-and-forth movement linked to the lateral movement for each of the moving body n and the moving body n + 1.
  • FIGS. 8A to 8C the front-rear acceleration control in the traveling scene (from b in FIG. 1 to d and after in FIG. 1) in which the steady turning state is changed to the straight-ahead state will be described.
  • the forward / backward acceleration control in which the separation distance between the moving body n and the moving body n + 1 is set as the target value (target separation distance), and the moving body n and The front-rear acceleration control with the speed of the moving body n + 1 as the target value (target speed) is also performed.
  • FIG. 8A to 8C the front-rear acceleration control in the traveling scene (from b in FIG. 1 to d and after in FIG. 1) in which the steady turning state is changed to the straight-ahead state.
  • FIG. 8A shows the temporal changes in the lateral acceleration and the anteroposterior acceleration of the moving body n in the formation and the moving body n + 1 which is the succeeding moving body of the moving body n
  • FIG. 8B shows the separation distance dn + 1 between the two.
  • Time change FIG. 8 (c) shows the time change of both speeds.
  • the moving body n and the moving body n + 1 each have a substantially constant lateral acceleration, and the steady turning (the curvature of the traveling path ( ⁇ road curvature) is constant) (time t7 in the moving body n).
  • the time when the positive back-and-forth acceleration occurs is that the preceding moving body n (time t7) is higher than the following moving body n + 1 (time t8).
  • the preceding moving body n can acquire the traveling information of the following moving body n + 1, and the curvature of the traveling path of the following moving body n + 1 is reduced to reduce the absolute value of the lateral acceleration.
  • a positive forward / backward acceleration is generated in the moving body n at a time t7 before the time t8 when the movement starts to decrease.
  • a turning transition period (a straight-ahead state in which the curvature of the traveling path decreases from a steady turning state in which the curvature of the traveling path is constant and the absolute value of the lateral acceleration becomes zero) (in the moving body n, the time t7 to the time t9, the moving body
  • the maximum value of the anteroposterior acceleration generated from time t8 to time t10) at n + 1 is such that the moving body n + 1, which is the succeeding moving body, is larger than the moving body n, which is the preceding moving body (FIG. 8 (a)).
  • both (positive) forward / backward acceleration control is performed.
  • the curvature of the traveling path of the moving body n + 1, which is the following moving body, decreases and the absolute value of the lateral acceleration decreases, and the absolute value of the lateral acceleration (or the curvature of the traveling path) can be regarded as a straight running. (Here, about zero and a preset value)
  • the speed of the moving body n + 1 and / or the moving body n (here) so that the speed of the moving body n + 1 becomes larger than the speed of the moving body n.
  • the forward / backward acceleration (positive) is controlled (see FIG. 8 (c)).
  • the separation distance dn + 1 between the two is first increased (in the example shown in FIG. 8 (b), it is increased halfway between the time t9 and the time t10), and then the succeeding moving body.
  • the separation distance dn + 1 between the two decreases with the acceleration of n + 1.
  • the integrated value of the front-back acceleration from time t7 to time t12 of the moving body n and the integrated value from time t8 to time t11 of the moving body n + 1 are the speed before the start of positive front-back acceleration control and the target speed, respectively.
  • Set to be a difference and accelerate back and forth so that the sum of the integrated value between the time t7 and the time t12 of the relative speed ⁇ Vn + 1 of the two and the separation distance at the time t7 becomes the target separation distance during straight running (after the curve).
  • the moving body n and the moving body n + 1 can continue to travel at the target separation distance when the forward / backward acceleration control with respect to the curve is completed.
  • FIGS. 7 (a), 7 (b) and 8 (a) to 8 (c) show the relationship between the longitudinal acceleration and the lateral acceleration when the longitudinal acceleration control of the present invention shown in FIGS. 7 (a), 7 (b) and 8 (a) to 8 (c) is performed.
  • it is possible to provide an acceleration change in which the riding comfort in which the lateral movement and the front-back movement are linked is suitable.
  • FIGS. 10 (a), 10 (b) and 11 show an example in which the front-rear acceleration control according to the present invention is provided for the four platooning shown in FIG. 10 (a) and 10 (b) show the front-back acceleration and lateral acceleration of the moving body 0, the moving body 1, the moving body 2, and the moving body 3, and the separation distance between the moving bodies (moving body 1-moving body 0, Moving body 2-moving body 1, moving body 3-moving body 2) are shown, and FIG. 11 shows the relationship between the longitudinal acceleration and the lateral acceleration of the moving body 0, the moving body 1, the moving body 2, and the moving body 3 at this time (moving body 0, moving body 1, moving body 2, and moving body 3).
  • the “gg” diagram) is shown.
  • FIG. 10A different front-rear acceleration controls for the curved road are performed for each of the moving body 0, the moving body 1, the moving body 2, and the moving body 3 entering and exiting the curved road, and as a result,
  • FIG. 10B the separation distance between the moving bodies (moving body 1-moving body 0, moving body 2-moving body 1, moving body 3-moving body 2) is set from before the start of turning to the end of turning.
  • the increase / decrease is repeated twice (specifically, after the separation distance is once opened, the operation of closing the separation distance by the distance is performed), and finally the distance is converged to the initial separation distance d0.
  • FIG. 10B the separation distance between the moving bodies (moving body 1-moving body 0, moving body 2-moving body 1, moving body 3-moving body 2) is set from before the start of turning to the end of turning.
  • the increase / decrease is repeated twice (specifically, after the separation distance is once opened, the operation of closing the separation distance by the distance is performed), and finally the distance is converged to the initial separation distance
  • negative forward / backward acceleration is sequentially generated from the moving body at the end of the formation to start deceleration.
  • it may be controlled so that the front-rear acceleration generated becomes smaller (the deceleration becomes larger) as the moving body moves backward.
  • the relationship between the longitudinal acceleration and the lateral acceleration at this time is a circle from the origin 0 in all the moving bodies (moving body 0, moving body 1, moving body 2, moving body 3) in the formation. It can be seen that the shape is like drawing.
  • the front-rear acceleration control of the present invention even when passing through a curved road by platooning, the ride comfort in which lateral movement and front-back movement are linked to all moving bodies in the platoon while keeping the separation distance at a predetermined value or more. It is possible to provide an acceleration change that is suitable and prevents the load from collapsing.
  • the method of controlling the forward / backward acceleration when passing through a curved road during platooning is not limited to the method shown here, and the moving body n that runs ahead in the platoon and the moving body that follows the moving body n.
  • the absolute value of the lateral acceleration of the moving body n + 1 or the curvature ( ⁇ road curvature) of the traveling route the route on which the moving body n + 1 should travel on the road route
  • both of them When the anteroposterior acceleration of the moving body n + 1 or both the moving body n and the moving body n + 1 is controlled so that the separation distance increases, and the absolute value of the lateral acceleration of the moving body n + 1 or the curvature of the traveling path begins to increase.
  • the speed of the moving body n + 1 becomes smaller than the speed of the moving body n.
  • Any method may be used as long as it is a method of controlling the longitudinal acceleration of the moving body n and the moving body n + 1.
  • the separation distance dn + 1 between the moving body n and the following moving body n + 1 traveling in advance in the formation reduces the absolute value of the lateral acceleration of the following moving body n + 1 or the curvature of the traveling path ( ⁇ road curvature).
  • the front-back acceleration of the moving body n or both the moving body n and the moving body n + 1 is controlled so that the separation distance between the two increases, and the absolute value of the lateral acceleration of the moving body n + 1 or the curvature of the traveling path.
  • the speed of the moving body n + 1 is higher than the speed of the moving body n when Any method may be used as long as it is a method of controlling the forward / backward acceleration of the moving body n and the moving body n + 1 so as to be small.
  • a method may be used in which the separation distance dn + 1 between the two is increased before the absolute value of the lateral acceleration of the succeeding moving body n + 1 is increased by setting the value smaller than the front-back acceleration (large deceleration) of. Further, as a method other than that shown in FIG. 8A, for example, in FIG. 8A, at a timing earlier than the time t7, the moving body n + 1 (the forward / backward acceleration here is not zero). It may be a method of increasing the separation distance dn + 1 between the two before the absolute value of the lateral acceleration of the moving body n + 1 decreases by generating a front-rear acceleration larger than (may be).
  • control is performed to adjust the front-rear acceleration of each moving body traveling in a platoon according to the type and state of the transported object. For example, before and after the moving body n + 1 depending on whether or not the occupant is on the moving body n + 1 and, if the occupant is on the moving body n + 1, the occupant of the moving body n + 1 is gazing at the moving body n in front. Control is performed to adjust the acceleration. Specifically, when the occupant is on the moving body n + 1, the front-rear acceleration is adjusted so as to gradually increase or decrease the separation distance dn + 1 from before entering the curve to the steady turning, as compared with the case where the occupant is not on the moving body n + 1. Control is performed.
  • the separation distance dn + 1 is gradually increased or decreased from before entering the curve to the steady turning as compared with the case where the moving body n + 1 is not gazing. Control is performed to adjust the front-rear acceleration. Further, when the moving body n + 1 is loaded with a load that requires careful and careful handling such as precision equipment and fresh food, the separation distance dn + 1 is set more leniently as compared with the case where the moving body n + 1 is not loaded. Control is performed to adjust the front-back acceleration so that it increases or decreases.
  • the moving body n + 1 is a construction machine such as a dump truck and a transported object such as earth and sand is loaded and the position of the center of gravity is high, the position of the center of gravity is low due to unloading, even before entering the curve.
  • Control is performed to correct the front-rear acceleration so as to gradually increase or decrease the separation distance dn + 1 until a steady turn is reached.
  • each moving body 21 in the formation is shared by the moving body movement control device 1A, and the front-rear acceleration of each moving body 21 in the formation is individually controlled. ..
  • Each moving body 21 has an automatic driving device that automatically operates based on a control command output from the moving body motion control device 1A.
  • the mobile body motion control device 1A controls to adjust the front-rear acceleration of each moving body 21 according to the presence / absence of a transported object of each moving body 21, the content and properties of the transported object, and the like.
  • FIG. 12 is a conceptual diagram of the entire system equipped with the embodiment of the mobile control system according to the present invention.
  • the mobile body control system 1 is composed of a mobile body motion control device 1A and a plurality of mobile bodies 21.
  • the mobile body control system 1 transmits and receives information between the mobile body motion control device 1A and the plurality of mobile bodies 21, and the mobile body motion control device 1A combines the plurality of mobile bodies 21 into one mobile body group. Controls the platooning.
  • the mobile body motion control device 1A is provided outside the moving body 21, but it may be deployed inside the moving body 21 that travels in a platoon. Further, the moving body 21 may be deployed in the controller of the control center that is controlled from the outside.
  • the mobile body motion control device 1A includes a calculation device having a storage area, a calculation processing capacity, a signal input / output means, and the like, and has a platoon control calculation unit 1Aa and a travel control calculation unit 1Ab as internal functions.
  • the platoon control calculation unit 1Aa acquires the course shape, the outside world information, the moving body position information, the transported object information, and the moving body motion state information from each moving body 21, and based on these information, each moving body to run in the platoon. Create 21 target paths, target speeds, and target distances. Further, here, when the traffic information of the area where each moving body 21 travels in a platoon is obtained as the input to the moving body motion control device 1A, the traffic information is input to the platoon control calculation unit 1Aa, and each moving body 21 Target paths, target speeds, and target distances may be created.
  • the front-rear acceleration command value as a control command value for generating the front-rear acceleration is obtained from the target path, the target speed, the target separation distance, the moving body motion state information, etc. created by the formation control calculation unit 1Aa.
  • the moving body 21 is calculated individually and transmitted to each moving body 21.
  • the moving body 21 is a moving body capable of carrying a transported object such as a person or luggage, and in the present embodiment, at least one moving body for transporting a person is included in the plurality of moving bodies 21 constituting the formation. It is a condition that there is one.
  • Examples of the moving body 21 include general passenger cars, commercial vehicles, buses (including new mobility capable of transporting people), construction machines (dump trucks, etc.), and, for example, unmanned transport machines that automatically transport luggage and parts. It may be.
  • One moving body group formed by a plurality of moving bodies 21 traveling in a platoon is not limited to the same type of moving body 21, and may be composed of a combination of different types of moving bodies 21. It is possible, for example, to form a platoon by mixing a general passenger car and an unmanned carrier.
  • FIG. 13 is a conceptual diagram showing an example of a mobile body in the embodiment of the mobile body control system according to the present invention.
  • the moving body 21 shown in FIG. 13 is an automobile capable of carrying a plurality of occupants and is provided with an automatic driving device that automatically drives based on a control command value transmitted from the moving body motion control device 1A.
  • the moving body 21 When the moving body 21 receives the control command value from the moving body motion control device 1A, the moving body 21 can control the longitudinal acceleration and / or the lateral acceleration generated by itself (brake actuator 11, drive actuator 13, steering angle control actuator 16).
  • the control command value is transmitted to each control unit (brake control unit 10, drive torque control unit 12, steering angle control unit 15) that performs drive control of the above through the communication line 14.
  • the moving body 21 includes a sensor (acceleration sensor 2, gyro sensor 3, wheel speed sensor 8) for acquiring moving body motion state information, and a sensor (steering angle sensor 5, brake pedal sensor 17, accelerator pedal) for acquiring driver operation information.
  • Sensor 18 a sensor that acquires information on the transported object conveyed by the moving body 21, and a sensor that acquires the traveling path information of the traveling path on which the moving body 21 travels (course shape acquisition sensor 6, position detection sensor 9, Various information is acquired from the external communication unit 20 or the like that transmits / receives information by communicating with the external world information detection sensor 19) and a control device other than the own moving body, and transmitted to the moving body motion control device 1A.
  • the sensor for acquiring the moving body motion state information may be a sensor or means capable of acquiring moving body speed, longitudinal acceleration, lateral acceleration, and yaw rate, and is not limited to the above sensor configuration.
  • the moving body velocity may be obtained by differentiating the position information obtained by the Global Positioning System (GPS).
  • GPS Global Positioning System
  • the yaw rate, the longitudinal acceleration, and the lateral acceleration of the moving body may be acquired by using an image acquisition sensor such as a camera.
  • the moving body 21 does not have to have the input of the sensor directly.
  • necessary information may be acquired from another control unit (for example, the brake control unit 10) through the communication line 14.
  • the sensor for acquiring the driver operation information only needs to be able to acquire the operation amount of the steering wheel 4 by the driver and the operation amount of the brake pedal and the accelerator pedal (not shown). Does not have to have a direct sensor input. For example, necessary information may be acquired from another control unit (for example, the brake control unit 10) through the communication line 14.
  • the sensor that acquires the transported object information of the moving body 21 is composed of a camera that images the interior of the moving body 21 or the luggage compartment, or an infrared sensor or a laser sensor that senses the inside of the moving body 21. Then, whether the moving object 21 has a transported object such as a occupant or luggage on it, or is it in an empty vehicle or empty state, and if the transported object is on board, what is the content and type of the transported object, and what if it is an occupant? Acquire information such as the direction of the line of sight, whether you are riding in the correct direction or posture. These information may not have the input of the sensor, and may be acquired from, for example, a predetermined information input means.
  • the moving body 21 uses the Global Positioning System (GPS) as the self-position detection sensor 9 as a sensor for acquiring the travel path information, and detects obstacles around itself such as a camera and a radar as the outside world information detection sensor 19.
  • GPS Global Positioning System
  • a sensor capable of detecting a travelable area can be used, and as the course shape acquisition sensor 6, a navigation system or the like capable of acquiring its own travel route information can be used.
  • a sensor for acquiring self-moving vehicle travel path information any means can be used as long as it can acquire the course shape (also referred to as road shape) and external world information (travelable area) in the self-traveling direction, and is limited to these sensors. It's not something to do.
  • it may be a method of acquiring the course shape in front of the own mobile body 21 by communicating with the mobile body motion control device 1A or a device installed on the road that transmits road information, or an imaging means such as a camera. It may be a method of acquiring an image of the front and / or surroundings of the self-moving body 21 and acquiring the course shape in front of the self-moving body 21. Further, by any one of these means or a combination thereof, a method of acquiring the course shape in the traveling direction of the own moving body 21 from the unit that calculates the course shape through the communication line 14 may be used.
  • the out-of-vehicle communication unit 20 transmits and receives signals by communicating with a mobile movement control device 1A installed outside the mobile body by wireless or wired communication, and as a communication method, a cellular line or WiFi (a cellular line or WiFi) is used. It may be a communication method by wireless communication means such as (registered trademark), or a communication method by direct contact with another mobile body or road surface infrastructure system via a telegraph cable.
  • the moving body 21 outputs (transmits) its own traveling information (moving body information) to the moving body motion control device 1A via the external communication unit 20, and inputs (receives) a control command from the moving body motion control device 1A.
  • the traveling information (moving body information) includes a traveling route, a speed, a forward / backward acceleration control plan, a distance from another moving body, and the like.
  • the mobile body 21 may acquire the past travel data route of the road surface on which the mobile body 21 travels by communicating with the mobile body motion control device 1A by the external communication unit 20.
  • the mobile body information may be acquired by using a camera, radar, or the like as the external world information detection sensor 19 mounted on the mobile body 21 without using the vehicle external communication unit 20.
  • the acceleration / deceleration actuators capable of controlling the front-rear acceleration generated in the moving body 21 controls the force generated between the tire 7 and the road surface to generate the front-back acceleration in the moving body 21.
  • It is an actuator that can control, for example, a combustion engine that can control the control drive torque applied to the tire 7 by controlling the combustion state and can control the front-rear acceleration of the moving body 21, or the tire 7 by controlling the current.
  • An electric motor that can control the front-rear acceleration of the moving body 21 by controlling the control drive torque applied to the moving body 21, or a transmission that can control the front-rear acceleration of the moving body 21 by changing the gear ratio when transmitting power to each wheel.
  • an acceleration / deceleration actuator capable of controlling the front-rear acceleration, such as a friction brake that generates a front-rear acceleration on the moving body 21 by pressing a brake disc against the brake pads of each wheel, can be applied.
  • the moving body 21 When the moving body 21 receives the front-back acceleration command value from the moving body motion control device 1A, the moving body 21 uses the acceleration / deceleration actuator that can generate the front-back acceleration as the front-back acceleration generating means, and the acceleration / deceleration actuator (brake actuator 11, drive actuator 13). The front-rear acceleration command value is sent to the drive controller (brake control unit 10, drive torque control unit 12). Then, when the moving body 21 receives the lateral movement command value from the moving body motion control device 1A, the moving body 21 uses the steering angle control actuator 16 capable of generating the lateral motion as a turning motion generating means to control the drive of the steering angle control actuator 16. The steering angle command value as the lateral motion command value is sent to the actuator (rudder angle control unit 15).
  • the signal received by the moving body 21 from the moving body motion control device 1A may not be the front-back acceleration itself, but a signal capable of realizing the front-back acceleration command value by the acceleration / deceleration actuator.
  • the signal received by the moving body 21 from the moving body motion control device 1A is not the steering angle itself, but any signal that can realize the steering angle command value by the steering angle control actuator 16.
  • a control drive torque command value capable of realizing the front-rear acceleration command value is sent to the drive torque control unit 12.
  • the drive signal of the combustion engine that realizes the front-rear acceleration command value may be sent directly to the control actuator of the combustion engine without going through the drive torque control unit 12.
  • the hydraulic command value that realizes the front-rear acceleration command value is sent to the brake control unit 10.
  • the drive signal of the hydraulic friction brake drive actuator that realizes the front-rear acceleration command value may be sent directly to the hydraulic friction brake drive actuator without going through the brake control unit 10.
  • the acceleration / deceleration actuator that performs drive control according to the front-rear acceleration command value may be changed.
  • the combustion engine and the hydraulic friction brake are provided as the acceleration / deceleration actuator, the combustion engine is driven and controlled as long as the front-rear acceleration command value is within a range that can be realized by the control drive torque control of the combustion engine.
  • the front-rear acceleration command value is a negative value in a range that cannot be realized by the control drive torque control of the combustion engine
  • the hydraulic friction brake is driven and controlled together with the combustion engine.
  • the electric motor and the combustion engine are provided as the acceleration / deceleration actuators, the electric motor is driven and controlled when the time change of the front-rear acceleration is large, and the combustion engine is used when the time change of the front-rear acceleration is small.
  • the drive may be controlled.
  • the front-rear acceleration command value is driven and controlled by an electric motor, and if the front-rear acceleration command cannot be realized by the electric motor due to the state of the battery or the like, another acceleration / deceleration actuator (combustion engine, hydraulic friction brake, etc.) is used.
  • the drive may be controlled.
  • Ethernet may be used for communication with a sensor that acquires information on a self-moving vehicle that needs to exchange a large amount of data
  • CAN Controller Area Network
  • the mobile body motion control device 1A includes a calculation device having a storage area, a calculation processing capacity, a signal input / output means, and the like, and includes mobile body movement state information, driver operation information, self-moving body travel path information, and the like. Using various information obtained from the moving body 21, the front-back acceleration command value generated in each moving body 21 is calculated, and the control command value is transmitted to each moving body 21. Further, the mobile body movement control device 1A calculates a lateral movement command value to be generated in each moving body 21 from various information obtained from the moving body movement state information, the driver operation information, the self-moving body traveling path information, and the like, and each of them. It is transmitted to each of the moving bodies 21.
  • the control command value sent from the moving body motion control device 1A to each moving body 21 is the acceleration / deceleration actuator (brake actuator 11, drive actuator 13) mounted on the moving body 21, even if it is the front-rear acceleration command value itself. It may be a control parameter that can be calculated by the drive controller (brake control unit 10, drive torque control unit 12) to realize the front-rear acceleration command value.
  • the automatic driving control device 22 mounted on the moving body 21 is provided with the same control algorithm as the forward / backward acceleration control command value calculation for the curved road performed by the traveling control calculation unit 1Ab, and the traveling control calculation unit 1Ab is provided with the driving control calculation unit 1Ab.
  • Control parameters such as gain and threshold of the control algorithm may be sent.
  • the inter-vehicle distances do not necessarily have to be the same.
  • the target separation distance Dtgt_n + 1 between the moving body 21_n and the succeeding moving body 21_n + 1 may be changed according to the forward / backward acceleration control range that can be controlled by the moving body 21_n and the following moving body 21_n + 1. ..
  • the maximum front-rear acceleration and the minimum front-back acceleration that can be generated in each moving body 21 of the platooning, and the target separation distance between the moving body 21_n and the following moving body 21_n + 1 are set, and the maximum front-back acceleration and / or the minimum front-back acceleration and / or the minimum front-back acceleration.
  • the target separation distance may be changed according to the acceleration.
  • the target separation distance Dtgt_n + 1 is set to a value larger than the target separation distance Dtgt_n between the moving body 21_n and the preceding moving body 21_n-1 which is the moving body to follow.
  • the range in which the front-rear acceleration can be controlled is a value set in consideration of the ride comfort of the occupant in addition to the restrictions imposed by the actuator of the moving body, and the range in which the front-rear acceleration can be controlled is the case where there is no occupant in the moving body. , The value may be larger than when there is an occupant in the moving body.
  • FIG. 14 is a block diagram illustrating an internal function of the formation control calculation unit.
  • the target route and the target for platooning each moving body 21 based on the course shape, the outside world information, the moving body position information, the moving body movement state information, the platooning state information, and the transported object information. Processing is performed to calculate the speed and the target separation distance.
  • the platoon control calculation unit 1Aa includes a target route acquisition unit 31, a moving body motion state acquisition unit 32, a platoon information acquisition unit 33, a transported object information acquisition unit 34, and a permissible value calculation unit 35.
  • the target route acquisition unit 31 In the target route acquisition unit 31, the target route (traveling route) for platooning each moving body 21 as one moving body group from the moving body traveling path information (course shape, outside world information) and the moving body motion state information. And get the travelable area.
  • the target route (traveling route) is a route that each moving body 21 should travel on the course (road) route, and as a method of creating the target route, the target route is based on the course shape in which each moving body 21 travels. It may be a method of acquiring the past travel data route of the road surface on which each mobile body 21 travels by communication with an external device, and it may be a method of creating based on the route.
  • the target route acquisition unit 31 generates information on the target route that defines the route on which the moving body 21 travels, based on the outside world information and the moving body movement allowable value calculated by the allowable value calculating unit 35.
  • the information on the target route is information including the route L on which the moving body 21 travels and the passing time t of the moving body 21 at a predetermined position.
  • the information on the target route is not defined by the transit time information at the predetermined position, but may be defined by the information on the target speed at the predetermined position.
  • the route L specifically defines the coordinates of the target vertical position and the target horizontal position set on the target route at regular intervals.
  • the target traveling speed of the moving body 21 in the target trajectory is lowered as a whole.
  • the vehicle 20 can travel without large acceleration / deceleration.
  • the lateral acceleration allowable value CAy calculated by the allowable value calculation unit 35 is small, the curvature of the target path is reduced. As a result, the moving body 21 can travel without generating a large lateral acceleration Ay.
  • the moving body 21 can travel without a sudden yaw movement.
  • the moving body movement state acquisition unit 32 acquires the movement state (running speed, turning state, driver operation amount, etc.) of each moving body 21 from the moving body movement state information.
  • the platoon information acquisition unit 33 acquires the traveling information (moving body information) of each moving body 21 by communication by the external communication unit 20 or the like.
  • the platoon information acquisition unit 33 acquires information such as a position in the platoon, a traveling route, a speed, a forward / backward acceleration control plan, and a distance between moving objects 21 as platoon information. Further, the formation information acquisition unit 33 may receive the formation continuation possibility flag as the formation information in addition to the above information.
  • the transported object information acquisition unit 34 acquires information on the transported object transported by the moving body 21.
  • the transported object information can be acquired from each moving body 21, for example, or may be acquired by communication with an external device.
  • the transported object information includes, for example, information on the luggage on the moving body 21, information on the direction of the line of sight of the occupant when the occupant is on board, and the like.
  • the riding position and behavior of the occupant are estimated.
  • occupant behavior include sleeping, reading, and watching videos.
  • FIG. 16 is a block diagram showing a main part of the transported item information acquisition unit 34.
  • the transported object information acquisition unit 34 includes a line-of-sight information estimation unit 34a, a visual object estimation unit 34b, and an occupant direction estimation unit 34c.
  • the line-of-sight information estimation unit 34a detects or estimates the line-of-sight of the occupant based on the information in the moving body 21 obtained from the in-vehicle sensor. For example, the eye movement of the occupant may be tracked by a camera to estimate the line-of-sight information.
  • the visual target estimation unit 34b detects or estimates the visual target of the occupant and the behavior of the occupant based on the line-of-sight information output from the line-of-sight information estimation unit 34a.
  • the visual target estimation unit 34b detects or estimates the visual target of the occupant and the behavior of the occupant based on the line-of-sight information output from the line-of-sight information estimation unit 34a.
  • the visual object of the occupant is presumed to be outside the moving body, the visual object is not classified in detail, and the visual object is set as the moving object outside the moving body.
  • the occupant behavior is not classified in detail, and it is visually recognized outside the moving body.
  • the visual target and the occupant's behavior are determined in detail.
  • the visual object include a book, a document, a display, a conversation partner, and the like.
  • the method for discriminating the visual object include a method of estimating an object in front of the occupant's line of sight from a database and a method of estimating from a learning model (deep learning using image information as input).
  • the occupant behavior is estimated based on the line-of-sight information and the visual target information. This may estimate the occupant behavior from a learning model that directly estimates the occupant behavior.
  • Occupant direction estimation unit 34c based on the mobile unit of information obtained from the vehicle sensors, or the body of the occupant is facing in either direction (relative occupant direction D H against the traveling direction D C of the moving object) presume.
  • the permissible value calculation unit 35 is allowed to move the moving body based on the occupant information (visual target, occupant behavior, occupant direction, etc.) acquired from the transported object information acquisition unit 34 so as not to make the occupant feel uncomfortable.
  • the mobile movement tolerance C which is a control value, is determined.
  • the moving body motion permissible value C is for each of the physical quantities representing the moving body motion information, such as front-rear acceleration Ax, lateral acceleration Ay, vertical acceleration Az, yaw rate Ry, roll rate Rr, and pitch rate Rp. It is an acceptable value.
  • the occupant's boarding position is irrespective of whether it is the driver's seat or the rear seat.
  • the reference value S is a threshold value of a physical quantity that the occupant generally feels uncomfortable, and is ⁇ 0.2 G for a front-rear acceleration Ax, for example.
  • the reference value S increases in proportion to the speed at low speed, but is set to be constant after reaching a predetermined speed.
  • the moving body movement permissible value C is set to the suppression value S'which is smaller than the reference value S. That is, to set the reference value S 1 ⁇ S small suppression value S '1 ⁇ S' n than n to mobile movement allowance C 1 ⁇ C n.
  • the front-rear acceleration Ax and the vertical acceleration Az may cause blurring of the line of sight, which may cause discomfort or motion sickness of the occupant. .. Therefore, when the object to be visually recognized is grasped by the occupant (for example, during reading), the front-rear acceleration permissible value C Ax and the vertical acceleration permissible value C Az of the moving body are suppressed values smaller than the respective reference values S. Change to S'.
  • the moving body motion permissible value C is changed according to the type of the content to be viewed.
  • the permissible value C for moving body movement is made smaller when watching a slide show video than when watching a news video. do.
  • the moving body movement permissible value C is changed based on the occupant direction DH.
  • the visual target and passenger behavior also equals the traveling direction D C and the occupant direction D H is compared with the time that substantially coincides, mobile motion allowable value C when the traveling direction D C and the occupant direction D H are different Let be smaller.
  • the mobile motion tolerance which is one longitudinal acceleration tolerance C Ax and lateral acceleration allowance C Ay and C
  • the traveling direction D C and the occupant direction D H is equal reference value S Ax, S Ay smaller suppression value S 'Ax, S' is set to Ay.
  • FIG. 15 is a functional block diagram illustrating the internal configuration of the traveling control calculation unit 1Ab.
  • the travel control calculation unit 1Ab calculates the forward / backward acceleration of each moving body 21.
  • the travel control calculation unit 1Ab has a moving body motion control calculation unit 38, a control command transmission unit 36, and a control plan transmission unit 37.
  • the moving body motion control calculation unit 38 mounts the front-back acceleration control for the moving body 21 on the moving body 21 based on various information such as the target path, the target speed, and the target separation distance obtained by the moving body motion control device 1A.
  • the front-back acceleration command value to be realized by the actuator of the above and the front-back acceleration control plan for the curved path of each moving body 21 are calculated.
  • the moving body motion control calculation unit 38 calculates a front-back acceleration command value and a front-back acceleration control plan for each moving body 21 of the moving body group forming the platoon system, respectively.
  • the calculation result of the front-back acceleration command value is sent to the control command transmission unit 36, and the calculation result of the front-back acceleration control plan is sent to the control plan transmission unit 37.
  • the moving body motion control calculation unit 38 uses the target path acquisition unit 31, the moving body motion state acquisition unit 32, and the formation information acquisition. Based on the information obtained by the unit 33 and the transported object information acquisition unit 34, the actuator mounted on the moving body 21 calculates the steering angle command value traveling on the target route and sends it to the control command transmission unit 36. This steering angle command value is also calculated for each moving body 21 of the moving body group and sent to the control command transmitting unit 36, similarly to the calculation result of the front-rear acceleration command.
  • the front-rear acceleration command value for each moving body 21 created by the moving body motion control calculation unit 38, or both the front-back acceleration command value and the steering angle command value are used as control command values for the moving body. It is transmitted to the corresponding moving bodies 21 in the group, respectively.
  • Each moving body 21 can control the front-rear acceleration and / or the actual tire steering angle based on the front-rear acceleration command value created by the moving body motion control calculation unit 38, or both the front-rear acceleration command value and the steering angle command value.
  • a control command value is sent to each control unit (brake control unit 10, drive torque control unit 12, steering angle control unit 15) that performs drive control of various actuators (brake actuator 11, drive actuator 13, steering angle control actuator 16).
  • control plan transmission unit 37 transmits the front-rear acceleration control plan created by the moving body motion control calculation unit 38 to the corresponding moving bodies 21, respectively.
  • FIG. 20 is a flowchart showing the contents of processing in the mobile motion control device 1A of the present embodiment. The determination based on the flowchart of FIG. 20 is made for each of the plurality of moving bodies 21 forming the formation.
  • the moving body 21 to be calculated by the formation control calculation unit 1Aa target route acquisition unit 31, moving body motion state acquisition unit 32, formation information acquisition unit 33, and transported object information acquisition unit 34.
  • target route travelable range, speed control range, moving body motion state, preceding moving body traveling path, preceding moving body speed, preceding moving body front-rear acceleration control plan, preceding moving body separation distance, following moving body traveling route, following Information such as the moving body speed, the trailing moving body front-back acceleration control plan, and the following moving body separation distance (maximum front-back acceleration, minimum front-back acceleration, target separation distance, if necessary) is acquired.
  • the target path is converted as node point position data NPn (Xvn, Yvn) on the coordinates with the moving weight center position as the origin, the Xv axis with the direction of the moving body velocity vector as positive, and the Yv axis orthogonal to it.
  • NPn node point position data NPn (Xvn, Yvn) on the coordinates with the moving weight center position as the origin, the Xv axis with the direction of the moving body velocity vector as positive, and the Yv axis orthogonal to it.
  • n is an integer that increases from 0 to the point closest to the moving body, and increases to 1, 2, ..., Nmax in the direction of travel of the self-moving body.
  • nmax is the maximum value of the node point position data number n that can be acquired.
  • Yv0 which is a Yv-axis component of NP0, is a lateral deviation of the moving body.
  • each node point also has information such as a travelable range at the node point position and a vehicle speed control range.
  • the platoon information for the moving body that is the front part of the platoon in the platooning and does not have the preceding moving body, the information that "there is no preceding moving body" is acquired as the leading moving body information, and it is the last part of the platoon. For a moving body that does not have a succeeding moving body, the information "no succeeding moving body" is acquired as the succeeding moving body information.
  • the mobile body motion control device 1A determines whether or not the moving body 21 to be calculated has the preceding moving body front-rear acceleration control plan.
  • the moving body 21 to be calculated does not have the preceding moving body forward / backward acceleration control plan (NO in S45)
  • the moving body 21 to be calculated is the frontmost part of the platoon, that is, the moving body 21 at the beginning of the platoon. Judge that there is, and proceed to S47.
  • the moving body 21 to be calculated has the preceding moving body forward / backward acceleration control plan (YES in S45), it is assumed that the moving body 21 is the following moving body 21_n + 1 that follows the leading moving body 21_n and travels in S46. move on.
  • the moving body motion control device 1A calculates the front-back acceleration of the frontmost part of the formation, that is, the moving body 21_1 (moving body 0 in FIG. 1) at the head of the formation (front and back). Acceleration calculation A).
  • the front-back acceleration calculation A the front-back acceleration command value and the front-back acceleration control plan of the moving body 21_1 at the front of the platoon are calculated from the target route, the travelable range, the vehicle speed control range, and the moving body movement state.
  • the moving body motion control device 1A moves body motion control calculation unit 38
  • the moving body speed control device 1A causes the moving body speed to fall within the vehicle speed control range.
  • the target route has a curved road shape (a shape in which the absolute value of the road curvature of the traveling road ( ⁇ the curvature of the traveling route) increases to reach the maximum value or substantially constant, or the road curvature of the traveling route ( ⁇ the curvature of the traveling route).
  • the front-back acceleration command value based on the curved road shape is calculated.
  • the moving body motion control device 1A moving body motion control calculation unit 38
  • the absolute value of the road curvature of the traveling path ⁇ the curvature of the traveling path
  • the absolute value of the lateral acceleration generated in the moving body 21_1 increases. Negative longitudinal acceleration is generated (decelerated) in the section where a) See).
  • the moving body motion control device 1A moving body motion control calculation unit 38
  • the absolute value of the road curvature ( ⁇ the curvature of the traveling path) of the traveling path is reduced, and the absolute value of the lateral acceleration generated in the moving object 21_1 is reduced. Positive anteroposterior acceleration is generated (accelerated) in the section where )reference). After calculating the front-back acceleration command value, it is transmitted to the moving body 21_1 as a control command value.
  • FIG. 21 is a flowchart illustrating the contents of the forward / backward acceleration calculation A in S47.
  • the front-back acceleration calculation A whether or not the target path set for the moving body 21_1 has curve information, that is, whether or not the front-back acceleration control plan of the moving body 21_1 at the head of the formation has curve information. Judged. Then, when there is no curve information (NO in S51), that is, in the case of a straight road, the front-rear acceleration following the target speed is calculated (S52).
  • the moving body motion control device 1A determines whether or not there is curve information in the forward / backward acceleration control plan of the preceding moving body 21_n, that is, in front of the moving body 21_n + 1 to be calculated. It is determined whether or not the traveling preceding moving body 21_n has a front-rear acceleration control plan for a curved road.
  • the front-rear acceleration control plan acquired here may be a front-back acceleration profile from the current time to a predetermined time ahead and a front-back acceleration profile with a front-back acceleration control plan flag caused by a curved path added, or a node point.
  • the information may be added to the position information and the velocity profile or the front-rear acceleration profile at each node point position, and the profile information set due to the curved road may be added to the front-back / front-back of the preceding moving body 21_n with respect to the curved road. Any method can be used as long as the acceleration control plan can be understood. If there is no curve information in the front-back acceleration control plan of the preceding moving body 21_n, the process proceeds to S48 in order to calculate the front-back acceleration when the moving body 21_n to be calculated travels on a straight road. Further, when there is curve information, the process proceeds to S49 in order to calculate the forward / backward acceleration when the moving body 21_n + 1, which is the calculation target, travels on the curved road.
  • the moving body motion control device 1A performs the front-back acceleration command of the moving body 21_n + 1 to be calculated based on the front-back acceleration control plan of the preceding moving body 21_n as the front-back acceleration calculation B. Calculate the value and the front-back acceleration control plan (front-back acceleration calculation B). Specifically, the moving body motion control device 1A (moving body motion control calculation unit 38) has the moving body 21_n + 1 to be calculated with the leading moving body 21_n so as to maintain the separation distance from the leading moving body 21_n.
  • the target separation distance may be a preset value or a value acquired from the outside by a communication means. Further, the target separation distance may be changed according to the maximum front-rear acceleration and / or the minimum front-rear acceleration that can be generated in each moving body 21 of the platooning. After calculating the front-back acceleration command value, it is transmitted as a control command value from the moving body motion control device 1A to the moving body 21_n + 1 to be calculated.
  • FIG. 22 is a flowchart illustrating the contents of the forward / backward acceleration calculation B in S48.
  • the front-back acceleration calculation B the front-back acceleration calculation of the moving body 21_n + 1 of the calculation target in which the preceding moving body 21_n exists is performed.
  • the target path of the mobile body 21_n + 1 to be calculated does not have curve information (NO in S46), that is, there is no curve information in the forward / backward acceleration control plan of the mobile body 21_n + 1 to be calculated, and the plan is to travel on a straight road. Therefore, the acceleration / deceleration of the preceding moving body 21_n is acquired (S61).
  • the moving body motion control device 1A (moving body motion control calculation unit 38) performs the calculation target as the front-back acceleration calculation C based on the front-back acceleration control plan of the preceding moving body 21_n and the curve information in the moving body traveling direction. Calculates the front-back acceleration command value and the front-back acceleration control plan of the moving body 21_n + 1 (front-back acceleration calculation C). Specifically, in the moving body motion control device 1A (moving body motion control calculation unit 38), as described above, the curvature of the traveling path of the leading moving body 21_n increases and the lateral acceleration generated in the leading moving body 21_n increases.
  • the distance between the moving body 21_n + 1 to be calculated and the preceding moving body 21_n increases, and the curvatures of the traveling paths of the moving body 21_n + 1 and the preceding moving body 21_n to be calculated become substantially constant.
  • the front-rear acceleration command value and the front-back acceleration control flag caused by the curved path are set so that the separation distance is reduced to reach the target separation distance. Calculate the forward / backward acceleration control plan with the addition of. After calculating the front-back acceleration command value, it is transmitted from the server 100 to the mobile body 21_n + 1 to be calculated as a control command value.
  • FIG. 23 is a flowchart illustrating an example of the contents of the forward / backward acceleration calculation C in S49.
  • FIG. 23 describes a case where the transported object of the moving body 21_n + 1 to be calculated is an occupant.
  • the front-back acceleration calculation C first, it is determined whether or not the occupant's gaze direction is forward (S71).
  • the gaze direction of the occupant on the calculation target moving body 21_n + 1 is not forward (NO in S71)
  • the deceleration of the preceding moving body 21_n at the time of entering the curve is larger than the deceleration of the calculation target moving body 21_n + 1.
  • a normal pre-curve deceleration is set in consideration of both riding comfort and transportation efficiency (S72). As shown in FIG.
  • the pre-curve deceleration is a deceleration that decelerates the moving body 21_n + 1 to be calculated in advance before the preceding moving body 21_n enters the curve, and is a front-rear acceleration that is not linked to the lateral acceleration.
  • the moving body 21_n + 1 to be calculated starts deceleration at the deceleration before the curve so that the front-back acceleration at the time when the deceleration starts is smaller than the front-back acceleration generated at the preceding moving body 21_n at the same time, that is,
  • the forward / backward acceleration control is performed so that the deceleration generated in the moving body 21_n + 1 to be calculated at the same time becomes larger than the deceleration generated in the preceding moving body 21_n.
  • This deceleration before the curve is also adjusted according to whether or not the occupant's gaze direction is forward.
  • the information on the type of the preceding mobile 21_n is acquired (S73).
  • the preceding moving body 21_n is a large moving body such as a dump truck or a bus
  • the occupants of the following moving body 21_n + 1 receive a greater sense of anxiety and oppression than a small moving body such as a passenger car. .. Therefore, when the preceding moving body 21_n is a large moving body, the front-rear acceleration control for increasing the deceleration before the curve of the moving body 21_n + 1 to be calculated afterwards can be performed as compared with the case of the small moving body. desirable. Therefore, the information of the type of the preceding mobile body 21_n-1 is acquired.
  • a process is performed to acquire the permissible relative acceleration of the moving body 21_n + 1 to be calculated with respect to the leading moving body 21_n (S74).
  • the permissible relative acceleration may be a fixed value or may be changed according to the type acquired in S73.
  • the deceleration before the curve is calculated according to the case where the gaze direction of the occupant of the moving body 21_n + 1 is forward (S75).
  • the deceleration before the curve is calculated based on the information acquired in S73 and S74, that is, the type of the preceding moving body 21_n and the allowable relative acceleration.
  • the pre-curve deceleration is set to a smaller value so as to be gradually decelerated as compared with the pre-curve deceleration (S72) calculated when the occupant's gaze direction is not forward.
  • the front-back acceleration linked to the lateral acceleration is calculated.
  • a process of calculating the gain K for calculating the front-rear acceleration from the lateral acceleration is performed (S76).
  • the front-back acceleration is calculated by the following calculation formula (1).
  • the moving body 21_n + 1 When the gaze direction of the occupant of the moving body 21_n + 1 is not forward (NO in S71), since the occupant is not looking at the preceding moving body 21_n, the moving body 21_n + 1 to be calculated decelerates by the deceleration before the curve and is the leading moving body. Even if it approaches 21_n, it does not give a feeling of anxiety or oppression to the occupants of the moving body 21_n + 1. Therefore, in S76, the value of the gain K that prioritizes the transportation efficiency over the ride quality of the occupant is set.
  • the moving body 21_n + 1 when the gaze direction of the occupant of the moving body 21_n + 1 is forward (YES in S71), the moving body 21_n + 1 to be calculated decelerates at a normal deceleration and approaches the preceding moving body 21_n. There is a risk of giving a feeling of anxiety or oppression to the occupants of the body 21_n + 1. Therefore, in S76, the value of the gain K that gradually increases or decreases the separation distance from the preceding moving body 21_n is set from the curve entrance to the steady turning.
  • the gain K is calculated using the value of.
  • the gain K is calculated using the value of the deceleration before the curve acquired in S72.
  • the gain K at the curve entrance is set as compared with the case where it is determined not to be forward. , A value larger than the gain K during single running or leading running is calculated.
  • the pre-curve deceleration time Tsb is the time to cause the front-rear acceleration that is not linked to the lateral acceleration, that is, the pre-curve deceleration before entering the curve, and is based on the value of the pre-curve deceleration calculated in S72 or S75. Is calculated.
  • the deceleration before the curve and the gain K of the following moving body 21_n + 2 when it is determined that the gaze direction of the occupant of the moving body 21_n + 1 to be calculated is backward, it is determined that the gaze direction is not backward. Compared with the time, the deceleration before the curve and the gain K are set to larger values.
  • FIG. 24 is a diagram showing changes in the front-rear acceleration acting on the moving body when traveling on a curved road
  • FIG. 24 (a) shows changes in the front-rear acceleration and the lateral acceleration when the moving body travels alone.
  • (B) to FIG. 24 (d) are diagrams showing changes in acceleration of two moving bodies traveling in a platoon.
  • FIG. 24 (b) shows the change in the front-rear acceleration when the occupant is not on the moving body 21_n + 1 to be calculated
  • FIG. 24 (c) shows the back-and-forth acceleration when the occupant of the moving body 21_n + 1 is looking forward.
  • FIG. 24 (d) is a diagram showing a change in the front-rear acceleration when the occupant of the preceding moving body 21_n is looking backward.
  • FIG. 25 is a “gg” diagram showing the relationship between the longitudinal acceleration and the lateral acceleration when the longitudinal acceleration control in the present embodiment is applied, and FIG. 25 (a) shows an occupant riding on the moving body 21_n + 1. “Gg” diagram when not, FIG. 25 (b) shows the “gg” diagram when the occupant of the moving body 21_n + 1 is looking forward, and FIG. 25 (c) shows the occupant of the preceding moving body 21_n. It is a "gg" diagram when looking backward.
  • the time t3 is the time when the moving body 21_n passes through the curve entrance
  • the time t1 is the time before the deceleration time Tsb before the curve
  • the time t5 is the lateral acceleration in the curve road.
  • Time t9 which is the time when is constant, is the time when the car passes through the exit of the curve.
  • the front-back acceleration in the pre-curve deceleration time Tsb is a front-back acceleration that is not linked to the lateral acceleration. Then, from the time t3 when passing through the curve entrance to the time t5 when the lateral acceleration becomes constant, the front-back acceleration control for generating the back-and-forth movement linked to the lateral movement is performed.
  • the solid line shows the change in the acceleration of the moving body 21_n + 1 to be calculated
  • the broken line shows the change in the acceleration of the leading moving body 21_n.
  • the time t4 is the time when the moving body 21_n + 1 passes through the curve entrance
  • the time t1 is the time before the deceleration time Tsb before the curve
  • the time t6 is the time when the lateral acceleration becomes constant in the curve road.
  • Time t8 is the time when the lateral acceleration starts to decrease
  • time t9 is the time when the curve exit is passed.
  • the time t3 is the time when the preceding moving body 21_n passes through the curve entrance
  • the time t2 is the time when the deceleration before the curve is started
  • the time t5 is the time when the lateral acceleration becomes constant in the curve road
  • the time t9 is. This is the time when the lateral acceleration becomes 0.
  • the moving body 21_n + 1 when no occupant is on the moving body 21_n + 1, the moving body 21_n + 1 generates a back-and-forth acceleration linked to the lateral movement described with reference to FIGS. 6 to 11. Control is done.
  • the moving body 21_n + 1 starts decelerating at the timing t1 before the curve entrance, and is decelerated at a front-rear acceleration that is not linked to the lateral acceleration until the time t4 when the moving body 21_n + 1 reaches the curve entrance (deceleration time before the curve Tsb).
  • the moving body 21_n + 1 passes through the curve entrance, the moving body 21_n + 1 is controlled to a front-back acceleration smaller than that of the preceding moving body 21_n by the front-back acceleration control according to the lateral acceleration.
  • the difference in front-rear acceleration between the preceding moving body 21_n and the succeeding moving body 21_n + 1 is ⁇ a1 at the maximum.
  • the front-back acceleration control is performed so that the back-and-forth movement is linked to the lateral movement of the following moving body 21_n + 1.
  • the trailing moving body 21_n + 1 is controlled to have a smaller front-back acceleration than the preceding moving body 21_n in the control of the front-back acceleration according to the lateral acceleration at the curve exit.
  • the difference in front-rear acceleration between the preceding moving body 21_n and the succeeding moving body 21_n + 1 is ⁇ b1 at the maximum.
  • the front-rear acceleration according to the lateral acceleration is set to a normal value that achieves both riding comfort and transportation efficiency. ..
  • the front-rear acceleration at the curve entrance is higher than when the occupant shown in FIG. 24 (b) is not on board.
  • the front-rear acceleration is controlled so that it becomes smaller (larger deceleration).
  • the difference in front-rear acceleration between the preceding moving body 21_n and the succeeding moving body 21_n + 1 is ⁇ a2 at the maximum ( ⁇ a1> ⁇ a2).
  • the following moving body 21_n + 1 gently changes the distance from the leading moving body 21_n from before entering the curve to the steady turning, as shown in FIG. 7 (b). be able to. Therefore, since the separation distance does not decrease sharply, it is possible to prevent the occupant of the following moving body 21_n who is gazing ahead from giving anxiety and oppressive feeling, and it is possible to improve the riding comfort.
  • the front-rear acceleration at the curve exit is higher than when the occupant shown in FIG. 24 (b) is not on board.
  • the front-back acceleration is controlled so that it becomes smaller (larger deceleration).
  • the difference in front-rear acceleration between the preceding moving body 21_n and the succeeding moving body 21_n + 1 is ⁇ b2 at the maximum ( ⁇ b1> ⁇ b2).
  • the deceleration of the following moving body 21_n + 1 becomes larger from the front than the curve exit, and the following moving body 21_n + 1 once separates from the preceding moving body 21_n and passes through the curve exit, and then leads again.
  • the front-rear acceleration is controlled so as to approach the moving body 21_n and reach the target separation distance. Therefore, it is possible to prevent the occupant of the preceding moving body 21_n from receiving anxiety and a feeling of oppression, and it is possible to improve the riding comfort.
  • FIG. 25 is a “gg” diagram showing the relationship between the longitudinal acceleration and the lateral acceleration when the longitudinal acceleration control in the present embodiment is applied, and FIG. 25 (a) shows an occupant on the following moving body 21-n + 1.
  • the “gg” diagram when not riding FIG. 25 (b) is the “gg” diagram when the occupant of the following moving object 21-n + 1 is looking forward, and FIG. 25 (c) is the preceding moving object. It is a "gg” diagram when the occupant of 21-n is looking backward.
  • the occupant of the following moving body 21-n + 1 is looking forward as shown in FIG. 25 (b). If so, the degree of change in the anteroposterior acceleration with respect to the increase in the lateral acceleration of the following moving body 21-n + 1 is large. That is, when the occupant of the following moving body 21_n + 1 is looking forward, the deceleration is changed so as to be large during the period from the curve entrance of the following moving body 21_n + 1 to the steady turning (t4 ⁇ t6). Therefore, in such a case, the following moving body 21_n + 1 gently approaches the leading moving body 21_n (see FIG. 7B), and the occupant of the following moving body 21_n + 1 suddenly approaches the leading moving body 21_n. It is possible to prevent a feeling of anxiety and oppression due to approaching.
  • FIG. 26 is a flowchart illustrating another example of the contents of the front-back acceleration calculation C (front-back acceleration calculation unit) of S49.
  • the gain K for calculating the front-rear acceleration linked to the lateral acceleration is changed according to the direction in which the occupant is gazing has been described, but instead of the gain K or together with the gain K.
  • the deceleration time before the curve may be changed. For example, when the gaze direction of the occupant of the following moving body 21_n + 1 is forward, the forward / backward acceleration control is performed so as to lengthen the deceleration time before the curve as compared with the case where the gaze direction is not forward. You may.
  • the pre-curve deceleration for the following moving body 21_n + 1 is set (S113). Then, for the succeeding moving body 21_n + 1, the gain K for controlling the front-rear acceleration linked to the lateral acceleration is calculated (S114).
  • a process of acquiring the state of the occupant of the following moving body 21_n + 1 is performed (S115). For example, based on the information in the moving body obtained from the in-vehicle sensor, the line of sight of the occupant is detected or estimated and used as the state of the occupant.
  • a process of calculating the pre-curve deceleration time Tsb for decelerating the following moving body 21_n + 1 before entering the curve is performed (S116).
  • the deceleration time Tsb before the curve is adjusted according to the state of the occupant. For example, when the occupant of the following moving body 21_n + 1 is gazing at the front, a longer value is calculated as compared with the case where the occupant is not gazing at the front. Will be done.
  • the separation distance dn + 1 between the preceding moving body 21_n and the succeeding moving body 21_n + 1 is increased before the absolute value of the lateral acceleration of the succeeding moving body 21_n + 1 or the curvature of the traveling path is increased.
  • the longitudinal acceleration of both the trailing moving body 21_n + 1 or the leading moving body 21_n and the trailing moving body 21_n + 1 is controlled.
  • the present invention is not limited to this.
  • the transported object requires careful and careful handling such as precision machinery and fresh food
  • the transported object should not be impacted or loaded during transportation by the moving body 21. It is necessary to control the forward / backward acceleration so that the collapse does not occur.
  • the mobile body motion control device 1A calculates the front-back acceleration command value according to the position of the moving body in the platoon of each moving body 21 traveling in the platoon, thereby performing FIG. 10 (a). (B) and the platooning shown in FIG. 11 can be realized.
  • the front-rear acceleration of each moving body 21 is controlled according to the state of the transported object to be conveyed.
  • the moving body 21 in which the occupant is gazing forward is subject to front-back acceleration control so that the separation distance dn + 1 changes more gently than the moving body 21 in which the occupant is not gazing forward (FIG. 7 (b). ). Therefore, the following moving body 21_n gently approaches the preceding moving body 21_n-1, and the occupant of the following moving body 21_n receives anxiety and oppression due to the sudden approach of the preceding moving body 21_n-1. Can be prevented. Further, when the transported object transported by the moving body is a handling-care item such as precision equipment or fresh food that requires careful handling, the transported object can be transported while suppressing the impact on the transported object.
  • FIG. 27 is a diagram illustrating still another modification of the present embodiment.
  • FIG. 27 is a diagram corresponding to FIG. 1, and is different from FIG. 1 in that the travelable lane is two lanes and the number of moving bodies is six.
  • a plurality of moving bodies 0 to 4 are lined up in a row and travel in a platoon. Based on this, it may be divided into two formations and passed through a curve. For example, on the inside of the curve, a plurality of moving bodies 0 to 3 carrying occupants who are not gazing at the front form a platoon and run, and on the outside of the curve, occupants who are gazing at the front and handling precautions are placed.
  • the mounted moving bodies 4 and 5 may form a platoon and run.
  • the platoon control calculation unit 1Aa determines whether or not the route through which each moving body passes is a route that can be platooned in a plurality of rows. Then, when it is determined that the route is capable of traveling in a platoon in a plurality of rows, it is based on the information on the transported object of each moving body 21 and its state acquired by the transported object information acquisition unit 34 of the platoon control calculation unit 1Aa. Then, the route of each moving body 21 is set.
  • a moving body 21 in which the occupant is gazing forward or backward and a moving body 21 in which the occupant is not gazing when an occupant is on each moving body 21, it is classified into a moving body 21 in which the occupant is gazing forward or backward and a moving body 21 in which the occupant is not gazing.
  • the moving body 21 on which the occupant is not riding when the moving body 21 on which the occupant is not riding is included, it is included in the moving body 21 not being watched. Then, for the moving body 21 in which the occupant is gazing at the front or the rear, a route for traveling inside the curve is set, and front-rear acceleration control is performed in which the riding comfort is prioritized over the transportation efficiency. On the other hand, for a moving body in which the occupant is not gazing at the front or the rear, a route for traveling outside the curve is set, and front-rear acceleration control is performed in consideration of both transportation efficiency and riding comfort.
  • each moving body 21 is a construction machine such as a dump truck capable of transporting earth and sand
  • each moving body 21 is classified according to whether or not it is loaded with earth and sand.
  • the braking distance is long, the position of the center of gravity is high, and the running stability tends to be low.
  • Forward / backward acceleration control that prioritizes running stability is performed.
  • the braking distance is short, the position of the center of gravity is low, and the running stability tends to be high.
  • the front-rear acceleration is performed in consideration of both the driving stability and the running stability.
  • the front-rear acceleration is controlled with priority given to transportation efficiency, and mobile objects carrying occupants who are gazing ahead and luggage that requires careful handling such as precision equipment are placed. It is possible to control the anteroposterior acceleration that prioritizes ride comfort and safety in a platoon composed of moving bodies.
  • one platoon is divided into small platoons in front of the curve, and the front-back acceleration control is performed for each platoon, so that the amount of calculation for the front-back acceleration control can be kept low, and the cost of the arithmetic unit can be reduced. It can be planned, and it is possible to prevent the formation from extending long back and forth, and to improve the transportation efficiency.
  • the separation distance between the preceding moving body and the succeeding moving body is the subsequent movement.
  • the absolute value of the lateral acceleration of the body, or the absolute value of the lateral acceleration of the leading and trailing moving bodies, or the leading and trailing moving bodies, which increases before the curvature of the traveling path of the trailing moving body increases or decreases.
  • the forward / backward acceleration of at least one of the preceding moving body and the following moving body is controlled so that the curvature of the traveling path decreases after the section where the curvature increases or decreases.
  • the traveling information of the moving body traveling in a platoon is transmitted and received between the moving bodies, and the separation distance is set before the absolute value of the lateral acceleration of the following moving body or the curvature of the traveling path of the following moving body is increased or decreased.
  • the forward / backward acceleration of the preceding moving body and the succeeding moving body is controlled so that the separation distance decreases.
  • a negative forward / backward acceleration is generated (decelerated) from the moving body at the end of the platoon, or backward.
  • the back-and-forth acceleration of each moving body is controlled so that the front-back acceleration generated is smaller (the deceleration is larger) as the moving body is.
  • the minimum value (maximum deceleration) of the front-rear acceleration that occurs in the section where the absolute value of the lateral acceleration generated in the moving body increases, or the road curvature at the moving body traveling position or the curvature of the traveling path of the moving body increases is ,
  • the leading moving body is smaller (maximum deceleration is larger), and the absolute value of the lateral acceleration generated in the moving body decreases, or the road curvature at the moving body running position or the curvature of the moving body's running path decreases.
  • the front-back acceleration of each moving body is controlled so that the maximum value (maximum acceleration) of the generated back-and-forth acceleration becomes larger (the maximum acceleration becomes larger) as the moving body rearward.
  • the relationship between the front-rear acceleration and the lateral acceleration generated until the moving body group traveling in the platoon in the straight section reaches the steady turning state is controlled so as to be appropriately changed for all the moving bodies in the platoon. This can be expected to have the effect of improving the comfort of the occupants of each moving body.
  • the present invention is not limited to the above-described embodiments, and various designs are designed without departing from the spirit of the present invention described in the claims. You can make changes.
  • the above-described embodiment has been described in detail in order to explain the present invention in an easy-to-understand manner, and is not necessarily limited to the one including all the described configurations.
  • 1 Mobile control system
  • 1A Mobile motion control device
  • 1Aa Formation control calculation unit
  • 1Ab Travel control calculation unit
  • 21 Mobile body
  • 21_n Each moving body of the mobile body group traveling in a platoon (n: Positive) )
  • 37 Control plan transmission unit
  • 38 Mobile motion control calculation unit

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

複数の移動体による隊列走行時において、各移動体の乗員の快適性と荷物の輸送効率の両方を向上させることのできる移動体制御システムを提供する。予め設定された走行経路に沿って複数の移動体21を隊列走行させる移動体制御システム1であって、先行移動体21_nおよび後続移動体21_n+1の走行経路における前後加速度を演算する前後加速度演算部S49を備える。前後加速度演算部は、前後加速度を演算する演算式のゲインEを、各移動体21が搬送する搬送物の情報に基づいて調整することを特徴とする。

Description

移動体制御システム
 本発明は、移動体制御システムに関する。
 自動車におけるADAS(先進運転支援システム)及び自動運転関連技術の開発が、近年、急速に進められている。運転操作の一部を自動化する機能として、アダプティブクルーズコントロール、レーンキープアシストシステム、緊急自動ブレーキ等が実用化に至っている。しかしながら、これらはいずれも車両の前後運動と横運動のどちらか一方のみを自動制御するシステムである。加減速を伴って旋回する走行シーン、例えば、曲率がきつく、一定の速度で走行すると横加速度が過大となるカーブ路や、追い越し、合流等でスムーズな車両運動を実現するために、車両の前後運動と横運動の連係した制御が必要となる。
 車両に発生する前後運動と横運動の連係については、特許文献1に、入力された車両の横方向の加加速度(Gy_dot)に、速度(V)及び横加速度(Gy)から決定され、予め記憶されたゲイン(Cxy)を乗じ、乗じた値に基づいて、車両の前後加速度を制御する制御指令を生成し、生成された前記制御指令を出力する車両の運動制御方法が開示されている。この方法によると、前後加速度と横加速度の合成加速度ベクトル(G)の軌跡が車両重心固定の座標系において、なめらかな曲線を描くように方向づけられ(Vectoring)、G-Vectoring制御(GVC:G-Vectoring Control)と呼ばれている。このGVCによると、緊急回避性能が大幅に向上することが報告されている(非特許文献1参照)。
 また、例えば特許文献2では、自車両前方の走行コースにおけるカーブ曲率の時間変化に基づいて加減速する方法が開示されている。この方法によると、自車両に横加速度が発生する前から横加速度の絶対値が増加する旋回過渡期まで連続的な減速を実現することが可能となる。本技術は、前記G-Vectoring制御に前方注視情報を加えることから、Preview G-Vectoring制御(PGVC:Preview G-Vectoring Control)と呼ばれている(非特許文献2参照)。
 また、近年では、道路輸送における渋滞緩和と輸送効率向上にあたり、極小離間距離での自動追従走行(隊列走行ともいう)システムの開発が進められている。
 上記特許文献1、2では、前述のように単独の車両において、カーブ路走行時における前後運動と横運動を連係させ、スムーズに走行する方法が示されているが、上記特許文献1、2のいずれの文献でも、複数台の車両が隊列走行している際の加減速方法には言及されていない。
 一方、複数台の車両間で加減速の情報をやり取りしながら隊列走行する方法に関しては、例えば特許文献3に、自車の目標速度パターン及び他車の目標速度パターンに基づいて隊列走行速度パターンを随時生成し、前記隊列走行速度パターンに応じて車両の走行制御を行う方法が開示されている。また、例えば特許文献4には、予め隊列内の車両に設定される走行計画を共有し、減速制御の開始タイミングが遅い車両から順に車両の隊列の順序を変更する方法が開示されている。
特開2009-262701号公報 特開2012-030674号公報 特開2008-110620号公報 特開2008-204094号公報
M.Yamakado, J. Takahashi, S. Saito, A.Yokoyama, and M. Abe, Improvement in vehicle agility and stability by G-Vectoring control, Veh. Syst. Dyn. 48 (2010), pp. 231-254. Takahashi, J., et al., "Evaluation of Preview G-Vectoring Control to decelerate a vehicle prior to entry into a curve", International Journal of Automotive Technology, Vol. 14, No. 6, 2013, pp. 921-926.
 しかしながら、上記特許文献3、4における加減速の制御において、上記特許文献1、2に記載されている横運動に連係した前後運動に関しては考慮されておらず、隊列走行するすべての車両で、横運動を伴う加減速時にスムーズな運動を実現する方法が明らかでない。例えば、隊列走行中のカーブ路走行時に、先行車両のタイミングでの減速制御では、各車両の(特に、後続の車両ほど)乗員の乗り心地が悪化する可能性がある。
 また、複数の移動体によって隊列が編成されており、その複数の移動体に、乗員が乗車していない空の車両や荷物を載せて走行する搬送機が含まれている場合には、乗員の乗り心地よりも、隊列の移動速度や台数などの輸送効率を優先させる運動を実施する必要がある。
 本発明は、上記事情に鑑みてなされたものであって、その目的とするところは、複数の移動体による隊列走行時において、移動体に乗っている乗員の快適性と荷物の輸送効率の両方を向上させることのできる移動体制御システムを提供することにある。
 上記課題を解決するために、本発明に係る移動体制御システムは、予め設定された走行経路に沿って複数の移動体を隊列走行させる移動体制御システムであって、先行移動体および後続移動体の走行経路における前後加速度を演算する前後加速度演算部を備え、該前後加速度演算部は、前記前後加速度を演算する演算式のゲインを、前記各移動体が搬送する搬送物の情報に基づいて調整することを特徴とする。
 本発明によれば、例えば直線区間を隊列走行してきた移動体群が定常旋回状態に至るまでの間に発生する前後加速度と横加速度の関係を、隊列内全ての移動体に対し、好適に変化するよう制御することができ、各移動体の乗員の快適性と荷物の輸送効率を向上する効果が期待できる。
 本発明に関連する更なる特徴は、本明細書の記述、添付図面から明らかになるものである。また、上記した以外の、課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
カーブ区間を含む道路の形状の一部を示した図。 参考手法1にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の走行状態を示し、(a)は各移動体の横加速度および前後加速度、(b)は離間距離を示した図。 参考手法1にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の各移動体の横加速度と前後加速度の関係を示した図。 参考手法2にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の走行状態を示し、(a)は各移動体の横加速度および前後加速度、(b)は離間距離を示した図。 参考手法2にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の各移動体の横加速度と前後加速度の関係を示した図。 移動体n、移動体n+1、および移動体nと移動体n+1の離間距離dn+1の定義を示した図。 本発明にて隊列走行に対する負の前後加速度制御をした際のカーブ路走行時の走行状態を示し、(a)は各移動体の横加速度および前後加速度、(b)は離間距離を示した図。 本発明にて隊列走行に対する正の前後加速度制御をした際のカーブ路走行時の走行状態を示し、(a)は各移動体の横加速度および前後加速度、(b)は離間距離、(c)は各移動体の速度を示した図。 本発明による前後加速度制御を適用した際の前後加速度と横加速度の関係を示した図。 本発明にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の走行状態を示し、(a)は各移動体の横加速度および前後加速度、(b)は離間距離を示した図。 本発明にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の各移動体の前後加速度と横加速度の関係を示した図。 本発明に係る移動体制御システムの実施形態を搭載したシステム全体の概念図。 本発明に係る移動体制御システムの実施形態における移動体の一例を示す概念図。 本発明に係る移動体制御システムの実施形態における移動体運動制御装置の隊列制御演算部の構成を説明する図。 本発明に係る移動体制御システムの実施形態における移動体運動制御装置の走行制御演算部の構成を説明する図。 搬送物情報取得部の要部を示すブロック図である。 乗員の視認対象が移動体外に存在する場合の動作例に供される図。 乗員の視認対象が移動体内に存在する場合の動作例に供される図。 移動体進行方向と乗員方向が異なる際の動作例に供される図。 本発明に係る移動体制御システムの第1実施形態のフローチャート。 隊列の先頭移動体の前後加速度を演算する方法を説明するフローチャート。 先行移動体の前後加速度制御計画にカーブ情報がない場合における追従移動体の前後加速度を演算する方法を説明するフローチャート。 先行移動体の前後加速度制御計画にカーブ情報がある場合における追従移動体の前後加速度を演算する方法を説明するフローチャート。 カーブ路走行時に移動体に作用する前後加速度の変化を示す図であり、図24(a)は単一の移動体の前後加速度と横加速度の変化を示し、図24(b)は後続移動体に乗員が乗っていない場合における先行移動体と後続移動体の前後加速度の変化を示し、図24(c)は後続移動体の乗員が前方を見ている場合における先行移動体と後続移動体の前後加速度の変化を示し、図24(d)は先行移動体の乗員が後方を見ている場合における先行移動体と後続移動体の前後加速度の変化を示す図。 本実施形態における前後加速度制御を適用した際の前後加速度と横加速度の関係を示した“g-g”ダイアグラムであり、図25(a)は後続移動体に乗員が乗っていない場合における“g-g”ダイアグラム、図25(b)は後続移動体の乗員が前方を見ている場合における“g-g”ダイアグラム、図25(c)は先行移動体の乗員が後方を見ている場合における“g-g”ダイアグラム。 本実施形態における前後加速度制御の内容を説明するフローチャートである。 本実施形態の変形例を説明する図。
 以下、本発明の実施形態について、図面を参照して説明する。
[実施形態の概要説明]
 具体的な実施形態の説明に先立ち、本発明の理解が容易になるよう、まず、図1~図11を用いて、4台の隊列走行移動体群(移動体0、移動体1、移動体2、移動体3)が直線路からカーブ進入、定常旋回状態に至るまでの加速度制御方法について、参考手法1、参考手法2、および本発明手法による方法の違いを比較しながら説明する。なお、本例では、移動体の重心点を原点とし、移動体の前後方向をx、それに直角な方向(移動体の横(左右)方向)をyとした場合、x方向の加速度を前後加速度、y方向の加速度を横加速度とする。また、前後加速度は、移動体前方向を正、すなわち移動体が前方向に対して進行している際、その速度を増加させる前後加速度を正とする。また、横加速度は、移動体が前方向に対して進行している際、左回り(反時計回り)旋回時に発生する横加速度を正とし、逆方向を負とする。また、左回りの旋回半径を正とし、その逆数を移動体走行曲率とする。同様に、目標経路(走行経路)に関しても、左回りの旋回半径を正とし、その逆数を目標経路曲率(走行経路の曲率)とする。また、左回り(反時計回り)方向の操舵角を正とする。
 参考手法1は、カーブ路に対する前後加速度制御として、旋回開始から定常旋回に至るまで横運動に連係した前後加速度制御として、前記G-Vectoring制御を、隊列内の各移動体がそれぞれ独立して個々に行うものとする。また、参考手法2としては、隊列内にて速度プロファイルを共有し、隊列内全ての移動体において同タイミングで同じ前後加速度制御を行うことで、前後の移動体の間の離間距離を変化させることなく走行するものとする。なお、参考手法2は、カーブ路に対する前後加速度制御としては、参考手法1と同様G-Vectoring制御を行うものとする。
 図1は、カーブ区間を含む道路の形状の一部を示した図であり、本実施形態の速度制御の説明に際し、直線区間(曲率0)、緩和曲線区間である曲率単調変化区間(横加速度変化)、曲率一定区間(定常旋回)を持つカーブ路(カーブ区間を含む道路)、およびそこを走行(隊列走行)する複数の移動体(移動体0、移動体1、移動体2、移動体3)の概念図を示している。移動体の走行経路は、横加速度が発生するようなカーブ路を想定している。各移動体は、前後方向(進行方向)に隊列を組み、コース形状(道路形状)に応じた各々の目標経路(走行経路)にしたがって且つ所定の離間距離(d1:移動体1-移動体0、d2:移動体2-移動体1、d3:移動体3-移動体2、例えばd1≒d2≒d3)を保つように走行(隊列走行)するとともに、順次、カーブに進入・退出することになる。
 図2は、参考手法1にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の走行状態を示し、(a)は各移動体の横加速度および前後加速度、(b)は離間距離を示した図である。より詳しくは、図2(a)、(b)は、移動体0、移動体1、移動体2、移動体3がそれぞれ図1に示したようなカーブ路を走行する際に、参考手法1、すなわち各移動体独自にG-Vectoring制御を行った時の、各移動体の前後加速度および横加速度、並びに各移動体間の離間距離(移動体1-移動体0、移動体2-移動体1、移動体3-移動体2)を示している。
 この場合、図2(a)に示すように、移動体0、移動体1、移動体2、移動体3それぞれにおいて、走行経路の曲率(≒道路曲率)が増加し、横加速度(の絶対値)が増加する区間において、横運動に連係した前後加速度制御(G-Vectoring制御)を行っていることがわかる。この時、先頭移動体である移動体0から順に負の前後加速度制御を行うこととなるため、図2(b)に示すように、各移動体間の離間距離は順次小さな値となっている。
 また、図3にこの時の前後加速度と横加速度の関係である“g-g”ダイアグラムを示す。図3は、参考手法1にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の各移動体の横加速度と前後加速度の関係を示した図である。
 両者の関係を見てみると、全移動体で同じ変化となっており、すべての移動体において前後加速度から横加速度へスムーズに遷移する運動を実現している。したがって、移動体に急激な動きがなく、例えば移動体に乗員が乗っている場合には、乗り心地が好適となり、移動体に荷物が積載されている場合には荷崩れが防止される。
 しかし、図2(b)に示したように、各移動体が独自にG-Vectoring制御を行う構成では、カーブ進入時に離間距離が減少するため、隊列走行する移動体間での衝突の危険性が高まり、また、それを避けるためには隊列走行時の離間距離を大きくとる必要がある。この場合、隊列走行による輸送密度向上といった効果が小さくなり、各移動体が単独で走行するシーンと変わらないものとなってしまう。また、カーブ進入時に離間距離が急激に減少すると、例えば後続移動体に乗員が乗っており、その乗員の視線が前方を向いているときは、先行の移動体が迫ってくるように見え、衝突するのではないかという不安感や圧迫感を乗員に与えるおそれがある。
 図4は、参考手法2にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の走行状態を示し、(a)は各移動体の横加速度および前後加速度、(b)は離間距離を示した図である。より詳しくは、図4(a)、(b)は、移動体0、移動体1、移動体2、移動体3がそれぞれ図1に示したようなカーブ路を走行する際に、参考手法2、すなわち隊列内の移動体が同じ速度プロファイルにて前後加速度制御を行った時の、各移動体の前後加速度および横加速度、並びに各移動体間の離間距離(移動体1-移動体0、移動体2-移動体1、移動体3-移動体2)を示している。
 この場合、図4(a)に示すように、移動体0、移動体1、移動体2、移動体3の全てにおいて、移動体0の走行経路の曲率(≒道路曲率)が増加し、移動体0の横加速度(の絶対値)が増加するタイミングで開始するG-Vectoring制御と同一の前後加速度制御が行われていることがわかる。この時、全移動体同時に同じ負の前後加速度制御を行うこととなるため、図4(b)に示すように、各移動体間の離間距離は変化することなく、前後加速度制御前の離間距離を維持できている。したがって、例えば後続移動体に乗員が乗っており、その乗員の視線が前方を向いているときでも、先行の移動体の接近移動によって乗員に不安感や圧迫感を与えることはない。
 また、図5にこの時の前後加速度と横加速度の関係である“g-g”ダイアグラムを示す。図5は、参考手法2にて隊列走行に対する前後加速度制御をした際のカーブ路走行時の各移動体の横加速度と前後加速度の関係を示した図である。
 両者の関係を見てみると、移動体0では前後加速度から横加速度へスムーズに遷移する運動を実現しているものの、後続移動体(移動体1、移動体2、移動体3)になるほど横加速度が小さい領域で発生する負の前後加速度が大きくなり、前後加速度と横加速度が連係しない区間が増加する。したがって、後続移動体(移動体1、移動体2、移動体3)は、移動体0から離れるほど、動きが急激になり、例えば後続移動体に乗員が乗っている場合には乗り心地が悪化し、後続移動体に荷物が積載されている場合には荷崩れの原因となる。
 本実施形態では、乗員が他の移動体の接近による不安感や圧迫感を与えないように、隊列走行時の離間距離を適切に保ちながら、カーブ路走行時の隊列内で乗員が乗っている移動体は乗員の乗り心地が好適となるよう、移動体において横運動に連係した前後運動となる前後加速度制御を行う手法を提案する。
 以下、図6、図7(a)、(b)、図8(a)~(c)を用いて、本実施形態における前後加速度制御の特徴を説明する。図7(a)、(b)、図8(a)~(c)の説明において、図6に示すように、隊列内の複数台の移動体で、先行して走行する先行移動体を移動体n、移動体nに追従走行(移動体nの後方を走行)する後続移動体を移動体n+1とし、両者の離間距離をdn+1としている(ここでnは0以上の正の整数)。
 初めに図7(a)、(b)を用いて、直進状態から定常旋回状態へと遷移する走行シーン(図1のa手前~図1のb)における前後加速度制御を説明する。図7(a)は、隊列内の移動体nおよび移動体nに追従して移動する後続移動体である移動体n+1の、横加速度および前後加速度の時間変化、図7(b)は、両者の離間距離dn+1の時間変化を示している。図7(a)に示す通り、移動体n、移動体n+1それぞれにおいて、カーブ進入(走行経路の曲率(≒道路曲率)が増加)、すなわち横加速度が発生する前(移動体nにおいて時刻t3の前、移動体n+1において時刻t4の前)から、定常旋回(走行経路の曲率(≒道路曲率)が一定)、すなわち横加速度が略一定となる時刻(移動体nにおいて時刻t5、移動体n+1において時刻t6)まで、連続的に負の前後加速度を発生(つまり、減速)していることがわかる。ここで、本実施形態において、後続移動体である移動体n+1は、その横加速度の絶対値が増加、すなわち旋回を開始する前に減速を開始し、減速を開始する時刻t1での前後加速度が、同時刻における移動体nに発生する前後加速度よりも小さい。すなわち、同時刻で後続移動体である移動体n+1に発生する減速度が先行移動体である移動体nに発生する減速度よりも大きくなるよう、前後加速度制御を行うことを特徴とする。
 より詳細には、後で説明するように、後続移動体である移動体n+1は、移動体nの走行情報を取得可能であり、移動体nの横加速度の絶対値が増加、すなわち移動体nの走行経路の曲率(≒道路曲率)が増加して旋回を開始する時刻t3よりも前の時刻t1に、負の前後加速度を発生させて減速を開始する。また、図7(a)に示す例では、時刻t1よりも後かつ時刻t3よりも前の時刻t2に、移動体nも、その横加速度の絶対値が増加、すなわち旋回を開始する前に負の前後加速度を発生させて減速を開始するが、時刻t3における移動体nの速度より、同時刻(時刻t3)における移動体n+1の速度が小さくなるよう、時刻t1から時刻t3の間に、移動体nおよび移動体n+1に負の前後加速度を発生させて減速する。これにより、図7(b)に示すように、両者の離間距離dn+1を増加させる。
 その後、先行する移動体nがカーブに進入する時刻t3から、走行経路の曲率が増加して横加速度の絶対値が増加し、走行経路の曲率が一定になって定常旋回に至る時刻t5の区間において、移動体nは、例えばG-Vectoring制御のような横運動に連係した前後運動となる前後加速度制御を行う。更に、後続する移動体n+1においても、カーブに進入する時刻t4から、走行経路の曲率が増加して横加速度の絶対値が増加し、走行経路の曲率が一定になって定常旋回に至る時刻t6の区間において、例えばG-Vectoring制御のような横運動に連係した前後運動となる前後加速度制御を行う。この時に移動体nに発生する減速度が、移動体n+1に発生している減速度よりも大きければ(例えば、図7(a)に示すように、時刻t3から時刻t5の区間に発生する移動体nの前後加速度の最小値よりも、時刻t4から時刻t6の区間に発生する移動体n+1の前後加速度の最小値が大きくなるように制御すれば)、両者の離間距離dn+1は減少し始める。ここでは、移動体nの横加速度の絶対値が増加し、かつ、移動体n+1の横加速度の絶対値が増加する区間(時刻t4から時刻t5の区間)において、両者の離間距離dn+1が減少するよう、移動体nおよび/または移動体n+1の(負の)前後加速度が制御されている。
 ここで、カーブに対する前後加速度制御開始前、すなわち移動体n+1の減速開始時刻t1より前の時刻において、両者の速度が同じである時、移動体nの時刻t2から時刻t5までの前後加速度の積分値と、移動体n+1の時刻t1から時刻t6までの積分値が同じであれば、両者の定常旋回時の速度は同速度となり、同じ横加速度での旋回となる。更に、両者の相対速度ΔVn+1の時刻t1から時刻t6の間の積分値がゼロとなるように両者の前後加速度制御を行うことで、移動体n+1が定常旋回を開始する時刻t6で、両者の離間距離dn+1は、時刻t1以前の離間距離と同距離にすることができる。
 これにより、移動体n、移動体n+1それぞれに横運動に連係した前後運動を発生する前後加速度制御を実現しながら、例えば定常旋回時の離間距離を旋回開始前の離間距離とすることができる。
 次に図8(a)~(c)を用いて、定常旋回状態から直進状態へと遷移する走行シーン(図1のb~図1のd以降)における前後加速度制御を説明する。本走行シーンでは、横運動に連係した正の前後加速度制御に加え、移動体n、および移動体n+1の離間距離を目標値(目標離間距離)とする前後加速度制御、並びに、移動体n、および移動体n+1の速度を目標値(目標速度)とする前後加速度制御を合わせて行う。図8(a)は、隊列内の移動体nおよび移動体nの後続移動体である移動体n+1の、横加速度および前後加速度の時間変化、図8(b)は、両者の離間距離dn+1の時間変化、図8(c)は、両者の速度の時間変化を示している。図8(a)に示す通り、移動体n、移動体n+1それぞれにおいて、略一定の横加速度となっている定常旋回(走行経路の曲率(≒道路曲率)が一定)(移動体nにおいて時刻t7、移動体n+1において時刻t8)から、横加速度がゼロとなる時刻(移動体nにおいて時刻t9、移動体n+1において時刻t10)まで、連続的に正の前後加速度を発生(つまり、加速)していることがわかる。また、どちらの移動体も、その走行経路の曲率が減少してその横加速度の絶対値が減少し始める時刻t7(移動体n)、t8(移動体n+1)から、発生する正の前後加速度を増加させ、その後、図8(c)に示す速度が目標速度に近づくにつれて、正の前後加速度を減少させる。
 この時の移動体nおよび移動体n+1の前後加速度を比較すると、正の前後加速度が発生する時刻は、先行する移動体n(時刻t7)の方が、後続する移動体n+1(時刻t8)よりも早い。つまり、後で説明するように、先行する移動体nは、後続する移動体n+1の走行情報を取得可能であり、後続する移動体n+1の走行経路の曲率が減少して横加速度の絶対値が減少し始める時刻t8よりも前の時刻t7に、当該移動体nに正の前後加速度を発生させる。また、時刻t8における移動体nの速度より、同時刻(時刻t8)における移動体n+1の速度が小さくなるよう、時刻t7から時刻t8の間に、移動体nおよび移動体n+1に正の前後加速度を発生させて加速する。なお、図8(a)に示す例では、この区間の移動体n+1の前後加速度がゼロであるが、必ずしもゼロである必要は無い。また、後続する移動体n+1が目標速度へ到達し、その前後加速度がゼロとなる時刻t11は、先行する移動体nが目標速度に到達し、その前後加速度がゼロとなる時刻t12よりも早い。また、旋回過渡期(走行経路の曲率が一定の定常旋回状態から走行経路の曲率が減少して横加速度の絶対値がゼロとなる直進状態)(移動体nにおいて時刻t7から時刻t9、移動体n+1において時刻t8から時刻t10)に発生する前後加速度の最大値は、後続移動体である移動体n+1の方が先行移動体である移動体nよりも大きくなるように(図8(a)の時刻t9付近参照)、両者の(正の)前後加速度制御を行う。また、ここでは、後続移動体である移動体n+1の走行経路の曲率が減少して横加速度の絶対値が減少し、その横加速度の絶対値(もしくは走行経路の曲率)が直進走行とみなせる値(ここでは、約ゼロであって予め設定された値)以下となる時刻t10において、移動体n+1の速度が移動体nの速度よりも大きくなるよう、移動体n+1および/または移動体nの(正の)前後加速度が制御されている(図8(c)参照)。
 これにより、図8(b)に示すように、両者の離間距離dn+1を最初に増加させ(図8(b)に示す例では、時刻t9と時刻t10の途中まで増加)、その後、後続移動体n+1の加速に応じて両者の離間距離dn+1が減少する。
 ここで、移動体nの時刻t7から時刻t12までの前後加速度の積分値、および移動体n+1の時刻t8から時刻t11までの積分値は、それぞれ正の前後加速度制御開始前の速度と目標速度の差分となるよう設定し、更に両者の相対速度ΔVn+1の時刻t7から時刻t12の間の積分値と時刻t7における離間距離の和が(カーブ後の)直進走行時の目標離間距離となるよう前後加速度制御を行うことで、移動体n、および移動体n+1がそれぞれカーブに対する前後加速度制御が終了した際に、目標とする離間距離での走行を継続することができる。
 このように、定常旋回から直進走行へと遷移する際の、横運動に連係した正の前後加速度制御に、移動体n、および移動体n+1の離間距離を目標値とする前後加速度制御、並びに、移動体n、および移動体n+1の速度を目標値とする前後加速度制御を考慮することで、それぞれ個別に前後加速度制御を行う場合よりも、前後加速度の増減回数を減少することができる。したがって、移動体nや移動体n+1に乗員が乗っている場合には、乗員の乗り心地向上が期待でき、また、荷物が載っている場合には、荷崩れを防止することができる。
 図9に、図7(a)、(b)、図8(a)~(c)に示した本発明の前後加速度制御を行った際の前後加速度と横加速度の関係である“g-g”ダイアグラムを示す。この図9から、先行する移動体nと後続移動体n+1の両者とも、原点0から左回りの円を描くように前後加速度と横加速度の関係が遷移しており、移動体n、移動体n+1のどちらの移動体に対しても、横運動と前後運動が連係した乗り心地が好適となる加速度変化を提供することができている。
 前記した本発明の効果を確認するため、図10(a)、(b)、図11に、図1に示した4台の隊列走行に本発明による前後加速度制御を提供した例を示す。図10(a)、(b)は、移動体0、移動体1、移動体2、移動体3の前後加速度および横加速度、並びに各移動体間の離間距離(移動体1-移動体0、移動体2-移動体1、移動体3-移動体2)を示し、図11は、この時の移動体0、移動体1、移動体2、移動体3の前後加速度と横加速度の関係(“g-g”ダイアグラム)を示している。
 図10(a)に示すように、カーブ路に進入・退出する移動体0、移動体1、移動体2、移動体3それぞれにカーブ路に対する異なる前後加速度制御が行われており、その結果、図10(b)に示すように、各移動体間の離間距離(移動体1-移動体0、移動体2-移動体1、移動体3-移動体2)は、旋回開始前から旋回終了まで2回の増減を繰り返し(具体的には、一旦離間距離をあけた後、そのあけた分の離間距離をつめる動作を行い)、最終的に初期の離間距離d0に収束している。なお、図10(a)に示す例では、先頭移動体がカーブ路に対する減速を開始するシーンで、隊列最後尾の移動体から順次負の前後加速度を発生させて減速を開始しているが、後述するように、後方の移動体ほど発生する前後加速度が小さく(減速度が大きく)なるように制御してもよい。また、この時の前後加速度と横加速度の関係は、図11に示すように、隊列内全ての移動体(移動体0、移動体1、移動体2、移動体3)において、原点0から円を描くような形状となっていることがわかる。
 このように、本発明の前後加速度制御により、隊列走行によるカーブ路通過時においても、離間距離を所定以上に保ちながら、隊列内のすべての移動体に横運動と前後運動が連係した乗り心地が好適となり荷崩れが防止される加速度変化を提供することが可能となる。
 なお、隊列走行時におけるカーブ路通過時の前後加速度制御方法は、ここに示した方法に限定するものではなく、隊列内を先行して走行する移動体nと前記移動体nに後続する移動体n+1の離間距離dn+1が、前記移動体n+1の横加速度の絶対値、もしくは走行経路(道路経路上で移動体n+1が走行すべき経路)の曲率(≒道路曲率)が増加する前に、両者の離間距離が増加するように、移動体n+1、もしくは移動体nと移動体n+1の両方の前後加速度を制御し、前記移動体n+1の横加速度の絶対値、もしくは走行経路の曲率が増加し始める際に(つまり、前記移動体nおよび前記移動体n+1の横加速度の絶対値、もしくは走行経路の曲率が増加する区間以降で)、移動体n+1の速度が移動体nの速度よりも小さくなるよう、移動体nおよび移動体n+1の前後加速度を制御する方法であればよい。また、隊列内を先行して走行する移動体nと後続移動体n+1の離間距離dn+1が、後続の前記移動体n+1の横加速度の絶対値、もしくは走行経路の曲率(≒道路曲率)が減少する前に、両者の離間距離が増加するように、移動体n、もしくは移動体nと移動体n+1の両方の前後加速度を制御し、前記移動体n+1の横加速度の絶対値、もしくは走行経路の曲率が減少し始める際に(つまり、前記移動体および前記移動体n+1の横加速度の絶対値、もしくは走行経路の曲率が減少する区間以降で)、移動体n+1の速度が移動体nの速度よりも小さくなるよう、移動体nおよび移動体n+1の前後加速度を制御する方法であればよい。前記図7(a)に示した以外の方法として、例えば図7(a)における時刻t1および時刻t2を同じタイミングとし、移動体n+1に発生させる負の前後加速度を、移動体nに発生させる負の前後加速度よりも小さな値(大きな減速度)とすることで、後続移動体n+1の横加速度の絶対値が増加する前に両者の離間距離dn+1を大きくする方法であってもよい。また、前記図8(a)に示した以外の方法として、例えば図8(a)において、時刻t7よりも早いタイミングで、移動体nに、移動体n+1(ここでの前後加速度はゼロでなくてもよい)よりも大きな前後加速度を発生させることで、移動体n+1の横加速度の絶対値が減少する前に両者の離間距離dn+1を大きくする方法であってもよい。
 そして、本実施形態では、隊列走行する各移動体の前後加速度を、搬送物の種類や状態に応じて調整する制御が行われる。例えば、移動体n+1に乗員が乗っているか否か、そして、乗員が乗っている場合には移動体n+1の乗員が前方の移動体nを注視しているか否かに応じて移動体n+1の前後加速度を調整する制御が行われる。具体的には、移動体n+1に乗員が乗っている場合には、乗っていない場合と比較して、カーブ進入前から定常旋回に至るまで離間距離dn+1を緩やかに増減させるように前後加速度を調整する制御が行われる。そして、移動体n+1の乗員が前方の移動体nを注視している場合には、注視していない場合と比較して、カーブ進入前から定常旋回に至るまで離間距離dn+1を緩やかに増減させるように前後加速度を調整する制御が行われる。また、移動体n+1に、精密機器や生鮮食料品などの慎重かつ丁寧な取り扱いが要求される荷物が積載されている場合には、積載されていない場合と比較して、離間距離dn+1を緩やかに増減させるように前後加速度を調整する制御が行われる。更に、移動体n+1がダンプトラック等の建設機械であり、土砂などの搬送物が積載されて重心の位置が高い場合には、未積載により重心の位置が低いときと比べて、カーブ進入前から定常旋回に至るまで離間距離dn+1を緩やかに増減させるように前後加速度を補正する制御が行われる。
<移動体制御システム>
 以下、図12~図27を用いて、本実施形態による移動体制御システム1の構成及び動作について説明する。
 本実施形態の移動体制御システム1は、移動体運動制御装置1Aによって隊列内の各移動体21の走行情報を共有し、隊列内の各移動体21の前後加速度を個別に制御するものである。各移動体21は、移動体運動制御装置1Aから出力される制御指令に基づいて自動運転を行う自動運転装置を有している。移動体運動制御装置1Aは、各移動体21の搬送物の有無や搬送物の内容、性質などに応じて各移動体21の前後加速度を調整する制御を行う。
 最初に、図12、図13、図14、図15を用いて、本実施形態による移動体制御システムの構成について説明する。
 図12は、本発明に係る移動体制御システムの実施形態を搭載したシステム全体の概念図である。
 移動体制御システム1は、移動体運動制御装置1Aと、複数台の移動体21によって構成される。移動体制御システム1は、移動体運動制御装置1Aと複数台の移動体21との間で情報の送受信を行い、移動体運動制御装置1Aにより複数台の移動体21を一つの移動体群として隊列走行させる制御を行う。なお、図12に示す例では、移動体運動制御装置1Aが移動体21の外部に備えられているが、隊列走行をする移動体21の内部に配備してもよい。また、移動体21を外部から制御するコントロールセンタの制御器内に配備してもよい。
 移動体運動制御装置1Aは、記憶領域、演算処理能力、および信号の入出力手段等を有する演算装置を備えており、内部機能として、隊列制御演算部1Aa、および走行制御演算部1Abを有する。
 隊列制御演算部1Aaでは、各移動体21からコース形状、外界情報、移動体位置情報、搬送物情報、および移動体運動状態情報を取得し、これらの情報に基づいて、隊列走行させる各移動体21の目標経路、目標速度、および目標離間距離を作成する。また、ここで、移動体運動制御装置1Aへの入力として、各移動体21が隊列走行するエリアの交通情報が得られる場合、交通情報を隊列制御演算部1Aaへ入力し、各移動体21の目標経路、目標速度、および目標離間距離を作成してもよい。
 走行制御演算部1Abでは、隊列制御演算部1Aaで作成した目標経路、目標速度、目標離間距離、および移動体運動状態情報などから、前後加速度を発生させる制御指令値としての前後加速度指令値を各移動体21に対して個別に演算し、各移動体21に送信する。
<移動体21>
 移動体21は、人や荷物等の搬送物を載せて走行可能な移動体であり、本実施形態では、隊列を構成する複数の移動体21の中に、人を輸送する移動体が少なくとも一つ存在することを条件としている。移動体21としては、例えば一般乗用車、商用車、バス(人を輸送可能な新モビリティを含む)、建設機械(ダンプなど)などであり、また、例えば荷物や部品を自動で搬送する無人搬送機でもよい。複数の移動体21が隊列走行することによって形成される一つの移動体群は、移動体21の種類が同じものに限定されるものではなく、種類の異なる移動体21の組み合わせにより構成することも可能であり、例えば一般乗用車と無人搬送機とを混在させて隊列を構成することも可能である。
 図13は、本発明に係る移動体制御システムの実施形態における移動体の一例を示す概念図である。図13に示す移動体21は、複数の乗員を乗せて移動可能な自動車であり、移動体運動制御装置1Aから送信される制御指令値に基づいて自動運転を行う自動運転装置を備えている。
 移動体21は、移動体運動制御装置1Aから制御指令値を受信すると、自己に発生する前後加速度および/もしくは横加速度を制御可能なアクチュエータ(ブレーキアクチュエータ11、駆動アクチュエータ13、舵角制御アクチュエータ16)の駆動制御を行う各制御ユニット(ブレーキ制御ユニット10、駆動トルク制御ユニット12、舵角制御ユニット15)に通信ライン14を通じてその制御指令値を送信する。
 移動体21は、移動体運動状態情報を取得するセンサ(加速度センサ2、ジャイロセンサ3、車輪速センサ8)と、ドライバ操作情報を取得するセンサ(操舵角センサ5、ブレーキペダルセンサ17、アクセルペダルセンサ18)と、移動体21によって搬送される搬送物の情報を取得するセンサと、移動体21が走行する走行路の走行路情報を取得するセンサ(コース形状取得センサ6、位置検出センサ9、外界情報検出センサ19)と、自己の移動体以外の制御機器と通信することで情報の送受信を行う車外通信ユニット20などから各種情報を取得し、移動体運動制御装置1Aに送信する。
 移動体運動状態情報を取得するセンサは、移動体速度、前後加速度、横加速度、ヨーレイトを取得できるセンサ、もしくは手段であればよく、上記センサ構成に限定するものではない。例えばグローバルポジショニングシステム(GPS)により得られる位置情報を微分することで、移動体速度を取得してもよい。また、カメラのような画像取得センサを用いて移動体のヨーレイト、前後加速度、横加速度を取得してもよい。また、移動体21が直接センサの入力を持たなくともよい。例えば別な制御ユニット(例えばブレーキ制御ユニット10)から通信ライン14を通じて必要な情報を取得してもよい。
 ドライバ操作情報を取得するセンサは、ドライバによるステアリングホイール4の操作量、図示していないブレーキペダルおよびアクセルペダルの操作量を取得できればよく、上述の移動体運動状態情報の取得同様、前記移動体21が直接センサの入力を持たなくともよい。例えば別な制御ユニット(例えばブレーキ制御ユニット10)から通信ライン14を通じて必要な情報を取得してもよい。
 移動体21の搬送物情報を取得するセンサは、移動体21の室内や荷室内を撮像するカメラ、あるいはセンシングする赤外線センサやレーザセンサによって構成されている。そして、移動体21に乗員や荷物等の搬送物が乗っているのか、それとも空車や空荷の状態なのか、搬送物が乗っているのであれば、その内容や種類、乗員であればどのような向きや姿勢で乗っているのか、視線の向きなどの情報を取得する。これらの情報は、センサの入力を持たなくてもよく、例えば所定の情報入力手段から取得してもよい。
 移動体21は、走行路情報を取得するセンサとして、グローバルポジショニングシステム(GPS)を自己位置検出センサ9として用い、外界情報検出センサ19として、カメラやレーダ等、自己周辺の障害物を検出して走行可能な領域を検出可能なセンサを用い、コース形状取得センサ6として、ナビゲーションシステムのような自己の走行経路情報を取得できるものを利用できる。ここで、自己の移動体走行路情報を取得するセンサとして、自己の進行方向におけるコース形状(道路形状ともいう)および外界情報(走行可能領域)が取得できる手段であればよく、これらセンサに限定するものではない。例えば移動体運動制御装置1Aや路上に設置された道路情報を送信する機器との通信により自己の移動体21の前方のコース形状を取得する方法であってもよいし、カメラのような撮像手段により自己の移動体21の前方もしくは周囲、またはその両方の画像を取得し、自己の移動体の前方のコース形状を取得する方法であってもよい。また、これら手段のいずれか、もしくはその組み合わせにより、自己の移動体21の進行方向のコース形状を演算するユニットから通信ライン14を通じて取得する方法であってもよい。
 車外通信ユニット20は、無線もしくは有線による通信により、移動体外に設置されている移動体運動制御装置1Aとの通信により信号の送受信を行うものであり、通信方法としては、セルラー回線もしくWiFi(登録商標)等の無線通信手段による通信方法であっても、他の移動体もしくは路面側インフラシステムと電信ケーブルを介した直接接触による通信方法であってもよい。移動体21は、車外通信ユニット20を介して自己の走行情報(移動体情報)を移動体運動制御装置1Aに出力(送信)し、移動体運動制御装置1Aから制御指令を入力(受信)することができる。ここで、走行情報(移動体情報)には、走行経路、速度、前後加速度制御計画、他の移動体との離間距離などが含まれる。
 また、移動体21は、車外通信ユニット20による移動体運動制御装置1Aとの通信により、移動体21が走行する路面の過去の走行データ経路を取得してもよい。なお、移動体情報は、前記車外通信ユニット20を用いず、移動体21に搭載されている前記外界情報検出センサ19としてのカメラやレーダ等を用いて取得してもよい。
 前記移動体21に発生する前後加速度を制御可能な加減速アクチュエータ(ブレーキアクチュエータ11、駆動アクチュエータ13)は、タイヤ7と路面間に発生する力を制御することで当該移動体21に発生する前後加速度を制御可能なアクチュエータであり、例えば、燃焼状態を制御することでタイヤ7にかかる制駆動トルクを制御し、移動体21の前後加速度を制御可能な燃焼エンジン、もしくは電流を制御することでタイヤ7にかかる制駆動トルクを制御し、移動体21の前後加速度を制御可能な電動モータ、もしくは動力を各車輪に伝達する際の変速比を変えることで移動体21の前後加速度を制御可能な変速機、もしくは各車輪のブレーキパッドにブレーキディスクを押しつけることで移動体21に前後加速度を発生させる摩擦ブレーキといった、前後加速度を制御可能な加減速アクチュエータを適用することができる。
 移動体21は、移動体運動制御装置1Aから前後加速度指令値を受け取ると、前後加速度を発生し得る前記加減速アクチュエータを前後加速度発生手段として、前記加減速アクチュエータ(ブレーキアクチュエータ11、駆動アクチュエータ13)の駆動制御器(ブレーキ制御ユニット10、駆動トルク制御ユニット12)へ前記前後加速度指令値を送る。そして、移動体21は、移動体運動制御装置1Aから横運動指令値を受け取ると、前記横運動を発生し得る舵角制御アクチュエータ16を旋回運動発生手段として、前記舵角制御アクチュエータ16の駆動制御器(舵角制御ユニット15)へ前記横運動指令値としての舵角指令値を送る。
 ここで、移動体運動制御装置1Aから移動体21が受け取る信号は前後加速度そのものではなく、前記加減速アクチュエータによって前記前後加速度指令値を実現し得る信号であればよい。同様に、移動体運動制御装置1Aから移動体21が受け取る信号は舵角そのものではなく、前記舵角制御アクチュエータ16により、舵角指令値を実現し得る信号であればよい。
 例えば、前記加減速アクチュエータが燃焼エンジンである場合、前記前後加速度指令値を実現し得る制駆動トルク指令値を駆動トルク制御ユニット12へ送る。また、駆動トルク制御ユニット12を介さず、前後加速度指令値を実現する燃焼エンジンの駆動信号を、燃焼エンジンの制御アクチュエータに直接送ってもよい。また、油圧によりブレーキパッドをブレーキディスクに押し付ける油圧式摩擦ブレーキを用いる場合、前後加速度指令値を実現する油圧指令値をブレーキ制御ユニット10へ送る。また、ブレーキ制御ユニット10を介さず、前後加速度指令値を実現する油圧式摩擦ブレーキ駆動アクチュエータの駆動信号を油圧式摩擦ブレーキ駆動アクチュエータに直接送ってもよい。
 また、前後加速度指令値を実現する際に、前後加速度指令値に応じて駆動制御を行う前記加減速アクチュエータを変更してもよい。
 例えば、前記燃焼エンジンと油圧式摩擦ブレーキを前記加減速アクチュエータとして持つ場合、前記前後加速度指令値が前記燃焼エンジンの制駆動トルク制御により実現できる範囲であれば、前記燃焼エンジンを駆動制御し、前記前後加速度指令値が前記燃焼エンジンの制駆動トルク制御で実現できない範囲の負の値である場合、前記燃焼エンジンと合わせて油圧式摩擦ブレーキを駆動制御する。また、前記電動モータと前記燃焼エンジンを前記加減速アクチュエータとして持つ場合、前記前後加速度の時間変化が大きい場合は前記電動モータを駆動制御し、前記前後加速度の時間変化が小さい場合は前記燃焼エンジンを駆動制御するようにしてもよい。また、通常時は前記前後加速度指令値を電動モータにより駆動制御し、バッテリーの状態等により電動モータにより前後加速度指令を実現できない場合、他の加減速アクチュエータ(燃焼エンジン、油圧式摩擦ブレーキ等)を駆動制御するようにしてもよい。
 また、通信ライン14として、信号によって異なる通信ラインおよび通信プロトコルを用いてもよい。例えば大容量のデータをやり取りする必要のある自移動体走行路情報を取得するセンサとの通信にイーサネットを用い、各アクチュエータとの通信にはCAN(Controller Area Network)を用いる構成であってもよい。
<移動体運動制御装置1A>
 移動体運動制御装置1Aは、記憶領域、演算処理能力、および信号の入出力手段等を有する演算装置を備えており、移動体運動状態情報、ドライバ操作情報、自移動体走行路情報など、各移動体21から得られた各種情報を用いて、各移動体21に発生させる前後加速度指令値を演算し、かかる制御指令値を各移動体21にそれぞれ送信する。また、移動体運動制御装置1Aは、移動体運動状態情報、ドライバ操作情報、自移動体走行路情報などにより得られた各種情報から各移動体21に発生させる横運動指令値を演算し、各移動体21にそれぞれ送信する。
 移動体運動制御装置1Aから各移動体21に送る制御指令値としては、前後加速度指令値そのものであっても、移動体21に搭載されている加減速アクチュエータ(ブレーキアクチュエータ11、駆動アクチュエータ13)の駆動制御器(ブレーキ制御ユニット10、駆動トルク制御ユニット12)にて、前後加速度指令値を実現するよう演算可能な制御パラメータであってもよい。
 詳しくは、走行制御演算部1Abにて行われるカーブ路に対する前後加速度制御指令値演算と同じ制御アルゴリズムを、移動体21に搭載されている自動運転制御装置22に備え、走行制御演算部1Abは、当該制御アルゴリズムのゲインや閾値といった制御パラメータを送ってもよい。
 また、隊列移動体内の移動体21の前後加速度制御範囲、すなわち前後加速度制御により発生可能な前後加速度最大値および前後加速度最小値が、移動体によって異なる場合、車間距離は必ずしも全て同じである必要はなく、移動体21_nとそれに追従する後続移動体21_n+1にて制御可能な前後加速度制御範囲に応じて、移動体21_nと後続移動体21_n+1との間の目標離間距離Dtgt_n+1を変更してもよい。つまり、隊列走行の各移動体21に発生可能な最大前後加速度および最小前後加速度、並びに移動体21_nと後続移動体21_n+1との間の目標離間距離を設定するとともに、最大前後加速度および/または最小前後加速度に応じて目標離間距離を変更してもよい。
 具体的には、例えば移動体21_nの最小前後加速度よりも、後続移動体21_n+1の最小前後加速度が小さい場合、すなわち負の前後加速度制御可能な範囲が、移動体21_nよりも後続移動体21_n+1が広い場合、目標離間距離Dtgt_n+1を、移動体21_nが追従する移動体である先行移動体21_n-1との間の目標離間距離Dtgt_nよりも、大きな値とする。ここで、前後加速度制御可能な範囲は、移動体のアクチュエータによる制約に加え、乗員の乗り心地を考慮して設定される値であり、前後加速度制御可能な範囲は、移動体内に乗員がいない場合、移動体内に乗員がいる場合よりも、大きな値としてもよい。
<隊列制御演算部1Aa>
 図14は、隊列制御演算部の内部機能を説明するブロック図である。
 隊列制御演算部1Aaでは、コース形状、外界情報、移動体位置情報、移動体運動状態情報、隊列状態情報、および搬送物情報に基づいて、各移動体21を隊列走行させるための目標経路、目標速度、目標離間距離を演算する処理が行われる。隊列制御演算部1Aaは、目標経路取得部31、移動体運動状態取得部32、隊列情報取得部33、搬送物情報取得部34、および許容値算出部35を有する。
<目標経路取得部31>
 目標経路取得部31では、移動体走行路情報(コース形状、外界情報)、および移動体運動状態情報から、各移動体21を一つの移動体群として隊列走行させるための目標経路(走行経路)および走行可能領域を取得する。ここで、目標経路(走行経路)は、コース(道路)経路上で各移動体21が走行すべき経路であり、目標経路の作成方法としては、各移動体21が走行するコース形状から目標経路を作成する方法であってもよいし、外部機器との通信により、各移動体21が走行する路面の過去の走行データ経路を取得し、その経路に基づいて作成する方法であってもよい。
 目標経路取得部31は、外界情報と、許容値算出部35で算出された移動体運動許容値に基づいて、移動体21が走行する経路を定義する目標経路の情報を生成する。ここで目標経路の情報とは、移動体21が走行する経路Lと、所定位置における移動体21の通過時間tを含んだ情報である。なお、目標経路の情報は、所定位置における通過時間情報で規定するのではなく、所定位置における目標速度の情報を規定するものでも良い。また、経路Lとは、具体的には、目標ルート上に設定された目標縦位置と目標横位置の座標が一定間隔毎に規定されたものである。
 許容値算出部35で算出した前後加速度許容値CAxが小さい場合、目標軌道における移動体21の目標走行速度を全体的に低くする。これにより、大きな加減速が発生することなく車両20が走行することが可能となる。また、許容値算出部35で算出した横加速度許容値CAyが小さい場合、目標経路の曲率を小さくする。これにより、大きな横加速度Ayが発生することなく移動体21が走行することが可能となる。
 同様に、許容値算出部35が算出したヨーレイト許容値CRyが小さい場合、目標経路の曲率を小さくする。これにより、急激なヨー運動を伴わずに移動体21が走行することが可能となる。
<移動体運動状態取得部32>
 移動体運動状態取得部32では、移動体運動状態情報から、各移動体21の運動状態(走行速度、旋回状態、ドライバ操作量等)を取得する。
<隊列情報取得部33>
 隊列情報取得部33では、車外通信ユニット20による通信などにより、各移動体21の走行情報(移動体情報)を取得する。隊列情報取得部33は、隊列情報として、隊列内の位置、走行経路、速度、前後加速度制御計画、および移動体21どうしの離間距離などの情報を取得する。また、隊列情報取得部33は、隊列情報として、前記情報に加え、隊列継続可否フラグを受け取ってもよい。
<搬送物情報取得部34>
 搬送物情報取得部34では、移動体21によって搬送される搬送物の情報を取得する。搬送物情報は、例えば各移動体21からそれぞれ取得することができ、また、外部機器との通信により、取得してもよい。搬送物情報には、例えば移動体21に乗っている荷物の情報、乗員が乗っている場合には乗員の視線の向きなどの情報も含まれる。
 例えば、カメラ等の車内センサから取得した移動体21内の情報に基づいて、乗員の乗車位置や行動、乗員の身体が向いている方向(乗員方向D)等を推定する。乗員行動の具体例として、睡眠、読書、動画閲覧等が挙げられる。
 図16は、搬送物情報取得部34の要部を示すブロック図である。ここに示すように、搬送物情報取得部34は、視線情報推定部34a、視認対象推定部34b、乗員方向推定部34cを備えている。
 視線情報推定部34aは、車内センサから得られた移動体21内の情報に基づいて、乗員の視線を検出または推定する。例えば、カメラにより乗員の眼球運動を追跡して、視線情報を推定してもよい。
 視認対象推定部34bは、視線情報推定部34aより出力される視線情報に基づいて、乗員の視認対象及び乗員の行動を検出または推定する。ここではまず、視線情報に基づいて、乗員の視認対象が移動体外か移動体内か判別する。そして、乗員の視認対象が移動体外と推定された場合には、視認対象を細かく分類せず、視認対象を移動体外対象物とする。乗員行動に関しても細かく分類せず、移動体外視認とする。
 一方、乗員の視認対象が移動体内と推定された場合であれば、視認対象および乗員行動の詳細な判別を行う。視認対象として、例えば、本、書類、ディスプレイ、会話相手などが挙げられる。視認対象の判別方法としては、乗員視線の先にある対象物をデータベースから推定する手法や学習モデル(画像情報を入力とした深層学習等)から推定する手法が挙げられる。同時に、乗員が視認対象を把持しているか否かも判定する。また、視線情報および視認対象情報に基づいて乗員行動を推定する。これは、直接乗員行動を推定する学習モデルから乗員行動を推定してもよい。
 乗員方向推定部34cは、車内センサから得られた移動体内の情報に基づいて、乗員の身体がどちらの方向に向いているか(移動体の進行方向Dに対する相対的な乗員方向D)を推定する。
<許容値算出部35>
 許容値算出部35は、搬送物情報取得部34から取得した乗員情報(視認対象、乗員行動、乗員方向等)に基づいて、乗員に不快感を抱かせないために許容される移動体の運動制御値である移動体運動許容値Cを決定する。この移動体運動許容値Cは、具体的には、移動体運動情報を表す物理量である前後加速度Ax、横加速度Ay、上下加速度Az、ヨーレイトRy、ロールレイトRr、ピッチレイトRp等の夫々についての許容値である。
 例えば、図17に示すように、乗員の視認対象(図中では星印で表示)が移動体外に存在する場合には、乗員の乗車位置が運転席であるか後部座席であるかによらず、移動体運動許容値C~Cを基準値S~Sに設定する。基準値Sは、一般的に乗員が不快に感じる物理量の閾値であり、例えば前後加速度Axであれば±0.2Gである。なお、図16に示すように、基準値Sは低速時には速度に比例して大きくなるが、所定の速度に達した以降は、一定となるように設定されている。
 一方、図18に示すように、乗員の視認対象(星印)が移動体内に存在する場合には、移動体運動許容値Cを基準値Sより小さい抑制値S’とする。すなわち、基準値S~Sよりも小さい抑制値S’~S’を移動体運動許容値C~Cに設定する。
 例えば、視認対象の物体が乗員により把持されている場合、前後加速度Axおよび上下加速度Azが生じることで視線のブレが生じてしまい、違和感の発生や、乗員の車酔いを誘発する可能性がある。そこで、視認対象の物体が乗員により把持されている場合(例えば読書中)においては、移動体の前後加速度許容値CAx、上下加速度許容値CAzを、それぞれの基準値Sよりも小さい抑制値S’に変更する。
 一方、視認対象の物体が乗員により把持されていない場合、すなわち移動体内に配置されているディスプレイ等を視認している場合においては、視聴するコンテンツの種類に応じて移動体運動許容値Cを変更する。例えば、動画視聴時用と静止画視聴時用の抑制値S’を別個に用意しておくことで、ニュース映像視聴時と比較して、スライドショー映像視聴時には、移動体運動許容値Cをより小さくする。
 また、図19に示すように、乗員の視認対象が移動体内に存在する場合では、乗員方向Dに基づいて移動体運動許容値Cを変更する。視認対象や乗員行動が等しい場合においても、進行方向Dと乗員方向Dが略一致している時と比較し、進行方向Dと乗員方向Dが異なる場合における移動体運動許容値Cをより小さいものとする。例えば、図18に示すように、移動体運動許容値Cの一つである前後加速度許容値CAxと横加速度許容値CAyを、進行方向Dと乗員方向Dが等しい場合の基準値SAx、SAyより小さい抑制値S’Ax、S’Ayに設定する。
<走行制御演算部1Ab>
 図15は、走行制御演算部1Abの内部構成を説明する機能ブロック図である。
 走行制御演算部1Abでは、各移動体21の前後加速度の演算が行われる。走行制御演算部1Abは、移動体運動制御演算部38と、制御指令送信部36と、制御計画送信部37とを有する。
 移動体運動制御演算部38では、移動体運動制御装置1Aにより得られた目標経路、目標速度、目標離間距離などの各種情報に基づいて、移動体21に対する前後加速度制御を、移動体21に搭載のアクチュエータにて実現するための前後加速度指令値、および各移動体21のカーブ路に対する前後加速度制御計画を演算する。移動体運動制御演算部38は、隊列系を形成する移動体群の移動体21ごとにそれぞれ前後加速度指令値および前後加速度制御計画を演算する。前記前後加速度指令値の演算結果は、制御指令送信部36に送られ、前記前後加速度制御計画の演算結果は制御計画送信部37に送られる。
 ここで、前後加速度に加え、横加速度も移動体運動制御装置1Aにて制御する場合、移動体運動制御演算部38にて、目標経路取得部31、移動体運動状態取得部32、隊列情報取得部33、及び搬送物情報取得部34により得られた情報に基づいて、移動体21に搭載のアクチュエータにて目標経路を走行する舵角指令値を演算し、制御指令送信部36に送る。この舵角指令値も、前後加速度指令の演算結果と同様に、移動体群の移動体21ごとにそれぞれ演算され、制御指令送信部36に送られる。
 制御指令送信部36では、前記移動体運動制御演算部38により作成された移動体21ごとの前後加速度指令値、もしくは前後加速度指令値と舵角指令値の両方を、制御指令値として、移動体群の中の対応する移動体21にそれぞれ送信する。各移動体21は、移動体運動制御演算部38により作成された前後加速度指令値、もしくは前後加速度指令値と舵角指令値の両方に基づいて、前後加速度および/もしくはタイヤ実舵角を制御可能なアクチュエータ(ブレーキアクチュエータ11、駆動アクチュエータ13、舵角制御アクチュエータ16)の駆動制御を行う各制御ユニット(ブレーキ制御ユニット10、駆動トルク制御ユニット12、舵角制御ユニット15)に制御指令値を送る。
 一方、制御計画送信部37では、移動体運動制御演算部38により作成された前後加速度制御計画を、対応する移動体21にそれぞれ送信する。
 次に、図20~図23を用いて、本実施形態における移動体運動制御方法について説明する。図20は、本実施形態の移動体運動制御装置1Aにおける処理の内容を示すフローチャートである。図20のフローチャートによる判断は、隊列を形成する複数の移動体21に対してそれぞれ行われる。
 まず、S41~S44では、隊列制御演算部1Aa(の目標経路取得部31、移動体運動状態取得部32、隊列情報取得部33、および搬送物情報取得部34)によって、演算対象の移動体21について、目標経路、走行可能範囲、速度制御範囲、移動体運動状態、先行移動体走行経路、先行移動体速度、先行移動体前後加速度制御計画、先行移動体離間距離、後続移動体走行経路、後続移動体速度、後続移動体前後加速度制御計画、後続移動体離間距離(必要に応じて、最大前後加速度、最小前後加速度、目標離間距離)などの情報を取得する。目標経路は、移動体重心位置を原点とし、移動体速度ベクトルの方向を正としたXv軸、それと直行するYv軸を取った座標上のノード点位置データNPn(Xvn,Yvn)として変換される。nは、最も移動体に近い点を0とし、自移動体進行方向に向かって1、2・・・、nmaxと増加する整数である。また、nmaxは取得可能なノード点位置データ番号nの最大値である。また、NP0のYv軸成分であるYv0は、移動体の横方向偏差となる。また、各ノード点はノード点位置における走行可能範囲、および車速制御範囲といった情報も合わせて持つものとする。また、隊列情報として、隊列走行において隊列最前部であり、先行移動体が存在しない移動体については、先行移動体情報として“先行移動体なし”という情報を取得し、また、隊列最後部であり、後続移動体が存在しない移動体については、後続移動体情報として“後続移動体なし”という情報を取得する。
 S45では、演算対象の移動体21に対して先行する移動体21が存在するか否かの判断が行われる。具体的には、移動体運動制御装置1A(の移動体運動制御演算部38)は、演算対象の移動体21が先行移動体前後加速度制御計画を有しているか否かを判定する。ここで、演算対象の移動体21が先行移動体前後加速度制御計画を有していない場合(S45でNO)、演算対象の移動体21が隊列最前部、つまり、隊列の先頭の移動体21であると判断してS47に進む。また、演算対象の移動体21が先行移動体前後加速度制御計画を有している場合(S45でYES)には、先行移動体21_nに追従して走行する後続移動体21_n+1であるとして、S46に進む。
 S47では、移動体運動制御装置1A(の移動体運動制御演算部38)は、隊列最前部、つまり、隊列の先頭の移動体21_1(図1の移動体0)の前後加速度を演算する(前後加速度演算A)。前後加速度演算Aでは、目標経路、走行可能範囲、車速制御範囲、移動体運動状態から、隊列最前部の移動体21_1の前後加速度指令値および前後加速度制御計画を演算する。例えば隊列最前部の移動体21_1の移動体速度が車速制御範囲を超えて高い場合、移動体運動制御装置1A(の移動体運動制御演算部38)は、移動体速度が車速制御範囲に収まるよう、負の前後加速度指令値を演算する。また、目標経路がカーブ路形状(走行路の道路曲率(≒走行経路の曲率)の絶対値が増加して最大値もしくは略一定に至る形状、もしくは、走行路の道路曲率(≒走行経路の曲率)の絶対値が最大値もしくは略一定から減少する形状)となっており、カーブ路に応じた加減速制御をおこなう場合、カーブ路形状に基づいた前後加速度指令値が演算される。例えば、移動体運動制御装置1A(の移動体運動制御演算部38)は、走行路の道路曲率(≒走行経路の曲率)の絶対値が増加し、移動体21_1に発生する横加速度の絶対値が増加する区間において負の前後加速度を発生(減速)させ、横加速度の時間変化が大きいほど、発生する前後加速度が小さくなるよう、前後加速度値を制御する(図7(a)、図10(a)参照)。また、移動体運動制御装置1A(の移動体運動制御演算部38)は、走行路の道路曲率(≒走行経路の曲率)の絶対値が減少し、移動体21_1に発生する横加速度の絶対値が減少する区間において正の前後加速度を発生(加速)させ、横加速度の時間変化が大きいほど、発生する前後加速度が大きくなるよう前後加速度値を制御する(図8(a)、図10(a)参照)。前後加速度指令値を演算後、制御指令値として、移動体21_1に送信される。
 図21は、S47の前後加速度演算Aの内容を説明するフローチャートである。
 前後加速度演算Aでは、移動体21_1に対して設定されている目標経路にカーブ情報があるか否か、つまり、隊列の先頭の移動体21_1の前後加速度制御計画にカーブ情報があるか否かが判断される。そして、カーブ情報がない場合(S51でNO)、つまり、直線路の場合、目標速度に追従する前後加速度が演算される(S52)。一方、カーブ情報がある場合(S51でYES)、つまり、カーブ路の場合、横運動に連係した前後運動を発生させる前後加速度制御を行うべく、横加加速度に連係した前後加速度が演算される(S53)。したがって、移動体21_nが搬送している搬送物が乗員の場合は、カーブを走行する際の乗り心地の向上が図られ、搬送物が荷物の場合には荷崩れを防止することができる。
 S46では、移動体運動制御装置1A(の移動体運動制御演算部38)は、先行移動体21_nの前後加速度制御計画にカーブ情報があるか否か、すなわち、演算対象の移動体21_n+1の前方を走行する先行移動体21_nがカーブ路に対する前後加速度制御計画を有しているか否かを判定する。ここで取得する前後加速度制御計画としては、現時刻から所定時刻先までの前後加速度プロファイルと前後加速度プロファイルにカーブ路に起因した前後加速度制御計画フラグを付記したものであってもよいし、ノード点位置情報と各ノード点位置での速度プロファイルもしくは前後加速度プロファイルに、カーブ路に起因して設定されたプロファイル情報に当該情報を付記したものであってもよく、先行移動体21_nのカーブ路に対する前後加速度制御計画が分かる方法であればよい。先行移動体21_nの前後加速度制御計画にカーブ情報がない場合、演算対象の移動体21_nが直線路を走行するときの前後加速度を演算すべく、S48に進む。また、カーブ情報がある場合、演算対象である移動体21_n+1がカーブ路を走行するときの前後加速度を演算すべく、S49に進む。
 S48では、移動体運動制御装置1A(の移動体運動制御演算部38)は、前後加速度演算Bとして、先行移動体21_nの前後加速度制御計画に基づいて、演算対象の移動体21_n+1の前後加速度指令値および前後加速度制御計画を演算する(前後加速度演算B)。具体的には、移動体運動制御装置1A(の移動体運動制御演算部38)は、演算対象の移動体21_n+1が先行移動体21_nとの間の離間距離を維持するよう、先行移動体21_nとの相対速度がゼロとなる前後加速度指令値および前後加速度制御計画、もしくは移動体21_n+1と先行移動体21_nとの間の離間距離が目標離間距離となる前後加速度指令値および前後加速度制御計画を演算する。ここで、目標離間距離は、予め設定される値であってもよいし、外部から通信手段によって取得される値であってもよい。また、目標離間距離は、隊列走行の各移動体21に発生可能な最大前後加速度および/または最小前後加速度に応じて変更してもよい。前後加速度指令値を演算後、制御指令値として、移動体運動制御装置1Aから演算対象の移動体21_n+1に送信される。
 図22は、S48の前後加速度演算Bの内容を説明するフローチャートである。
 前後加速度演算Bでは、先行移動体21_nが存在する演算対象の移動体21_n+1前後加速度の演算が行われる。演算対象の移動体21_n+1の目標経路にカーブ情報を有していない(S46でNO)、つまり、演算対象の移動体21_n+1の前後加速度制御計画にカーブ情報がなく、直線路を走行する計画であるので、先行移動体21_nの加減速度の取得が行われる(S61)。そして、先行移動体21_nと、演算対象の移動体21_n+1との離間距離の調整に必要な前後加速度演算が行われる(S62)。それから、演算対象の移動体21_n+1について目標速度に必要な前後加速度演算が行われる(S63)。
 S49では、移動体運動制御装置1A(の移動体運動制御演算部38)は、前後加速度演算Cとして、先行移動体21_nの前後加速度制御計画および移動体進行方向のカーブ情報に基づいて、演算対象の移動体21_n+1の前後加速度指令値および前後加速度制御計画を演算する(前後加速度演算C)。具体的には、移動体運動制御装置1A(の移動体運動制御演算部38)は、前述のように先行移動体21_nの走行経路の曲率が増加して先行移動体21_nに発生する横加速度の絶対値が増減する前に、演算対象の移動体21_n+1と先行移動体21_nとの離間距離が増加し、演算対象の移動体21_n+1および先行移動体21_nの走行経路の曲率が略一定となって演算対象の移動体21_n+1および先行移動体21_nの横加速度が略一定となる領域で、離間距離が減少して目標離間距離となるよう、前後加速度指令値、および、カーブ路に起因した前後加速度制御フラグを付記した前後加速度制御計画を演算する。前後加速度指令値を演算後、制御指令値として、サーバ100から演算対象の移動体21_n+1に送信される。
 図23は、S49の前後加速度演算Cの内容の一例を説明するフローチャートである。図23では、演算対象の移動体21_n+1の搬送物が乗員である場合について説明する。
 前後加速度演算Cでは、まず、乗員の注視方向が前方であるか否かが判断される(S71)。
 演算対象の移動体21_n+1に乗っている乗員の注視方向が前方ではない場合(S71でNO)、カーブ進入時の先行移動体21_nの減速度が、演算対象の移動体21_n+1の減速度より大きくても、通常の範囲内であれば、演算対象の移動体21_n+1の乗員に不安感や圧迫感を与えるおそれはない。したがって、かかる場合には、乗り心地と輸送効率の両方を考慮した通常のカーブ前減速度が設定される(S72)。カーブ前減速度は、例えば図7(a)に示すように、一定値が算出される。カーブ前減速度は、先行移動体21_nがカーブに進入する前に演算対象の移動体21_n+1を予め減速させる減速度であり、横加加速度に連係しない前後加速度である。演算対象の移動体21_n+1は、カーブ前減速度で減速を開始し、減速を開始する時刻での前後加速度が、同時刻における先行移動体21_nに発生する前後加速度よりも小さくなるように、すなわち、同時刻で演算対象の移動体21_n+1に発生する減速度が、先行移動体21_nに発生する減速度よりも大きくなるよう、前後加速度制御が行われる。このカーブ前減速度も乗員の注視方向が前方であるか否かに応じて調整される。
 一方、乗員の注視方向が前方の場合(S71でYES)、先行移動体21_nの動きを見て、演算対象の移動体21_n+1の乗員が不安感や圧迫感を受けないようにすべくS73以降の処理に移行する。
 最初に先行移動体21_nの種別の情報が取得される(S73)。例えば、先行移動体21_nがダンプトラックやバスなどの大型の移動体である場合には、乗用車などの小型の移動体に比べて、後続移動体21_n+1の乗員が受ける不安感や圧迫感は大きくなる。したがって、先行移動体21_nが大型の移動体である場合には、小型の移動体のときと比べて、後続の演算対象の移動体21_n+1のカーブ前減速度を大きくする前後加速度制御を行うことが望ましい。したがって、先行移動体21_n-1の種別の情報を取得する。
 次に、先行移動体21_nに対する演算対象の移動体21_n+1の許容相対加速度を取得する処理がなされる(S74)。例えば先行移動体21_nの減速度が演算対象の移動体21_n+1の減速度よりも大きく、減速度の差が所定値以上の場合、後続移動体21_n+1の乗員は、先行移動体21_nが急激に迫ってくるように感じて、不安感や圧迫感を受けるおそれがある。したがって、先行移動体21_nとの減速度の差をある程度の範囲に収める必要がある。そこで、乗員が不安感や圧迫感を受けるのを防ぐことができる許容相対加速度を取得する。この許容相対加速度は、固定値でもよく、また、S73で取得した種別に応じて可変させてもよい。
 そして、移動体21_n+1の乗員の注視方向が前方である場合に応じたカーブ前減速度が算出される(S75)。S75では、S73およびS74で取得した情報、つまり、先行移動体21_nの種別と許容相対加速度とに基づいてカーブ前減速度が算出される。
カーブ前減速度は、乗員の注視方向が前方でない場合に算出されたカーブ前減速度(S72)と比較して、緩やかに減速されるように小さい値とされる。
 そして、横運動に連係した前後運動を発生させる前後加速度制御を行うために、横加加速度に連係した前後加速度が演算される。ここでは、横加加速度から前後加速度を算出するためのゲインKを演算する処理が行われる(S76)。なお、前後加速度は、下記の演算式(1)により求められる。
Figure JPOXMLDOC01-appb-M000001
 移動体21_n+1の乗員の注視方向が前方でない場合には(S71でNO)、乗員は先行移動体21_nを見ていないので、演算対象の移動体21_n+1がカーブ前減速度で減速して先行移動体21_nに接近しても、移動体21_n+1の乗員に不安感や圧迫感を与えることはない。したがって、S76では、乗員の乗り心地よりも輸送効率を優先させたゲインKの値が設定される。
 一方、移動体21_n+1の乗員の注視方向が前方である場合には(S71でYES)、演算対象の移動体21_n+1が通常の減速度で減速して先行移動体21_nに接近してきた場合に、移動体21_n+1の乗員に不安感や圧迫感を与えるおそれがある。したがって、S76では、カーブ入口から定常旋回に至るまでの間、先行移動体21_nとの離間距離を緩やかに増減させるゲインKの値が設定される。
 移動体21_n+1の乗員の注視方向が前方である場合(S71でYES)、S73で取得した先行移動体種別の情報と、S74で取得した許容相対加速度の情報と、S75で算出したカーブ前減速度の値を用いてゲインKの演算が行われる。一方、移動体21_n+1の乗員の注視方向が前方でない場合(S71でNO)、S72で取得したカーブ前減速度の値を用いてゲインKの演算が行われる。
 S76におけるゲインKの演算では、S71において演算対象の移動体21_n+1の乗員の注視方向が前方であると判定された場合に、前方でないと判定されたときと比較して、カーブ入口におけるゲインKとして、単体走行時あるいは先頭走行時のゲインKよりも大きい値が演算される。
 そして、演算対象の移動体21_n+1についてカーブ前減速時間Tsbが演算される(S77)。カーブ前減速時間Tsbは、カーブに進入する前に、横加加速度に連係しない前後加速度、つまり、カーブ前減速度を生じさせる時間であり、S72またはS75で算出されるカーブ前減速度の値に基づいて演算される。
 上記した前後加速度演算Cでは、演算対象の移動体21_n+1と先行移動体21_nとの場合を例に説明したが、演算対象の移動体21_n+1と後続移動体21_n+2との場合についても同様に適用することができる。つまり、演算対象の移動体21_n+1に乗っている乗員の注視方向が後方である場合、カーブを通過する際に、後続移動体21_n+2が演算対象の移動体21_n+1に急速度で接近してくると、乗員に不安感や圧迫感を与えるおそれがある。そこで、後続移動体21_n+2のカーブ前減速度とゲインKの演算において、演算対象の移動体21_n+1の乗員の注視方向が後方であると判定された場合に、注視方向が後方ではないと判定されたときと比較して、カーブ前減速度とゲインKが大きい値に設定される。
 図24は、カーブ路走行時に移動体に作用する前後加速度の変化を示す図であり、図24(a)は移動体が単体で走行する際の前後加速度と横加速度の変化を示し、図24(b)~図24(d)は、隊列走行している2台の移動体の加速度の変化を示す図である。図24(b)は、演算対象の移動体21_n+1に乗員が乗っていないときの前後加速度の変化を示し、図24(c)は、移動体21_n+1の乗員が前方を見ているときの前後加速度の変化を示し、図24(d)は、先行移動体21_nの乗員が後方を見ているときの前後加速度の変化を示す図である。そして、図25は、本実施形態における前後加速度制御を適用した際の前後加速度と横加速度の関係を示した“g-g”ダイアグラムであり、図25(a)は移動体21_n+1に乗員が乗っていない場合における“g-g”ダイアグラム、図25(b)は移動体21_n+1の乗員が前方を見ている場合における“g-g”ダイアグラム、図25(c)は先行移動体21_nの乗員が後方を見ている場合における“g-g”ダイアグラムである。
 図24(a)において、時刻t3は、移動体21_nがカーブ入口を通過する時刻、時刻t1は、時刻t3よりもカーブ前減速時間Tsbだけ前の時刻、時刻t5は、カーブ路内で横加速度が一定になる時刻、時刻t9は、カーブ出口を通過する時刻である。移動体21_nは、単体でカーブ路を走行する場合、移動体運動制御装置1Aからの制御指令値によって、カーブ入口を通過する時刻t3よりもカーブ前減速時間Tsbだけ前の時刻t1において前後加速度が発生するように車両制御がなされる。カーブ前減速時間Tsbにおける前後加速度は、横加速度に連係しない前後加速度である。そして、カーブ入口を通過する時刻t3から横加速度が一定となる時刻t5までの間、横運動に連係した前後運動を発生する前後加速度制御がなされる。
 図24(b)~図24(d)において、実線は演算対象の移動体21_n+1の加速度の変化を示し、破線は、先行移動体21_nの加速度の変化を示す。そして、時刻t4は、移動体21_n+1がカーブ入口を通過する時刻、時刻t1は、時刻t4よりもカーブ前減速時間Tsbだけ前の時刻、時刻t6は、カーブ路内で横加速度が一定になる時刻、時刻t8は、横加速度が減少を開始する時刻、時刻t9は、カーブ出口を通過する時刻である。そして、時刻t3は、先行移動体21_nがカーブ入口を通過する時刻、時刻t2は、カーブ前減速を開始する時刻、時刻t5は、カーブ路内で横加速度が一定になる時刻、時刻t9は、横加速度が0になる時刻である。図24(b)~図24(d)は、図25(a)~図25(c)にそれぞれ対応する。
 まず、図24(b)に示すように、移動体21_n+1に乗員が乗っていない場合、移動体21_n+1には、図6~図11にて説明した横運動に連係した前後運動を発生させる前後加速度制御が行われる。移動体21_n+1は、カーブ入口よりも手前のタイミングt1で減速が開始され、カーブ入口に到達する時刻t4まで(カーブ前減速時間Tsb)横加速度に連係しない前後加速度で減速される。
 そして、移動体21_n+1は、カーブ入口を通過すると、横加速度に応じた前後加速度制御により、先行移動体21_nよりも小さな前後加速度に制御される。図24(b)に示す例では、先行移動体21_nと後続移動体21_n+1との前後加速度の差は、最大でδa1となっている。
 そして、先行移動体21_nの横加速度がカーブ出口に向けて減少を開始する時刻t7よりも遅いタイミングの時刻t8において、後続移動体21_n+1の横運動に連係した前後運動となるように前後加速度制御が行われる。後続移動体21_n+1は、カーブ出口における横加速度に応じた前後加速度の制御では、先行移動体21_nよりも小さな前後加速度に制御される。図24(b)に示す例では、先行移動体21_nと後続移動体21_n+1との前後加速度の差は、最大でδb1となっている。図24(b)に示す例では、後続移動体21_n+1には、乗員が乗っていないので、その横加速度に応じた前後加速度は、乗り心地と輸送効率を両立させた通常の値に設定される。
 次に、図24(c)に示すように、後続移動体21_n+1の乗員が前方を見ているときは、図24(b)に示す乗員が乗っていないときよりも、カーブ入口における前後加速度がより小さく(減速度が大きく)なるように、前後加速度が制御される。図24(c)に示す例では、先行移動体21_nと後続移動体21_n+1との前後加速度の差は、最大でδa2となっている(δa1>δa2)。後続移動体21_n+1は、乗員が前方を見ている場合、図7(b)に示すように、カーブ進入前から定常旋回に至るまでの間、先行移動体21_nとの離間距離を緩やかに変化させることができる。したがって、離間距離が急激に縮まらないので、前方を注視している後続移動体21_nの乗員に不安感や圧迫感を与えるのを防ぐことができ、乗り心地を向上させることができる。
 次に、図24(d)に示すように、先行移動体21_nの乗員が後方を見ているときは、図24(b)に示す乗員が乗っていないときよりも、カーブ出口における前後加速度がより小さく(減速度が大きく)なるように、前後加速度が制御される。図24(d)に示す例では、先行移動体21_nと後続移動体21_n+1との前後加速度の差は、最大でδb2となっている(δb1>δb2)。後続移動体21_n+1は、先行移動体21_nの乗員が後方を注視しているときは、カーブ出口よりも前から減速度が大きくなり、先行移動体21_nから一旦離れてカーブ出口を通過した後に再び先行移動体21_nに接近して目標離間距離となるように、前後加速度が制御される。したがって、先行移動体21_nの乗員が不安感や圧迫感を受けるのを防ぐことができ、乗り心地を向上させることができる。
 図25は、本実施形態における前後加速度制御を適用した際の前後加速度と横加速度の関係を示した“g-g”ダイアグラムであり、図25(a)は後続移動体21-n+1に乗員が乗っていない場合における“g-g”ダイアグラム、図25(b)は後続移動体21-n+1の乗員が前方を見ている場合における“g-g”ダイアグラム、図25(c)は先行移動体21-nの乗員が後方を見ている場合における“g-g”ダイアグラムである。
 図25(a)に示すように後続移動体21-n+1の乗員が前方を見ていない場合と比較して、図25(b)に示すように後続移動体21-n+1の乗員が前方を見ている場合は後続移動体21-n+1の横加速度の増大に対する前後加速度の変化の度合いが大きくなっている。つまり、後続移動体21_n+1の乗員が前方を見ている場合は、後続移動体21_n+1のカーブ入口から定常旋回に至るまでの間(t4→t6)における減速度が大きくなるように変更されている。したがって、かかる場合には、先行移動体21_nに対して後続移動体21_n+1が緩やかに接近することになり(図7(b)を参照)、後続移動体21_n+1の乗員が先行移動体21_nの急な接近による不安感や圧迫感を受けるのを防ぐことができる。
 そして、図25(c)に示すように先行移動体の乗員21_nが後方を見ている場合は、先行移動体21_nの横加速度の減少に対する前後加速度の変化の度合いが大きくなっている。つまり、先行移動体21_nの乗員が後方を見ている場合は、先行移動体21_nの横加速度が減少を開始してからカーブ出口に至るまでの間(t8→t9)における減速度が加速度が大きくなるように変更されている。したがって、かかる場合には、先行移動体21_nに対して後続移動体21_n+1が緩やかに接近することになり、後続移動体21_n+1のあおり運転のような動きを防ぐことができ、先行移動体21_nの乗員が不安感や圧迫感を受けるのを防ぐことができる。
 図26は、S49の前後加速度演算C(前後加速度演算部)の内容の他の例を説明するフローチャートである。
 上記した実施例では、横加加速度に連係した前後加速度を算出するためのゲインKを、乗員の注視している方向に応じて変更する場合について説明したが、ゲインKの替わりに、もしくはゲインKとともにカーブ前減速時間を変更してもよい。例えば、後続移動体21_n+1の乗員の注視している方向が前方である場合には、注視している方向が前方でない場合と比較して、カーブ前減速時間を長くするように前後加速度制御を行ってもよい。
 本変形例では、最初に先行移動体21_nの種別の情報が取得される(S111)。次に、先行移動体21_nに対する後続移動体21_n+1の許容相対加速度を取得する処理がなされる(S112)。ここまでの処理は、図23に示すS73とS74の処理と同じである。
 次に、後続移動体21_n+1についてのカーブ前減速度が設定される(S113)。
そして、後続移動体21_n+1について、横加加速度に連係した前後加速度の制御を行うためのゲインKを演算する(S114)。
 そして、後続移動体21_n+1の乗員の状態を取得する処理が行われる(S115)。例えば、車内センサから得られた移動体内の情報に基づいて、乗員の視線を検出または推定し、乗員の状態として用いる。
 そして、この乗員の状態の情報を用いて、後続移動体21_n+1をカーブ進入前に減速させるためのカーブ前減速時間Tsbを演算する処理が行われる(S116)。カーブ前減速時間Tsbは、乗員の状態に応じて調整され、例えば、後続移動体21_n+1の乗員が前方を注視している場合には、前方を注視していない場合と比較して長い値が演算される。これにより、後続移動体21_n+1の横加速度の絶対値、もしくは走行経路の曲率が増加する前に、先行移動体21_nと後続の演算対象の移動体21_n+1との離間距離dn+1が増加するように、後続移動体21_n+1、もしくは先行移動体21_nと後続移動体21_n+1の両方の前後加速度が制御される。
 本変形例によれば、先行移動体21_nとの離間距離を長くとった状態でカーブに進入するので、旋回中に先行移動体21_nが後続移動体21_n+1に接近しても乗員が不安感や恐怖感を受けるのを防ぐことができる。
 なお、上述の実施形態では、搬送物の状態として乗員の注視している方向の場合を例に説明したがこれに限定されるものではない。例えば、搬送物が精密機械や生鮮食料品のように慎重かつ丁寧な取り扱いが要求されるものである場合には、移動体21による搬送中に搬送物に衝撃が加えられないように、あるいは荷崩れが起きないように、前後加速度を制御する必要がある。
 本実施形態によれば、移動体運動制御装置1Aにより、隊列走行をする各移動体21の隊列内の移動体位置に応じた前後加速度指令値の演算を行うことで、図10(a)、(b)及び図11に示す隊列走行を実現することができる。
 そして、各移動体21は、それぞれが搬送する搬送物の状態に応じて前後加速度が制御される。例えば、乗員が前方を注視している移動体21は、前方を注視していない移動体21と比較して、離間距離dn+1が緩やかに変化するように前後加速度制御が行われる(図7(b)を参照)。したがって、先行移動体21_n-1に対して後続移動体21_nが緩やかに接近することになり、後続移動体21_nの乗員が先行移動体21_n-1の急な接近による不安感や圧迫感を受けるのを防ぐことができる。また、移動体によって搬送される搬送物が、精密機器や生鮮食料品などの慎重な取り扱いが要求される取扱注意品である場合には、搬送物への衝撃を抑えた搬送が可能となる。
 図27は、本実施形態の更に他の変形例を説明する図である。図27は、図1に対応する図であり、走行可能な車線が2車線である点、および移動体の数が6台である点で図1と相異している。
 上述の実施例では、複数の移動体0~4が一列に並んで隊列走行する場合を例に説明したが、例えば二列に並んで隊列走行可能な経路の場合には、搬送物の情報に基づいて2つの隊列に分けて、カーブを通過させる構成としてもよい。例えば、カーブ内側には、前方を注視していない乗員を載せた複数の移動体0~3によって隊列を形成して走行させ、カーブ外側には、前方を注視している乗員や取扱注意品を載せた移動体4、5で隊列を形成して走行させてもよい。
 具体的には、隊列制御演算部1Aa(の目標経路取得部31)は、各移動体が通過する経路が複数列に並んで隊列走行可能な経路であるか否かを判断する。そして、複数列に並んで隊列走行可能な経路であると判断されると、隊列制御演算部1Aaの搬送物情報取得部34によって取得した、各移動体21の搬送物とその状態の情報に基づいて、各移動体21の経路を設定する。
 例えば、各移動体21に乗員が乗っている場合には、乗員が前方又は後方を注視している移動体21と、注視していない移動体21に分類する。また、乗員が乗っていない移動体21が含まれている場合には、注視していない移動体21に含める。そして、乗員が前方又は後方を注視している移動体21については、カーブの内側を走行させる経路を設定し、輸送効率よりも乗り心地を優先させた前後加速度制御を行う。一方、乗員が前方又は後方を注視していない移動体については、カーブの外側を走行させる経路を設定し、輸送効率と乗り心地の両方を考慮した前後加速度制御を行う。
 例えば、各移動体21に、荷物が載せられている場合には、取扱注意品であるか否かを分類する。そして、取扱注意品を載せている移動体21については、カーブの内側を走行させる経路を設定し、輸送効率よりも慎重な取り扱いを優先させた前後加速度制御を行う。一方、取扱注意品を載せていない移動体については、カーブの外側を走行させる経路を設定し、輸送効率と慎重な取り扱いの両方を考慮した前後加速度制御を行う。
 例えば、各移動体21が土砂を運搬可能なダンプトラックなどの建設機械である場合には、土砂を積載しているか否かによって各移動体21を分類する。そして、土砂を積載している移動体21については、制動距離も長くなり、重心の位置が高く、走行安定性が低くなる傾向にあるので、カーブの内側を走行させる経路を設定し、輸送効率よりも走行安定性を優先させた前後加速度制御を行う。一方、土砂を積載していない移動体21については、制動距離も短くなり、重心の位置が低く、走行安定性が高くなる傾向にあるので、カーブの外側を走行させる経路を設定し、輸送効率と走行安定性の両方を考慮した前後加速度を行う。
 上述のように、搬送物の種類や状態に応じて隊列を分けることにより、例えば前方を注視していない乗員を乗せた移動体や、荷崩れしても影響のない荷物を載せた移動体で構成される隊列には、輸送効率を優先させた前後加速度の制御を行い、前方を注視している乗員を乗せた移動体や、精密機器などのように慎重な取り扱いが要求される荷物を載せた移動体で構成される隊列には、乗り心地や安全を優先させた前後加速度の制御を行うことができる。
 本変形例によれば、一つの隊列をカーブ前に小さな隊列に分けて、隊列別に前後加速度制御を行うことで、前後加速度制御の演算量を低く抑えることができ、演算装置の低コスト化を図ることができ、また、隊列として前後に長く延びるのを防ぎ、輸送効率の向上を図ることができる。
 以上で説明したように、本実施形態では、複数台の移動体が隊列を組んで所定の離間距離を保つように走行する隊列走行において、先行移動体と後続移動体の離間距離が、後続移動体の横加速度の絶対値、もしくは後続移動体の走行経路の曲率が増加または減少する前に増加し、先行移動体および後続移動体の横加速度の絶対値、もしくは先行移動体および後続移動体の走行経路の曲率が増加または減少する区間以降で減少するよう、先行移動体または後続移動体の少なくとも一方の前後加速度を制御する。より詳しくは、隊列走行する移動体の走行情報を移動体間で送受信し、後続移動体の横加速度の絶対値、もしくは後続移動体の走行経路の曲率が増加または減少する前に、前記離間距離が増加するよう、先行移動体または後続移動体の少なくとも一方の前後加速度を制御し、先行移動体および後続移動体の横加速度の絶対値、もしくは先行移動体および後続移動体の走行経路の曲率が増加または減少する区間以降で、前記離間距離が減少するよう、先行移動体および後続移動体の前後加速度を制御する。
 換言すれば、先行移動体に追従した隊列走行実行時に、先頭移動体がカーブ路に対する減速を開始するシーンで、隊列最後尾の移動体から負の前後加速度を発生(減速)させる、もしくは、後方の移動体ほど発生する前後加速度が小さく(減速度が大きく)なるよう、各移動体の前後加速度を制御する。また、移動体に発生する横加速度の絶対値が増加、もしくは移動体走行位置での道路曲率もしくは移動体の走行経路の曲率が増加する区間に発生する前後加速度の最小値(最大減速度)は、先頭の移動体ほど小さく(最大減速度が大きく)、移動体に発生する横加速度の絶対値が減少、もしくは移動体走行位置での道路曲率もしくは移動体の走行経路の曲率が減少する区間に発生する前後加速度の最大値(最大加速度)は、後方の移動体ほど大きく(最大加速度が大きく)なるよう、各移動体の前後加速度を制御する。
 これにより、例えば直線区間を隊列走行してきた移動体群が定常旋回状態に至るまでの間に発生する前後加速度と横加速度の関係を、隊列内全ての移動体に対し好適に変化するよう制御することができ、各移動体の乗員の快適性を向上する効果が期待できる。
 以上、本発明の実施形態について詳述したが、本発明は、前記の実施形態に限定されるものではなく、特許請求の範囲に記載された本発明の精神を逸脱しない範囲で、種々の設計変更を行うことができるものである。例えば、前記した実施の形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。さらに、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。
1:移動体制御システム、1A:移動体運動制御装置、1Aa:隊列制御演算部、1Ab:走行制御演算部、21:移動体、21_n:隊列走行する移動体群の各移動体(n:正の整数)、31:目標経路取得部、32:移動体運動状態取得部、33:隊列情報取得部、34:搬送物情報取得部、35:許容値算出部、36:制御指令送信部、37:制御計画送信部、38:移動体運動制御演算部

Claims (9)

  1.  予め設定された走行経路に沿って複数の移動体を隊列走行させる移動体制御システムであって、
     先行移動体および後続移動体の走行経路における前後加速度を演算する前後加速度演算部を備え、
     該前後加速度演算部は、前記前後加速度を演算する演算式のゲインを、前記各移動体が搬送する搬送物の情報に基づいて調整することを特徴とする移動体制御システム。
  2.  前記前後加速度演算部は、前記後続移動体の搬送物が乗員であり、該乗員が前記先行移動体を注視しているときは、注視していないときよりも、前記後続移動体の走行経路の曲率が増加する区間における前記後続移動体の前後加速度を演算する演算式のゲインを大きくすることを特徴とする請求項1に記載の移動体制御システム。
  3.  前記前後加速度演算部は、前記後続移動体の搬送物が乗員であり、該乗員が前記先行移動体を注視しているときは、注視していないときよりも、前記後続移動体の走行経路の曲率が減少する区間における前記後続移動体の前後加速度を演算する演算式のゲインを小さくすることを特徴とする請求項1に記載の移動体制御システム。
  4.  前記前後加速度演算部は、前記先行移動体の搬送物が乗員であり、該乗員が前記後続移動体を注視しているときは、注視していないときよりも、前記先行移動体の走行経路の曲率が増加する区間における前記先行移動体の前後加速度を演算する演算式のゲインを大きくすることを特徴とする請求項1に記載の移動体制御システム。
  5.  前記前後加速度演算部は、前記先行移動体の搬送物が乗員であり、該乗員が前記後続移動体を注視しているときは、注視していないときよりも、前記先行移動体の走行経路の曲率が減少する区間における前記先行移動体の前後加速度を演算する演算式のゲインを小さくすることを特徴とする請求項1に記載の移動体制御システム。
  6.  前記前後加速度演算部は、前記後続移動体の搬送物が乗員であり、該乗員が前記先行移動体を注視しているときは、注視していないときよりも、前記後続移動体の走行経路の曲率が増加する区間において前記先行移動体の前後加速度との差が小さくなる前記後続移動体の前後加速度を演算することを特徴とする請求項1に記載の移動体制御システム。
  7.  前記前後加速度演算部は、前記後続移動体の搬送物が乗員であり、該乗員が前記先行移動体を注視しているときは、注視していないときよりも、前記先行移動体の走行経路の曲率が減少する区間において前記後続移動体の前後加速度との差が小さくなる前記先行移動体の前後加速度を演算することを特徴とする請求項1に記載の移動体制御システム。
  8.  前記先行移動体の横加速度の絶対値、もしくは前記先行移動体の走行経路の曲率が増加し始める時刻よりも前に前記後続移動体を減速させる制御を行い、
     前記前後加速度演算部は、前記搬送物の情報に基づいて、前記後続移動体の減速時間を調整することを特徴とする請求項1に記載の移動体制御システム。
  9.  前記前後加速度演算部は、前記後続移動体の搬送物が乗員であり、該乗員が先行移動体を注視しているときは、注視していないときよりも、前記後続移動体の減速時間を長くすることを特徴とする請求項8に記載の移動体制御システム。
PCT/JP2021/002149 2020-03-31 2021-01-22 移動体制御システム WO2021199608A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
US17/640,888 US12005898B2 (en) 2020-03-31 2021-01-22 Mobile object platoon control system that calculates longitudinal acceleration of the mobile objects by setting a gain of an arithmetic expression
EP21782308.7A EP4129790A4 (en) 2020-03-31 2021-01-22 MOBILE BODY CONTROL SYSTEM

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020-062509 2020-03-31
JP2020062509A JP7399774B2 (ja) 2020-03-31 2020-03-31 移動体制御システム

Publications (1)

Publication Number Publication Date
WO2021199608A1 true WO2021199608A1 (ja) 2021-10-07

Family

ID=77929936

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/002149 WO2021199608A1 (ja) 2020-03-31 2021-01-22 移動体制御システム

Country Status (4)

Country Link
US (1) US12005898B2 (ja)
EP (1) EP4129790A4 (ja)
JP (1) JP7399774B2 (ja)
WO (1) WO2021199608A1 (ja)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4039556B1 (en) * 2021-02-09 2024-07-17 Aptiv Technologies AG Lateral acceleration control for autonomous driving
JPWO2023100469A1 (ja) * 2021-11-30 2023-06-08
JP7494833B2 (ja) 2021-12-20 2024-06-04 株式会社ダイフク 物品搬送設備
WO2024095332A1 (ja) * 2022-10-31 2024-05-10 株式会社Subaru 運転技能評価方法、運転技能評価システム、および記録媒体

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008110620A (ja) 2006-10-27 2008-05-15 Toyota Motor Corp 車両走行制御装置
JP2008204094A (ja) 2007-02-19 2008-09-04 Toyota Motor Corp 隊列走行制御装置
JP2009262701A (ja) 2008-04-23 2009-11-12 Fuji Heavy Ind Ltd 自動制動制御装置
JP2012030674A (ja) 2010-07-30 2012-02-16 Hitachi Automotive Systems Ltd 車両運動制御装置
JP2015214288A (ja) * 2014-05-12 2015-12-03 株式会社デンソー 運転支援装置
JP2019159829A (ja) * 2018-03-13 2019-09-19 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
SE537618C2 (sv) * 2013-09-30 2015-08-04 Scania Cv Ab Metod och system för gemensam körstrategi för fordonståg
US10449962B2 (en) 2016-06-23 2019-10-22 Honda Motor Co., Ltd. System and method for vehicle control using vehicular communication
US11014494B2 (en) * 2017-08-22 2021-05-25 Sony Corporation Information processing apparatus, information processing method, and mobile body
DE102018001054A1 (de) * 2017-12-08 2019-06-13 Knorr-Bremse Systeme für Nutzfahrzeuge GmbH Verfahren zum Bewegen einer Fahrzeugkolonne auf Basis einer der Fahrzeugkolonne zugeordneten, vorgebbaren Gesamtbetriebsstrategie
WO2019130483A1 (ja) * 2017-12-27 2019-07-04 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
US20190225232A1 (en) * 2018-01-23 2019-07-25 Uber Technologies, Inc. Passenger Experience and Biometric Monitoring in an Autonomous Vehicle
EP3882883A4 (en) * 2018-11-13 2021-12-29 Sony Group Corporation Information processing device, information processing method, and program
JP7190345B2 (ja) 2018-12-19 2022-12-15 株式会社日立製作所 車両運動制御装置及びその方法
CN110539799B (zh) * 2019-10-09 2021-07-23 吉林大学 一种基于驾驶员状态的分层架构人机共驾系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008110620A (ja) 2006-10-27 2008-05-15 Toyota Motor Corp 車両走行制御装置
JP2008204094A (ja) 2007-02-19 2008-09-04 Toyota Motor Corp 隊列走行制御装置
JP2009262701A (ja) 2008-04-23 2009-11-12 Fuji Heavy Ind Ltd 自動制動制御装置
JP2012030674A (ja) 2010-07-30 2012-02-16 Hitachi Automotive Systems Ltd 車両運動制御装置
JP2015214288A (ja) * 2014-05-12 2015-12-03 株式会社デンソー 運転支援装置
JP2019159829A (ja) * 2018-03-13 2019-09-19 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
M. YAMAKADOJ. TAKAHASHIS. SAITOA. YOKOYAMAM. ABE: "Improvement in vehicle agility and stability by G-Vectoring control", VEH. SYST. DYN., vol. 48, 2010, pages 231 - 254
See also references of EP4129790A4
TAKAHASHI, J ET AL.: "Evaluation of Preview G-Vectoring Control to decelerate a vehicle prior to entry into a curve", INTERNATIONAL JOURNAL OF AUTOMOTIVE TECHNOLOGY, vol. 14, no. 6, 2013, pages 921 - 926

Also Published As

Publication number Publication date
US12005898B2 (en) 2024-06-11
EP4129790A4 (en) 2024-04-10
JP7399774B2 (ja) 2023-12-18
EP4129790A1 (en) 2023-02-08
JP2021160458A (ja) 2021-10-11
US20220332318A1 (en) 2022-10-20

Similar Documents

Publication Publication Date Title
WO2021199608A1 (ja) 移動体制御システム
WO2023139867A1 (ja) 車両運動制御装置、および、車両運動制御方法
US20190171232A1 (en) Methods and systems for semi-autonomous vehicular convoys
JP7190345B2 (ja) 車両運動制御装置及びその方法
JP5780996B2 (ja) 車両走行制御装置
WO2017094904A1 (ja) 走行軌跡生成装置、走行軌跡生成方法
US10787162B2 (en) Driving force control apparatus
JP2009061878A (ja) 走行制御装置
JP2019034591A (ja) 車両運動制御装置及びその方法、並びに、目標軌道生成装置及びその方法
US12077184B2 (en) Vehicle control system
US20230331056A1 (en) Vehicle active suspension control system and method
CN112455441A (zh) 由自主车辆执行车道改变的方法和系统
US20230271469A1 (en) Vehicle active suspension control system and method
US11332139B2 (en) System and method of controlling operation of autonomous vehicle
CN111316338A (zh) 用于操纵集群中的交通工具的方法
JP6838218B2 (ja) 車両運動制御装置
CN113496608B (zh) 车辆的运行管理装置、运行管理方法以及交通系统
JP7091290B2 (ja) 車両制御装置、車両制御方法、およびプログラム
WO2023145170A1 (ja) 車両統合制御装置、車両統合制御方法
WO2023238588A1 (ja) 車両運動制御装置、および、車両運動制御方法
WO2023037758A1 (ja) 車両制御装置、車両制御方法、及び車両制御システム
WO2023175917A1 (ja) 運転支援装置、運転支援方法、およびプログラム
CN113727900A (zh) 车辆的行驶控制装置
JP2023137956A (ja) 運転支援装置、運転支援方法、およびプログラム
WO2022018153A1 (en) Vehicle active suspension control system and method

Legal Events

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

Ref document number: 21782308

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2021782308

Country of ref document: EP

Effective date: 20221031