WO2022019240A1 - 移動制御システム、移動制御方法、プログラム、及び、移動体 - Google Patents

移動制御システム、移動制御方法、プログラム、及び、移動体 Download PDF

Info

Publication number
WO2022019240A1
WO2022019240A1 PCT/JP2021/026857 JP2021026857W WO2022019240A1 WO 2022019240 A1 WO2022019240 A1 WO 2022019240A1 JP 2021026857 W JP2021026857 W JP 2021026857W WO 2022019240 A1 WO2022019240 A1 WO 2022019240A1
Authority
WO
WIPO (PCT)
Prior art keywords
information
moving body
outside world
control system
control
Prior art date
Application number
PCT/JP2021/026857
Other languages
English (en)
French (fr)
Inventor
猛 植村
Original Assignee
パナソニックIpマネジメント株式会社
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 パナソニックIpマネジメント株式会社 filed Critical パナソニックIpマネジメント株式会社
Priority to CN202180046218.9A priority Critical patent/CN115734906A/zh
Priority to JP2022537981A priority patent/JPWO2022019240A1/ja
Priority to US18/004,812 priority patent/US11866040B2/en
Priority to EP21847067.2A priority patent/EP4186766A4/en
Publication of WO2022019240A1 publication Critical patent/WO2022019240A1/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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/04Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
    • B60W10/08Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of electric propulsion units, e.g. motors or generators
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0015Planning or execution of driving tasks specially adapted for safety
    • 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/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0004In digital systems, e.g. discrete-time systems involving sampling
    • B60W2050/0006Digital architecture hierarchy
    • 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
    • B60W2400/00Indexing codes relating to detected, measured or calculated conditions or factors
    • 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/90Single sensor for two or more measurements
    • B60W2420/905Single sensor for two or more measurements the sensor being an xyz axis sensor
    • 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/10Longitudinal speed
    • 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/10Longitudinal speed
    • B60W2520/105Longitudinal acceleration
    • 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/12Lateral speed
    • B60W2520/125Lateral acceleration
    • 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/14Yaw
    • 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/80Spatial relation or speed relative to objects
    • 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
    • B60W2756/00Output or target parameters relating to data
    • B60W2756/10Involving external transmission of data to or from the vehicle

Definitions

  • the present disclosure relates to a movement control system, a movement control method, a program, and a moving body that moves autonomously.
  • Patent Document 1 discloses a vehicle control device (movement control system) that operates a vehicle.
  • the vehicle control device of Patent Document 1 includes an outside world recognition unit, a vehicle position recognition unit, an action planning unit, and a vehicle control unit.
  • the outside world recognition unit recognizes the surrounding conditions and objects of the own vehicle.
  • the own vehicle position recognition unit recognizes the position of the own vehicle and the map information around the position.
  • the action planning department determines the driving situation of the own vehicle based on the recognition results of the external world recognition unit and the own vehicle position recognition unit and the detection result of the vehicle sensor, and formulates (sets) various actions of the own vehicle. ..
  • the vehicle control unit calculates a control command value for the output device group based on the decision result (setting result) of the action planning unit.
  • An object of the present invention is to provide a movement control system, a movement control method, a program, and a moving body capable of improving the stability of autonomous movement.
  • the movement control system of one aspect of the present disclosure is a movement control system of a moving body moved by a driving system, and a control plan of the driving system is based on reference information including a first outside world information regarding the outside world of the moving body.
  • the second external world information related to the outside world of the moving body and different from the first external world information is obtained.
  • a correction unit that executes a correction process of the control plan based on the control plan, and a control unit that controls the drive system based on the control plan are provided.
  • the movement control method of one aspect of the present disclosure includes a planning step of executing an update process for updating a control plan of the drive system based on reference information including a first outside world information regarding the outside world of a moving body moved by the drive system.
  • the control plan modification process is executed based on the second outside world information related to the outside world of the moving body and different from the first outside world information. It includes a modification step and a control step that controls the drive system based on the control plan.
  • the program of one aspect of the present disclosure is a program for causing one or more processors to execute the movement control method.
  • the mobile body of one aspect of the present disclosure includes the movement control system and the drive system.
  • FIG. 1 is a block diagram of a mobile body including the movement control system of one embodiment.
  • FIG. 2 is a sequence diagram of the operation of the movement control system.
  • FIG. 3 is an explanatory diagram of the operation of the movement control system.
  • FIG. 1 shows a mobile body 100 including the mobile control system 10 of the embodiment.
  • the moving body 100 is an automobile (see FIG. 3).
  • the mobile body 100 is an electric vehicle.
  • the movement control system 10 is used for autonomous movement of the moving body 100.
  • autonomous movement is also called automatic driving. That is, the movement control system 10 is used to move the moving body 100 regardless of human operation.
  • the movement control system 10 includes a planning unit 432 and a correction unit 433.
  • the planning unit 432 executes an update process for updating the control plan of the drive system 30 based on the reference information including the first outside world information regarding the outside world of the moving body 100 moved by the drive system 30 at predetermined intervals.
  • the correction unit 433 executes the correction processing of the control plan based on the second outside world information which is different from the first outside world information and is related to the outside world of the moving body 100 at the timing between the plurality of update processes. In other words, in the second timing between the plurality of first timings in which the update process is executed, the correction unit 433 relates to the outside world of the moving body 100 and is based on the second outside world information different from the first outside world information. Execute the correction process.
  • the outside world in the present disclosure means the world around the mobile body 100.
  • the distance detection unit 22 detects the image information about the outside world of the moving body 100 by the outside world image detection unit 21, or the distance information of the moving body 100 from the surrounding objects in the outside world. Contains at least one of the information.
  • the second outside world information is information related to the outside world of the moving body 100 and the inertial force information which is the information of the inertial force acting on the moving body 100 from the outside world is detected by the inertial force detecting unit 26.
  • the second external world information is not limited to the inertial force information, and may include the inertial force information.
  • the planning unit 432 updates the control plan of the drive system 30 of the moving body 100 based on the reference information including the first outside world information, thereby enabling the autonomous movement of the moving body 100. ..
  • the mobile control system 10 includes a correction unit 433, and the correction unit 433 updates the control plan at the interval of the update process (that is, after the update process, the next update process, based on the second external world information.
  • Before correction, thereby attempting to correct the autonomous movement of the moving body 100.
  • the control plan is modified by the correction unit 433 to move the event to the autonomous movement. The impact can be reduced. Therefore, it is possible to make the mobile body 100 perform autonomous movement as planned. Therefore, according to the movement control system 10 of the present embodiment, the stability of autonomous movement can be improved.
  • the movement control system 10 is provided in the moving body 100 having the drive system 30.
  • the drive system 30 is a system for moving the moving body 100.
  • the moving body 100 is an electric vehicle, and the drive system 30 includes a power source (motor), drive wheels, a drive train (drive system component), and the like.
  • the mobile body 100 moves on land by the drive system 30.
  • the movement control system 10 includes a detection system 20 and a control system 40.
  • the detection system 20 is a system for detecting information about the mobile body 100.
  • the detection system 20 includes an external image detection unit 21, a distance detection unit 22, a position detection unit 23, an internal state detection unit 24, a map information detection unit 25, and an inertial force detection unit 26.
  • the outside world image detection unit 21 detects image information related to the outside world of the moving body 100.
  • the image information includes information on one or more images (outside world images) relating to the outside world of the moving body 100.
  • the image information includes an image of the front view from the moving body 100, an image of the rear view from the moving body 100, an image of the right view from the moving body 100, and an image of the left view from the moving body 100.
  • the external image detection unit 21 includes a plurality of image sensors, and detects image information by the plurality of image sensors. From this image information, the detection system 20 can detect the presence or absence of an object around the moving body 100 and the distance to the object.
  • the distance detection unit 22 detects distance information to an object around the moving body 100.
  • the object is assumed to be an obstacle that hinders the movement of the moving body 100. That is, the obstacle is an object to be avoided by the moving body 100 when the moving body 100 moves.
  • obstacles include another mobile body 300, as shown in FIG.
  • Other examples of obstacles include people and fixed objects (guardrails, falling objects, etc.).
  • the distance information includes the distance to the object in front of the moving body 100, the distance to the object behind the moving body 100, the distance to the object on the right side of the moving body 100, and the distance to the object on the left side of the moving body 100. including.
  • the distance detection unit 22 includes a plurality of distance sensors, and detects distance information by the plurality of distance sensors. Examples of distance sensors include ultrasonic sensors, radars (RADAR), and lidars (LIDAR). The distance information may also include information on the relative velocity to the object.
  • the position detection unit 23 detects the location information of the moving body 100.
  • the location information includes information on the current location of the mobile body 100.
  • the position detection unit 23 acquires location information by the satellite positioning system.
  • An example of a satellite positioning system is the Global Positioning System (GPS).
  • the internal state detection unit 24 detects internal information regarding the internal state of the moving body 100.
  • the internal information includes a plurality of parameters indicating the internal state of the moving body 100.
  • the internal state includes the operating state (control state) of the drive system 30.
  • the operating state (control state) of the drive system 30 is the steering angle, accelerator amount, brake amount, speed, state of power source (engine or motor), transmission speed, control circuit (ECU, etc.) of the drive system 30.
  • the state, the state of the control current in the drive system 30, includes.
  • the internal state detection unit 24 includes a sensor and a monitor for detecting the internal state.
  • the internal state detection unit 24 includes a steering angle sensor, an accelerator sensor, a brake sensor, a speedometer, a rotation sensor of an internal combustion engine or an electric motor, a rotation speed sensor of a transmission, a control circuit monitor, a control current monitor, and the like. ..
  • the map information detection unit 25 detects map information related to the moving body 100.
  • the map information includes information about a map in a predetermined range including the periphery of the moving body 100.
  • the map information detection unit 25 extracts a map of a predetermined range including the periphery of the moving body 100 from the map of the predetermined area based on the location information of the position detection unit 23, and obtains the map information.
  • the map information may be prepared in advance, or may be prepared by using landmark information or SLAM (Simultaneous Localization and Mapping) technology.
  • the inertial force detection unit 26 detects inertial force information regarding the moving body 100.
  • the inertial force information is information about the inertial force acting on the moving body 100.
  • Inertial force is represented by acceleration in a translational acceleration system and by angular velocity in a rotating coordinate system.
  • the detection of inertial force means the detection of at least one of acceleration and angular velocity.
  • the inertial force detection unit 26 includes a plurality of inertial force sensors.
  • the inertial force sensor is a sensor that detects at least one of acceleration and angular velocity. In the present embodiment, the inertial force detection unit 26 detects the inertial force of three orthogonal axes.
  • the three orthogonal axes are the front-back axis, the left-right axis, and the up-down axis of the moving body 100.
  • the inertial force information includes the above-mentioned three-axis angular velocity and acceleration.
  • the control system 40 includes an input / output interface 41, a storage unit 42, and a processing unit 43.
  • the input / output interface 41 is an interface for inputting information to the control system 40 and outputting information from the control system 40. That is, the input / output interface 41 also serves as an input unit for inputting information to the control system 40 and an output unit for outputting information from the control system 40.
  • the information to the control system 40 includes the information input from the detection system 20 to the control system 40.
  • the information from the control system 40 includes information output from the control system 40 to the drive system 30.
  • the input / output interface 41 may include an input device for operating the control system 40.
  • the input device has, for example, a touch pad and / or one or more buttons.
  • the input / output interface 41 may include an image display device for displaying information.
  • the image display device is a thin display device such as a liquid crystal display or an organic EL display.
  • a touch panel may be configured by the touch pad of the input / output interface 41 and the image display device.
  • the input / output interface 41 may be provided with a communication interface, and may be capable of inputting information to the control system 40 and outputting information from the control system 40 by wired communication or wireless communication.
  • the communication protocol for wired or wireless communication may be selected from a variety of well-known wired and wireless communication standards.
  • the storage unit 42 is used to store information used by the processing unit 43.
  • the storage unit 42 includes one or more storage devices.
  • the storage device is, for example, a RAM (RandomAccessMemory) or an EEPROM (ElectricallyErasableProgrammableReadOnlyMemory).
  • the processing unit 43 is a control circuit that controls the operation of the control system 40.
  • the processing unit 43 can be realized by, for example, a computer system including one or more processors (microprocessors) and one or more memories.
  • the processing unit 43 includes an acquisition unit 431, a planning unit 432, a correction unit 433, and a control unit 434. In FIG. 1, the acquisition unit 431, the planning unit 432, the correction unit 433, and the control unit 434 do not show a substantive configuration, but show a function realized by the processing unit 43.
  • the acquisition unit 431 acquires information from the detection system 20. More specifically, the information acquired by the acquisition unit 431 from the detection system 20 includes image information from the external image detection unit 21, distance information from the distance detection unit 22, location information from the position detection unit 23, and internal state detection unit. It includes internal information from 24, map information from the map information detection unit 25, and inertial force information from the inertial force detection unit 26.
  • the acquisition unit 431 does not acquire image information, distance information, location information, internal information, map information, and inertial force information all at once, but acquires them individually at necessary timings.
  • an image sensor is used as the external image detection unit 21 to obtain image information
  • a distance sensor is used as the distance detection unit 22 to obtain distance information
  • inertial force detection is used to obtain inertial force information.
  • An inertial force sensor is used as the portion 26.
  • Inertial force sensors generally have a shorter information update cycle than image sensors and distance sensors. That is, the inertial force sensor has a higher information update frequency (number of outputs per unit time) than the image sensor and the distance sensor. For example, the update frequency of the image sensor and the distance sensor is 30 to 60, while the update frequency of the inertial force sensor exceeds 100.
  • the acquisition unit 431 acquires inertial force information at a higher frequency than image information and distance information.
  • the acquisition unit 431 may acquire location information, internal information, and map information at any time. For example, the acquisition unit 431 may acquire location information, internal information, and map information in response to a request from the planning unit 432 or the correction unit 433.
  • the planning unit 432 periodically executes the update process.
  • the planning unit 432 executes the update process at predetermined time intervals.
  • the predetermined time may coincide with the update cycle of the first external world information.
  • the update process is a process of updating the control plan of the drive system 30 based on the reference information.
  • "update of control plan” includes not only update of control plan but also new creation of control plan.
  • the control plan is information that defines the movement of the moving body 100 by the drive system 30.
  • the control plan includes a target value (target traveling track) of the traveling track of the moving body 100 and a target value (target speed) of the speed of the moving body 100.
  • the speed of the moving body 100 may include the speeds of the three axes of the front-rear direction, the left-right direction, and the up-down direction.
  • the reference information includes the first outside world information.
  • the first outside world information is information about the outside world of the moving body 100 moved by the drive system 30.
  • the first outside world information includes image information of the outside world of the moving body 100 and distance information to an object around the moving body 100.
  • the planning unit 432 updates the control plan of the drive system 30 by using the location information, the internal information, and the map information as necessary in addition to the first external world information (image information and distance information).
  • the correction unit 433 executes the correction process of the control plan based on the second outside world information which is different from the first outside world information and which is related to the outside world of the moving body 100.
  • the correction unit 433 executes the correction process during the plurality of update processes and at the timing when the update process is not performed.
  • the timing here is a period between the update process and the next update process, and is a period during which the update process is not performed. That is, the correction unit 433 has an opportunity to perform the correction process at least once from the end of the update process to the start of the next update process.
  • the second outside world information includes inertial force information regarding the inertial force acting on the moving body 100 from the outside world.
  • the inertial force information is acquired by the acquisition unit 431 more frequently than the image information and the distance information. Therefore, the correction unit 433 can execute the correction process at the interval of the update process. Therefore, it is desirable that the cycle of the correction process is shorter than the cycle of the update process.
  • the correction unit 433 obtains a predicted value of the moving state of the moving body 100 at a predetermined time based on the second outside world information.
  • the predicted value of the moving state of the moving body 100 at the predetermined time is the predicted value of the traveling track of the moving body 100 (predicted traveling track) and the predicted value of the speed of the moving body 100 (speed of three axes) at the predetermined time. (Predicted speed) and included.
  • the moving body 100B corresponds to a predicted value (predicted traveling track and predicted speed) of the moving state of the moving body 100 at a predetermined time.
  • the second external world information includes inertial force information
  • the correction unit 433 changes the movement of the moving body 100 (change in the posture of the moving body 100) from the inertial force acting on the moving body 100 obtained from the inertial force information. ) Can be obtained.
  • the correction unit 433 obtains a predicted value of the moving state of the moving body 100 at a predetermined time by using the location information, the internal information, and the map information as necessary.
  • the correction unit 433 executes the correction process based on the predicted value of the moving state of the moving body 100 at a predetermined time obtained from the second outside world information.
  • the correction unit 433 executes the correction process based on the difference between the predicted value and the target value of the moving state of the moving body 100 at a predetermined time.
  • the target value of the moving state of the moving body 100 at a predetermined time is the target value of the traveling track of the moving body 100 (target traveling track) and the target value of the speed of the moving body 100 (speed of three axes) at the predetermined time. (Target speed) and included.
  • the moving body 100A corresponds to a target value (target traveling track and target speed) of the moving state of the moving body 100 at a predetermined time.
  • the correction unit 433 corrects the control plan so that the difference becomes zero.
  • the correction unit 433 corrects the control plan so that the predicted running track at the predetermined time and the target running track match, and the predicted speed and the target speed at the predetermined time match. do.
  • the control plan is modified so that the moving body 100 is in the moving state shown by the moving body 100A instead of the moving state shown by the moving body 100B at a predetermined time.
  • Location information, inside information, and map information are used as necessary in modifying the control plan.
  • the correction unit 433 attempts to correct the autonomous movement of the moving body 100. For example, even if an unintended event (for example, a change in the road surface condition) affects the autonomous movement of the moving body 100 at the interval of the update process, the modification of the control plan by the correction unit 433 causes the autonomy of the unintended event. It is possible to reduce the influence on movement.
  • the unintended event may be an event that is not considered in the control plan update process. Examples of unintended events may include changes in the surrounding environment of the moving body 100 such as road surface conditions and wind speed, and accidents (slip, tire puncture, etc.) of the moving body 100.
  • the correction unit 433 does not execute the correction process while the speed of the moving body 100 is equal to or less than the threshold value.
  • the threshold value is not particularly limited, but for example, in the case of an electric vehicle, the speed may be a speed corresponding to driving. That is, when the speed of the moving body 100 is slow, even if the movement of the moving body 100 is affected by the occurrence of some event, there is a high possibility that the update process can deal with it. This makes it possible to reduce the processing load of autonomous movement.
  • the correction unit 433 executes the correction process at the second timing between the plurality of first timings at which the update process is executed.
  • the control unit 434 controls the drive system 30 based on the control plan.
  • the control plan may be a control plan by the update process of the planning unit 432 and a control plan by the correction process of the correction unit 433. Therefore, when the update process is executed by the planning unit 432, the control unit 434 controls the drive system 30 based on the updated control plan.
  • the control unit 434 controls the drive system 30 based on the modified control plan until the update process is executed by the planning unit 432. That is, when the control plan is modified by the modification unit 433, the control unit 434 controls the drive system 30 based on the modified control plan.
  • control unit 434 generates a control instruction according to the target travel track and the target vehicle speed included in the control plan or the modified control plan, and outputs the control instruction to the drive system 30.
  • the control instruction includes an instruction value relating to an operating state (control state) of the drive system 30.
  • the control instructions include steering angle, accelerator amount, brake amount, speed, state of power source (engine or motor), transmission speed, control circuit of drive system 30 (ECU, etc.), control in drive system 30. It may include indications for current.
  • the detection system 20 gives the control system 40 first external world information (image information and distance information).
  • the control system 40 executes an update process to update the control plan.
  • the updated control plan is given from the control system 40 to the drive system 30, and the drive system 30 moves the moving body 100 according to the control plan. That is, the drive system 30 controls the moving body 100 according to the control plan.
  • the detection system 20 transfers the second external world information to the control system 40 before the next external world information is given to the control system 40. give.
  • the control system 40 executes a correction process to correct the control plan.
  • the modified control plan (“modified control plan” in FIG. 2) is given from the control system 40 to the drive system 30, and the drive system 30 moves the moving body 100 according to the modified control plan. That is, the drive system 30 controls the moving body 100 according to the modified control plan.
  • the detection system 20 further gives the second outside world information to the control system 40.
  • the control system 40 executes a correction process to correct the control plan.
  • the control system 40 modifies the previously modified control plan (correction control plan).
  • the modified control plan is given from the control system 40 to the drive system 30, and the drive system 30 moves the moving body 100 according to the modified control plan.
  • the first outside world information is given to the control system 40 from the detection system 20.
  • the control system 40 acquires the first outside world information
  • the control system 40 executes an update process to update the control plan.
  • the updated control plan is given from the control system 40 to the drive system 30, and the drive system 30 moves the moving body 100 according to the control plan.
  • the movement control system 10 executes a planning step for periodically executing the update process and a modification step for executing the modification process at the interval of the update process to realize stable autonomous movement of the moving body 100. do.
  • the movement control system 10 is a movement control system for the moving body 100 moved by the drive system 30, and includes a planning unit 432, a correction unit 433, and a control unit 434.
  • the planning unit 432 executes an update process for updating the control plan of the drive system 30 based on the reference information including the first outside world information regarding the outside world of the mobile body 100.
  • the correction unit 433 executes the correction processing of the control plan based on the second outside world information which is different from the first outside world information and is related to the outside world of the moving body 100 at the timing between the update processes.
  • the control unit 434 controls the drive system 30 based on the control plan. According to the movement control system 10 of the present embodiment, the stability of autonomous movement can be improved.
  • the movement control system 10 executes the following method (movement control method).
  • the movement control method includes a planning step, a modification step, and a control step.
  • the planning step is a step of periodically executing an update process for updating the control plan of the drive system 30 based on the reference information including the first outside world information about the outside world of the moving body 100 moved by the drive system 30.
  • the correction step is a step of executing the correction process of the control plan based on the second outside world information regarding the outside world of the moving body 100 but different from the first outside world information at the interval of the update process.
  • the control step is a step of controlling the drive system 30 based on the control plan. Therefore, according to the movement control method of the present embodiment, the stability of autonomous movement can be improved as in the movement control system 10.
  • the mobile control system 10 is realized by using a computer system. That is, the method executed by the movement control system 10 (movement control method) can be realized by the computer system executing the program.
  • This program is a computer program for causing one or more processors to execute a movement control method. According to such a program, the stability of autonomous movement can be improved as in the movement control system 10.
  • the moving body 100 is not limited to an automobile.
  • the moving body 100 may be an object having a function of moving in a space such as land (on snow), water, underwater, air, and space.
  • the mobile body 100 does not have to be a vehicle and includes an unmanned aerial vehicle.
  • examples of the mobile body 100 include vehicles, ships, aircraft, spacecraft, and playsets.
  • Vehicles include automobiles, motorcycles, tricycles, railroad vehicles, and the like.
  • Automobiles include gasoline-powered vehicles, electric vehicles, hybrid vehicles, plug-in hybrid vehicles, and the like.
  • Aircraft include passenger planes, drones, etc.
  • the movement control system 10 includes the detection system 20, but the detection system 20 does not necessarily have to be included in the movement control system 10, and is provided as an external system to the movement control system 10. May be good.
  • the detection system 20 does not necessarily have to include the position detection unit 23, the internal state detection unit 24, and the map information detection unit 25.
  • the detection system 20 may include at least one of the external image detection unit 21 and the distance detection unit 22, and the inertial force detection unit 26.
  • the processing unit 43 may have at least a planning unit 432 and a correction unit 433.
  • the acquisition unit 431 and the control unit 434 are not essential.
  • the interval at which the planning unit 432 executes the update process does not necessarily have to be constant, and may be executed at the timing when the first external world information is obtained.
  • the cycle of the correction process may be the same as the cycle of the update process.
  • the cycle of the correction process may be defined so that the correction process is executed at the interval of the update process.
  • the correction process does not necessarily have to use the predicted value, and the correction value of the control plan may be determined directly from the second external world information. That is, the correction process may be a process of appropriately changing the control plan so that the moving body 100 moves according to the original control plan.
  • the first outside world information may include at least one of the image information of the outside world of the moving body 100 and the distance information to the object around the moving body 100.
  • the reference information may include at least the first external world information, and does not necessarily have to include location information, internal information, and map information.
  • the reference information may include information related to the second external world information. That is, the second outside world information may be reflected in the control plan by the planning unit 432.
  • the information related to the second outside world information may be the second outside world information itself or the above-mentioned difference information.
  • the second external world information may include information different from the inertial force information.
  • the second outside world information relates to the outside world of the mobile body 100, it is preferable that the information is different from the first outside world information. Further, it is preferable that the second outside world information has a shorter update cycle than the first outside world information.
  • the second external world information may include information that may affect the movement of the moving body 100, such as the speed of the moving body 100, the change in the direction of the tire, the change in the wind speed, and the change in the road surface.
  • the correction unit 433 may execute the correction process regardless of the speed of the moving body 100.
  • the mobile control system 10 (control system 40) in the present disclosure includes, for example, a computer system.
  • the computer system mainly consists of a processor and a memory as hardware.
  • the processor executes the program recorded in the memory of the computer system, the function as the mobile control system 10 (control system 40) in the present disclosure is realized.
  • the program may be pre-recorded in the memory of the computer system, may be provided through a telecommunications line, and may be recorded on a non-temporary recording medium such as a memory card, optical disk, hard disk drive, etc. that can be read by the computer system. May be provided.
  • the processor of a computer system is composed of one or more electronic circuits including a semiconductor integrated circuit (IC) or a large scale integrated circuit (LSI).
  • the integrated circuit such as IC or LSI referred to here has a different name depending on the degree of integration, and includes an integrated circuit called a system LSI, VLSI (Very Large Scale Integration), or ULSI (Ultra Large Scale Integration).
  • an FPGA Field-Programmable Gate Array
  • a plurality of electronic circuits may be integrated on one chip, or may be distributed on a plurality of chips.
  • a plurality of chips may be integrated in one device, or may be distributed in a plurality of devices.
  • the computer system referred to here includes a microcontroller having one or more processors and one or more memories. Therefore, the microprocessor is also composed of one or a plurality of electronic circuits including a semiconductor integrated circuit or a large-scale integrated circuit.
  • control system 40 it is not an essential configuration for the mobile control system 10 (control system 40) that a plurality of functions in the mobile control system 10 (control system 40) are integrated in one housing, but the mobile control system 10 (control).
  • the components of the system 40) may be distributed in a plurality of housings.
  • at least a part of the functions of the mobile control system 10 (control system 40), for example, a part of the functions of the processing unit 43 may be realized by a cloud (cloud computing) or the like.
  • the first aspect is a movement control system (10) of a moving body (100) that is moved by a drive system (30), and includes a planning unit (432), a correction unit (433), and a control unit (434). , Equipped with.
  • the planning unit (432) executes an update process for updating the control plan of the drive system (30) based on the reference information including the first outside world information regarding the outside world of the moving body (100).
  • the correction unit (433) relates to the outside world of the moving body (100) and obtains second outside world information different from the first outside world information. Based on this, the correction process of the control plan is executed.
  • the control unit (434) controls the drive system (30) based on the control plan. According to this aspect, the stability of autonomous movement can be improved.
  • the second aspect is the movement control system (10) based on the first aspect.
  • the first outside world information is information including at least one of image information about the outside world of the moving body (100) and distance information with an object around the moving body (100).
  • the second outside world information is information including inertial force information acting on the moving body (100) from the outside world of the moving body (100). According to this aspect, the accuracy of the modification of the control plan can be improved.
  • the third aspect is the movement control system (10) based on the first or second aspect.
  • the control unit (434) controls after the modification until the modification process is executed by the modification unit (433) and the update process is executed by the planning unit (432).
  • the drive system (30) is controlled based on the plan. According to this aspect, the stability of autonomous movement can be improved.
  • the fourth aspect is a movement control system (10) based on any one of the first to third aspects.
  • the correction unit (433) has a predicted value of the moving state of the moving body (100) at a predetermined time obtained from the second external world information and the moving body (100) at the predetermined time. ) Is executed based on the difference from the target value of the moving state. According to this aspect, the accuracy of the modification of the control plan can be improved.
  • the fifth aspect is the movement control system (10) based on the fourth aspect.
  • the reference information includes the difference information. According to this aspect, the accuracy of the control plan can be improved.
  • the sixth aspect is a movement control system (10) based on any one of the first to fifth aspects.
  • the reference information includes the second outside world information. According to this aspect, the accuracy of the control plan can be improved.
  • the seventh aspect is a movement control system (10) based on any one of the first to sixth aspects.
  • the cycle of the correction process is shorter than the cycle of the update process. According to this aspect, the frequency of modification of the control plan can be improved.
  • the eighth aspect is the movement control system (10) based on any one of the first to seventh aspects.
  • the update cycle of the second external world information is shorter than the update cycle of the first external world information. According to this aspect, the frequency of modification of the control plan can be improved.
  • the ninth aspect is a movement control system (10) based on any one of the first to eighth aspects.
  • the correction unit (433) does not execute the correction process while the speed of the moving body (100) is equal to or less than the threshold value. According to this aspect, it is possible to reduce the processing load of autonomous movement.
  • the tenth aspect is a movement control method, which includes a planning step, a correction step, and a control step.
  • the planning step is a step of executing an update process for updating the control plan of the drive system (30) based on the reference information including the first outside world information regarding the outside world of the moving body (100) moved by the drive system (30).
  • the modification step is based on the second outside world information which is different from the first outside world information and is related to the outside world of the moving body (100) at the second timing between the plurality of first timings in which the update process is executed. It is a step to execute the correction process of the control plan.
  • the control step is a step of controlling the drive system (30) based on the control plan. According to this aspect, the stability of autonomous movement can be improved.
  • the eleventh aspect is a program (computer program), which is a program for causing one or more processors to execute the movement control method of the tenth aspect. According to this aspect, the stability of autonomous movement can be improved.
  • the twelfth aspect is a mobile body (100), which includes a movement control system (10) according to any one of the first to ninth aspects and the drive system (30). According to this aspect, the stability of autonomous movement can be improved.
  • the second to ninth aspects can be appropriately modified and applied to the tenth aspect.

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本発明の課題は、自律移動の安定性の向上が図れる、移動制御システム、移動制御方法、プログラム、及び、移動体を提供することである。移動制御システム(10)は、駆動システム(30)によって移動する移動体(100)の移動制御システムである。移動制御システム(10)は、計画部(432)と、修正部(433)と、制御部(434)と、を備える。計画部(432)は、移動体(100)の外界に関する第1外界情報を含む参照情報に基づいて駆動システム(30)の制御計画を更新する更新処理を実行する。修正部(433)は、更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、移動体(100)の外界に関するとともに第1外界情報とは異なる第2外界情報に基づいて制御計画の修正処理を実行する。制御部(434)は、制御計画に基づいて駆動システム(30)を制御する。

Description

移動制御システム、移動制御方法、プログラム、及び、移動体
 本開示は、移動制御システム、移動制御方法、プログラム、及び、自律移動する移動体に関する。
 特許文献1は、車両の運転操作を行う車両制御装置(移動制御システム)を開示する。特許文献1の車両制御装置は、外界認識部と、自車位置認識部と、行動計画部と、車両制御部とを備える。外界認識部は、自車両の周囲の状況および物体を認識する。自車位置認識部は、自車両の位置およびその位置周辺の地図情報を認識する。行動計画部は、外界認識部および自車位置認識部の認識結果と、車両センサの検出結果と、に基づいて、自車両の走行状況を判断し、自車両の各種行動を策定(設定)する。車両制御部は、行動計画部の決定結果(設定結果)に基づいて出力装置群に対する制御指令値を算出する。
 特許文献1の車両制御装置では、行動計画部での行動の設定後に何らかのイベントによって車両の走行に影響が生じた場合には、次に行動計画部が行動の設定をするまでは当該影響への対処を行えない。これは、車両の自動運転(移動体の自律移動)の安定性の低下の一因になり得る。
 すなわち、従来の移動体では、自律移動が安定しないという課題がある。
特開2019-73039号公報
 本発明の課題は、自律移動の安定性の向上が図れる、移動制御システム、移動制御方法、プログラム、及び、移動体を提供することである。
 本開示の一態様の移動制御システムは、駆動システムによって移動する移動体の移動制御システムであって、前記移動体の外界に関する第1外界情報を含む参照情報に基づいて前記駆動システムの制御計画を更新する更新処理を実行する計画部と、前記更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、前記移動体の外界に関するとともに前記第1外界情報とは異なる第2外界情報に基づいて前記制御計画の修正処理を実行する修正部と、前記制御計画に基づいて前記駆動システムを制御する制御部と、を備える。
 本開示の一態様の移動制御方法は、駆動システムによって移動する移動体の外界に関する第1外界情報を含む参照情報に基づいて前記駆動システムの制御計画を更新する更新処理を実行する計画ステップと、前記更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、前記移動体の外界に関するとともに前記第1外界情報とは異なる第2外界情報に基づいて前記制御計画の修正処理を実行する修正ステップと、前記制御計画に基づいて前記駆動システムを制御する制御ステップと、を含む。
 本開示の一態様のプログラムは、1以上のプロセッサに、前記移動制御方法を実行させるための、プログラムである。
 本開示の一態様の移動体は、前記移動制御システムと、前記駆動システムと、を備える。
図1は、一実施形態の移動制御システムを含む移動体のブロック図である。 図2は、上記移動制御システムの動作のシーケンス図である。 図3は、上記移動制御システムの動作の説明図である。
 (1)実施形態
 (1-1)概要
 図1は、一実施形態の移動制御システム10を備える移動体100を示す。本実施形態では、移動体100は、自動車である(図3参照)。特に、移動体100は、電気自動車である。移動制御システム10は、移動体100の自律移動のために用いられる。移動体100が自動車である場合、自律移動は自動運転ともいわれる。つまり、移動制御システム10は、人の操作によらず、移動体100を移動させるために用いられる。
 移動制御システム10は、計画部432と、修正部433と、を備える。計画部432は、駆動システム30によって移動する移動体100の外界に関する第1外界情報を含む参照情報に基づいて駆動システム30の制御計画を更新する更新処理を所定の間隔で実行する。修正部433は、複数の更新処理間のタイミングにおいて、移動体100の外界に関するとともに第1外界情報とは異なる第2外界情報に基づいて制御計画の修正処理を実行する。言い換えると、修正部433は、更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、移動体100の外界に関するとともに第1外界情報とは異なる第2外界情報に基づいて制御計画の修正処理を実行する。本開示での外界とは、移動体100の周囲の世界を意味する。また、第1外界情報は、移動体100の外界に関する画像情報を外界画像検出部21により検出した情報、もしくは、移動体100の外界における周囲の物体との距離情報を距離検出部22により検出した情報の少なくとも一方を含む。また、第2外界情報は、移動体100の外界に関するとともに、その外界から移動体100に作用する慣性力の情報である慣性力情報を慣性力検出部26により検出した情報である。なお、第2外界情報は、慣性力情報のみに限定されず、慣性力情報を含んでいればよい。
 移動制御システム10では、計画部432が、第1外界情報を含む参照情報に基づいて、移動体100の駆動システム30の制御計画を更新し、これによって、移動体100の自律移動を可能とする。そして、移動制御システム10は、修正部433を備えており、修正部433が、第2外界情報に基づいて、制御計画を更新処理の間隔において(つまり、更新処理の後、次の更新処理の前に)修正し、これによって、移動体100の自律移動の修正を図る。例えば、更新処理の間隔において、何らかのイベント(例えば、路面状態の変化)によって、移動体100の自律移動に影響が生じた場合でも、修正部433による制御計画の修正により、イベントの自律移動への影響を低減し得る。よって、移動体100に予定したとおりに自律移動を行わせることが可能となる。したがって、本実施形態の移動制御システム10によれば、自律移動の安定性の向上が図れる。
 (1-2)詳細
 以下、本実施形態の移動制御システム10について、図1~図3を参照して更に詳細に説明する。
 図1に示すように、移動制御システム10は、駆動システム30を有する移動体100に設けられる。
 駆動システム30は、移動体100を移動させるためのシステムである。本実施形態では、上述したように、移動体100は電気自動車であり、駆動システム30は、動力源(モータ)、駆動輪、ドライブトレイン(駆動系部品)等を含む。移動体100は、駆動システム30によって、陸上移動を行う。
 移動制御システム10は、検出システム20と、制御システム40と、を備える。
 検出システム20は、移動体100に関する情報の検出のためのシステムである。検出システム20は、外界画像検出部21と、距離検出部22と、位置検出部23と、内部状態検出部24と、地図情報検出部25と、慣性力検出部26と、を含む。
 外界画像検出部21は、移動体100の外界に関する画像情報の検出をする。画像情報は、移動体100の外界に関する1以上の画像(外界画像)の情報を含む。画像情報は、移動体100からの前方の景色の画像、移動体100からの後方の景色の画像、移動体100からの右方の景色の画像、及び移動体100からの左方の景色の画像を含む。本実施形態では、外界画像検出部21は、複数のイメージセンサを含み、複数のイメージセンサによって、画像情報を検出する。検出システム20は、この画像情報から、移動体100の周囲の物体の有無や、その物体までの距離を検出可能である。
 距離検出部22は、移動体100の周囲の物体までの距離情報の検出をする。ここで、物体は、移動体100の移動の障害となる障害物を想定している。つまり、障害物は、移動体100の移動の際に、移動体100が避ける対象となる物体である。障害物の例としては、図3に示すように、他の移動体300が挙げられる。障害物の他例としては、人、固定物(ガードレール、落下物等)が挙げられる。距離情報は、移動体100の前方の物体までの距離、移動体100の後方の物体までの距離、移動体100の右方の物体までの距離、及び移動体100の左方の物体までの距離を含む。距離検出部22は、複数の距離センサを含み、複数の距離センサによって、距離情報を検出する。距離センサの例としては、超音波センサ、レーダ(RADAR)、ライダ(LIDAR)が挙げられる。なお、距離情報は、物体までの相対速度に関する情報も含み得る。
 位置検出部23は、移動体100の場所情報の検出をする。場所情報は、移動体100の現在地の情報を含む。位置検出部23は、衛星測位システムによって、場所情報を取得する。衛星測位システムの例としては、グローバル・ポジショニング・システム(GPS)が挙げられる。
 内部状態検出部24は、移動体100の内部状態に関する内部情報の検出をする。内部情報は、移動体100の内部状態を示す複数のパラメータを含む。内部状態は、駆動システム30の動作状態(制御状態)を含む。駆動システム30の動作状態(制御状態)は、操舵角、アクセル量、ブレーキ量、速度、動力源(エンジンやモータ)の状態、変速機の回転数、駆動システム30の制御回路(ECU等)の状態、駆動システム30内の制御電流の状態、を含む。内部状態検出部24は、内部状態を検出するためのセンサやモニタを含む。例えば、内部状態検出部24は、操舵角センサ、アクセルセンサ、ブレーキセンサ、速度計、内燃機関や電気モータの回転センサ、変速機の回転数センサ、制御回路のモニタ、制御電流のモニタ等を含む。
 地図情報検出部25は、移動体100に関する地図情報の検出をする。地図情報は、移動体100の周囲を含む所定範囲の地図に関する情報を含む。地図情報検出部25は、所定地域の地図から、位置検出部23の場所情報に基づき、移動体100の周囲を含む所定範囲の地図を抽出して、地図情報を得る。なお、地図情報は、予め準備されていてもよいし、ランドマーク情報やSLAM(Simultaneous Localization and Mapping)技術を利用して、用意されてもよい。
 慣性力検出部26は、移動体100に関する慣性力情報の検出をする。慣性力情報は、移動体100に作用する慣性力に関する情報である。慣性力は、並進加速度系においては加速度で表され、回転座標系においては角速度で表される。つまり、慣性力の検出は、加速度と角速度との少なくとも一方の検出を意味する。慣性力検出部26は、複数の慣性力センサを含む。慣性力センサは、加速度と角速度との少なくとも一方を検出するセンサである。本実施形態では、慣性力検出部26は、直交する3軸の慣性力の検出をする。直交する3軸は、移動体100の前後方向の軸、左右方向の軸、及び、上下方向の軸である。本実施形態では、慣性力情報は、上記の3軸の角速度及び加速度を含む。
 制御システム40は、入出力インタフェース41と、記憶部42と、処理部43と、を含む。
 入出力インタフェース41は、制御システム40への情報の入力及び制御システム40からの情報の出力のためのインタフェースである。つまり、入出力インタフェース41は、制御システム40への情報の入力をする入力部と、制御システム40からの情報の出力する出力部とを兼ねる。制御システム40への情報は、検出システム20から制御システム40に入力される情報を含む。制御システム40からの情報は、制御システム40から駆動システム30に出力される情報を含む。入出力インタフェース41は、制御システム40を操作するための入力装置を備え得る。入力装置は、例えば、タッチパッド及び/又は1以上のボタンを有する。また、入出力インタフェース41は、情報を表示するための画像表示装置を備え得る。画像表示装置は、液晶ディスプレイや有機ELディスプレイ等の薄型のディスプレイ装置である。なお、入出力インタフェース41のタッチパッドと画像表示装置とでタッチパネルが構成されてもよい。また、入出力インタフェース41は、通信インタフェースを備えてよく、有線通信又は無線通信により、制御システム40への情報の入力及び制御システム40からの情報の出力が可能であってよい。有線通信又は無線通信の通信プロトコルは、周知の様々な有線及び無線通信規格から選択され得る。
 記憶部42は、処理部43が利用する情報を記憶するために用いられる。記憶部42は、1以上の記憶装置を含む。記憶装置は、例えば、RAM(Random Access Memory)、EEPROM(Electrically Erasable Programmable Read Only Memory)である。
 処理部43は、制御システム40の動作を制御する制御回路である。処理部43は、例えば、1以上のプロセッサ(マイクロプロセッサ)と1以上のメモリとを含むコンピュータシステムにより実現され得る。処理部43は、取得部431と、計画部432と、修正部433と、制御部434と、を備える。図1において、取得部431と、計画部432と、修正部433と、制御部434とは実体のある構成を示しているわけではなく、処理部43によって実現される機能を示している。
 取得部431は、検出システム20から情報を取得する。より詳細には、取得部431が検出システム20から取得する情報は、外界画像検出部21からの画像情報、距離検出部22からの距離情報、位置検出部23からの場所情報、内部状態検出部24からの内部情報、地図情報検出部25からの地図情報、及び、慣性力検出部26からの慣性力情報を含む。取得部431は、画像情報、距離情報、場所情報、内部情報、地図情報、及び、慣性力情報を一括して取得するのではなく、個別に必要なタイミングで取得する。本実施形態では、画像情報を得るために外界画像検出部21としてイメージセンサを用い、距離情報を得るために距離検出部22として距離センサを用いており、慣性力情報を得るために慣性力検出部26として慣性力センサを用いている。一般に、慣性力センサは、イメージセンサ及び距離センサよりも情報の更新周期が短い。つまり、慣性力センサは、イメージセンサ及び距離センサよりも情報の更新頻度(単位時間当たりの出力数)が高い。例えば、イメージセンサ及び距離センサの更新頻度が30~60であるのに対して、慣性力センサの更新頻度は100を超える。取得部431は、慣性力情報を、画像情報及び距離情報よりも高い頻度で取得する。取得部431は、場所情報、内部情報、及び地図情報は任意のタイミングで取得してよい。例えば、取得部431は、計画部432又は修正部433の要求に応じて場所情報、内部情報、及び地図情報を取得してよい。
 計画部432は、更新処理を定期的に実行する。本実施形態では、計画部432は、所定時間毎に更新処理を実行する。所定時間は、第1外界情報の更新周期と一致してよい。更新処理は、参照情報に基づいて駆動システム30の制御計画を更新する処理である。本実施形態では、「制御計画の更新」は、制御計画の更新だけではなく制御計画の新規作成も含む。制御計画は、駆動システム30による移動体100の移動を定義する情報である。本実施形態では、制御計画は、移動体100の走行軌道の目標値(目標走行軌道)と、移動体100の速度の目標値(目標速度)と、を含む。ここで、移動体100の速度は、前後方向、左右方向、及び上下方向の3軸の速度を含んでよい。参照情報は、第1外界情報を含む。第1外界情報は、駆動システム30によって移動する移動体100の外界に関する情報である。本実施形態では、第1外界情報は、移動体100の外界の画像情報、及び、移動体100の周囲の物体までの距離情報を含む。計画部432は、第1外界情報(画像情報及び距離情報)に加えて、必要に応じて、場所情報、内部情報、及び地図情報を用いて、駆動システム30の制御計画を更新する。
 修正部433は、移動体100の外界に関するとともに第1外界情報とは異なる第2外界情報に基づいて、制御計画の修正処理を実行する。本実施形態では、修正部433は、複数の更新処理の間であるとともに更新処理を行っていないタイミングにおいて、修正処理を実行する。ここでのタイミングは、更新処理から次の更新処理までの間の期間であるとともに、更新処理を行っていない期間である。つまり、修正部433は、更新処理の終了から次の更新処理の開始までに、少なくとも一回は修正処理を行う機会を有している。第2外界情報は、移動体100に外界から作用する慣性力に関する慣性力情報を含む。上述したように、慣性力情報は、取得部431によって、画像情報及び距離情報よりも高い頻度で取得される。よって、修正部433は、更新処理の間隔において、修正処理を実行することが可能である。そのため、修正処理の周期は、更新処理の周期よりも短いことが望ましい。
 修正処理について図3を参照して更に詳細に説明する。修正部433は、第2外界情報に基づき、所定時刻での移動体100の移動状態の予測値を求める。所定時刻での移動体100の移動状態の予測値は、所定時刻での、移動体100の走行軌道の予測値(予測走行軌道)と、移動体100の速度(3軸の速度)の予測値(予測速度)とを含む。例えば、図3において、移動体100Bは、所定時刻での移動体100の移動状態の予測値(予測走行軌道及び予測速度)に対応する。第2外界情報は、慣性力情報を含んでおり、修正部433は、慣性力情報から得られる移動体100に作用する慣性力から、移動体100の移動の変化(移動体100の姿勢の変化)を取得できる。修正部433は、移動体100の移動の変化に基づき、必要に応じて、場所情報、内部情報、及び地図情報を用いて、所定時刻での移動体100の移動状態の予測値を求める。修正部433は、第2外界情報から得られる所定時刻での移動体100の移動状態の予測値に基づいて、修正処理を実行する。より詳細には、修正部433は、予測値と、所定時刻での移動体100の移動状態の目標値との差分に基づいて修正処理を実行する。所定時刻での移動体100の移動状態の目標値は、所定時刻での、移動体100の走行軌道の目標値(目標走行軌道)と、移動体100の速度(3軸の速度)の目標値(目標速度)とを含む。例えば、図3において、移動体100Aは、所定時刻での移動体100の移動状態の目標値(目標走行軌道及び目標速度)に対応する。修正部433は、差分が0になるように、制御計画の修正を実行する。つまり、本実施形態では、修正部433は、所定時刻での予測走行軌道と目標走行軌道とが一致し、所定時刻での予測速度と目標速度とが一致するように、制御計画の修正を実行する。これによって、移動体100が、所定時刻において、移動体100Bで示す移動状態ではなく、移動体100Aで示す移動状態となるように、制御計画が修正される。制御計画の修正にあたっては、必要に応じて、場所情報、内部情報、及び地図情報が用いられる。
 以上述べたように、修正部433は、移動体100の自律移動の修正を図る。例えば、更新処理の間隔において、意図しないイベント(例えば、路面状態の変化)によって、移動体100の自律移動に影響が生じた場合でも、修正部433による制御計画の修正によって、意図しないイベントの自律移動への影響を低減することが可能となる。意図しないイベントは、制御計画の更新処理においては考慮されていないイベントであり得る。意図しないイベントの例としては、路面状態や風速等の移動体100の周囲環境の変化や、移動体100のアクシデント(スリップ、タイヤのパンク等)があり得る。
 本実施形態では、修正部433は、移動体100の速度が閾値以下である間は、修正処理を実行しない。閾値は、特に限定されないが、例えば、電気自動車であれば、徐行に対応する速度であってよい。つまり、移動体100の速度が遅い場合には、何らかのイベントの発生によって移動体100の移動に影響が生じた場合でも、更新処理によって対処可能である可能性が高いからである。これにより、自律移動の処理負荷の軽減を図ることができる。一方、修正部433は、移動体100の速度が閾値より大きい場合に、更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、修正処理を実行する。
 制御部434は、制御計画に基づいて駆動システム30を制御する。制御計画は、計画部432の更新処理による制御計画と、修正部433での修正処理による制御計画とがあり得る。よって、制御部434は、計画部432で更新処理が実行されると、更新後の制御計画に基づいて駆動システム30を制御する。制御部434は、修正部433で修正処理が実行されると、計画部432で更新処理が実行されるまでは修正後の制御計画に基づいて駆動システム30を制御する。つまり、制御計画が修正部433で修正された場合には、制御部434は、修正後の制御計画に基づいて駆動システム30を制御する。本実施形態では、制御部434は、制御計画又は修正後の制御計画に含まれる目標走行軌道および目標車速に応じて制御指示を生成し、駆動システム30に出力する。制御指示は、駆動システム30の動作状態(制御状態)に関する指示値を含む。例えば、制御指示は、操舵角、アクセル量、ブレーキ量、速度、動力源(エンジンやモータ)の状態、変速機の回転数、駆動システム30の制御回路(ECU等)、駆動システム30内の制御電流に関する指示値を含み得る。
 (1-3)動作
 以下、図2のシーケンス図を参照して、本実施形態の移動制御システム10の動作について説明する。
 移動制御システム10では、検出システム20から制御システム40に第1外界情報(画像情報及び距離情報)が与えられる。制御システム40は、第1外界情報を取得すると、更新処理を実行して、制御計画を更新する。更新された制御計画は、制御システム40から駆動システム30に与えられ、駆動システム30は制御計画に従って移動体100を移動させる。すなわち、駆動システム30は制御計画に従って移動体100を制御する。
 第1外界情報の更新周期よりも、第2外界情報の更新周期が短いため、検出システム20は、次に第1外界情報を制御システム40に与える前に、第2外界情報を制御システム40に与える。制御システム40は、第2外界情報を取得すると、修正処理を実行して、制御計画を修正する。修正された制御計画(図2の「修正制御計画」)は、制御システム40から駆動システム30に与えられ、駆動システム30は修正後の制御計画に従って移動体100を移動させる。すなわち、駆動システム30は修正制御計画に従って移動体100を制御する。
 第1外界情報の更新の前に、更に第2外界情報が更新されると、検出システム20は、更に第2外界情報を制御システム40に与える。制御システム40は、第2外界情報を取得すると、修正処理を実行して、制御計画を修正する。言い換えると、制御システム40は、第2外界情報を取得すると、前回に修正された制御計画(修正制御計画)を修正する。修正された制御計画は、制御システム40から駆動システム30に与えられ、駆動システム30は修正後の制御計画に従って移動体100を移動させる。
 この後、第1外界情報の更新があると、検出システム20から制御システム40に第1外界情報が与えられる。制御システム40は、第1外界情報を取得すると、更新処理を実行して、制御計画を更新する。更新された制御計画は、制御システム40から駆動システム30に与えられ、駆動システム30は制御計画に従って移動体100を移動させる。
 このように、移動制御システム10では、更新処理を定期的に実行する計画ステップと、更新処理の間隔において修正処理を実行する修正ステップとを実行し、安定的な移動体100の自律移動を実現する。
 (1-4)まとめ
 以上述べたように、移動制御システム10は、駆動システム30によって移動する移動体100の移動制御システムであって、計画部432と、修正部433と、制御部434と、を備える。計画部432は、移動体100の外界に関する第1外界情報を含む参照情報に基づいて駆動システム30の制御計画を更新する更新処理を実行する。修正部433は、更新処理間のタイミングにおいて、移動体100の外界に関するとともに第1外界情報とは異なる第2外界情報に基づいて制御計画の修正処理を実行する。制御部434は、制御計画に基づいて駆動システム30を制御する。本実施形態の移動制御システム10によれば、自律移動の安定性の向上が図れる。
 換言すれば、移動制御システム10は、下記の方法(移動制御方法)を実行しているといえる。移動制御方法は、計画ステップと、修正ステップと、制御ステップと、を含む。計画ステップは、駆動システム30によって移動する移動体100の外界に関する第1外界情報を含む参照情報に基づいて駆動システム30の制御計画を更新する更新処理を定期的に実行するステップである。修正ステップは、更新処理の間隔において、移動体100の外界に関するが第1外界情報とは異なる第2外界情報に基づいて制御計画の修正処理を実行するステップである。制御ステップは、制御計画に基づいて駆動システム30を制御するステップである。したがって、本実施形態の移動制御方法によれば、移動制御システム10と同様に、自律移動の安定性の向上が図れる。
 移動制御システム10は、コンピュータシステムを利用して実現されている。つまり、移動制御システム10が実行する方法(移動制御方法)は、コンピュータシステムがプログラムを実行することにより実現され得る。このプログラムは、1以上のプロセッサに、移動制御方法を実行させるためのコンピュータプログラムである。このようなプログラムによれば、移動制御システム10と同様に、自律移動の安定性の向上が図れる。
 (2)変形例
 本開示の実施形態は、上記実施形態に限定されない。上記実施形態は、本開示の課題を達成できれば、設計等に応じて種々の変更が可能である。以下に、上記実施形態の変形例を列挙する。以下に説明する変形例は、適宜組み合わせて適用可能である。
 一変形例では、移動体100は、自動車に限定されない。移動体100は、陸上(雪上)、水上、水中、空中、宇宙等の空間を移動する機能を有する物体であってよい。移動体100は、乗り物でなくてよく、無人機を含む。例えば、移動体100の例としては、車両、船舶、航空機、宇宙船、遊具が挙げられる。車両は、自動車、二輪車、三輪車、鉄道車両等を含む。自動車は、ガソリン車、電気自動車、ハイブリッドカー、プラグインハイブリッドカー等を含む。航空機は、旅客機、ドローン等を含む。
 一変形例では、移動制御システム10は、検出システム20を含むが、検出システム20は必ずしも移動制御システム10に含まれている必要はなく、移動制御システム10に対して外部のシステムとして設けられてもよい。
 一変形例では、検出システム20は、必ずしも、位置検出部23と、内部状態検出部24と、地図情報検出部25とを含んでいる必要はない。検出システム20は、外界画像検出部21と距離検出部22との少なくとも一方と、慣性力検出部26とを含んでもよい。
 一変形例では、制御システム40では、処理部43は、少なくとも、計画部432と、修正部433とを有していればよい。取得部431及び制御部434は必須ではない。
 一変形例では、計画部432が更新処理を実行する間隔は、必ずしも一定ではなくてよく、第1外界情報が得られるタイミングで実施されてよい。
 一変形例では、修正処理の周期が更新処理の周期と同じであってよい。修正処理の周期は、更新処理の間隔において修正処理が実行されるように定められていればよい。
 一変形例では、修正処理は、必ずしも予測値を用いる必要はなく、第2外界情報から直接的に制御計画の修正値を決定してよい。つまり、修正処理は、移動体100が当初の制御計画通りに移動するように、制御計画を適宜変更する処理であってよい。
 一変形例では、第1外界情報は、移動体100の外界の画像情報、及び、移動体100の周囲の物体までの距離情報の少なくとも一つを含んでいればよい。
 一変形例では、参照情報は、少なくとも第1外界情報を含んでいればよく、場所情報、内部情報、及び地図情報を含む必要は必ずしもない。
 一変形例では、参照情報は、第2外界情報に関連する情報を含んでよい。つまり、計画部432での制御計画には、第2外界情報が反映されてもよい。第2外界情報に関連する情報は、第2外界情報そのものであってもよいし、上述の差分情報をであってもよい。計画部432での制御計画に、第2外界情報を反映することで、制御計画の精度の向上が図れる。
 一変形例では、第2外界情報は、慣性力情報とは別の情報を含んでよい。ただし、第2外界情報は、移動体100の外界に関するが、第1外界情報とは異なる情報であることが好ましい。また、第2外界情報は、第1外界情報よりも更新周期が短いことが好ましい。例えば、第2外界情報は、移動体100の速度、タイヤの向きの変化、風速の変化、路面の変化等の、移動体100の移動に影響を与える可能性がある情報を含んでよい。
 一変形例では、修正部433は、移動体100の速度に関わらず、修正処理を実行してもよい。
 本開示における移動制御システム10(制御システム40)は、例えば、コンピュータシステムを含んでいる。コンピュータシステムは、ハードウェアとしてのプロセッサ及びメモリを主構成とする。コンピュータシステムのメモリに記録されたプログラムをプロセッサが実行することによって、本開示における移動制御システム10(制御システム40)としての機能が実現される。プログラムは、コンピュータシステムのメモリに予め記録されてもよく、電気通信回線を通じて提供されてもよく、コンピュータシステムで読み取り可能なメモリカード、光学ディスク、ハードディスクドライブ等の非一時的記録媒体に記録されて提供されてもよい。コンピュータシステムのプロセッサは、半導体集積回路(IC)又は大規模集積回路(LSI)を含む1ないし複数の電子回路で構成される。ここでいうIC又はLSI等の集積回路は、集積の度合いによって呼び方が異なっており、システムLSI、VLSI(Very Large Scale Integration)、又はULSI(Ultra Large Scale Integration)と呼ばれる集積回路を含む。さらに、LSIの製造後にプログラムされる、FPGA(Field-Programmable Gate Array)、又はLSI内部の接合関係の再構成若しくはLSI内部の回路区画の再構成が可能な論理デバイスについても、プロセッサとして採用することができる。複数の電子回路は、1つのチップに集約されていてもよいし、複数のチップに分散して設けられていてもよい。複数のチップは、1つの装置に集約されていてもよいし、複数の装置に分散して設けられていてもよい。ここでいうコンピュータシステムは、1以上のプロセッサ及び1以上のメモリを有するマイクロコントローラを含む。したがって、マイクロコントローラについても、半導体集積回路又は大規模集積回路を含む1ないし複数の電子回路で構成される。
 また、移動制御システム10(制御システム40)における複数の機能が、1つの筐体内に集約されていることは移動制御システム10(制御システム40)に必須の構成ではなく、移動制御システム10(制御システム40)の構成要素は、複数の筐体に分散して設けられていてもよい。さらに、移動制御システム10(制御システム40)の少なくとも一部の機能、例えば、処理部43の一部の機能がクラウド(クラウドコンピューティング)等によって実現されてもよい。
 (3)態様
 上記実施形態及び変形例から明らかなように、本開示は、下記の態様を含む。以下では、実施形態との対応関係を明示するためだけに、符号を括弧付きで付している。
 第1の態様は、駆動システム(30)によって移動する移動体(100)の移動制御システム(10)であって、計画部(432)と、修正部(433)と、制御部(434)と、を備える。前記計画部(432)は、前記移動体(100)の外界に関する第1外界情報を含む参照情報に基づいて前記駆動システム(30)の制御計画を更新する更新処理を実行する。前記修正部(433)は、前記更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、前記移動体(100)の外界に関するとともに前記第1外界情報とは異なる第2外界情報に基づいて前記制御計画の修正処理を実行する。前記制御部(434)は、前記制御計画に基づいて前記駆動システム(30)を制御する。この態様によれば、自律移動の安定性の向上が図れる。
 第2の態様は、第1の態様に基づく移動制御システム(10)である。第2の態様では、前記第1外界情報は、前記移動体(100)の外界に関する画像情報、及び前記移動体(100)の周囲の物体との距離情報の少なくとも一方を含む情報である。前記第2外界情報は、前記移動体(100)の外界から前記移動体(100)に作用する慣性力情報を含む情報である。この態様によれば、制御計画の修正の精度の向上が図れる。
 第3の態様は、第1又は第2の態様に基づく移動制御システム(10)である。第3の態様では、前記制御部(434)は、前記修正部(433)で前記修正処理が実行されると、前記計画部(432)で前記更新処理が実行されるまでは修正後の制御計画に基づいて前記駆動システム(30)を制御する。この態様によれば、自律移動の安定性の向上が図れる。
 第4の態様は、第1~第3の態様のいずれか一つに基づく移動制御システム(10)である。第4の態様では、前記修正部(433)は、前記第2外界情報から得られる所定時刻での前記移動体(100)の移動状態の予測値と、前記所定時刻での前記移動体(100)の移動状態の目標値との差分に基づいて、前記修正処理を実行する。この態様によれば、制御計画の修正の精度の向上が図れる。
 第5の態様は、第4の態様に基づく移動制御システム(10)である。第5の態様では、前記参照情報は、前記差分の情報を含む。この態様によれば、制御計画の精度の向上が図れる。
 第6の態様は、第1~第5の態様のいずれか一つに基づく移動制御システム(10)である。第6の態様では、前記参照情報は、前記第2外界情報を含む。この態様によれば、制御計画の精度の向上が図れる。
 第7の態様は、第1~第6の態様のいずれか一つに基づく移動制御システム(10)である。第7の態様では、前記更新処理の周期よりも、前記修正処理の周期が短い。この態様によれば、制御計画の修正の頻度の向上が図れる。
 第8の態様は、第1~第7の態様のいずれか一つに基づく移動制御システム(10)である。第8の態様では、前記第1外界情報の更新周期よりも、前記第2外界情報の更新周期が短い。この態様によれば、制御計画の修正の頻度の向上が図れる。
 第9の態様は、第1~第8の態様のいずれか一つに基づく移動制御システム(10)である。第9の態様では、前記修正部(433)は、前記移動体(100)の速度が閾値以下である間は、前記修正処理を実行しない。この態様によれば、自律移動の処理負荷の軽減を図ることができる。
 第10の態様は、移動制御方法であって、計画ステップと、修正ステップと、制御ステップと、を含む。前記計画ステップは、駆動システム(30)によって移動する移動体(100)の外界に関する第1外界情報を含む参照情報に基づいて前記駆動システム(30)の制御計画を更新する更新処理を実行するステップである。前記修正ステップは、前記更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、前記移動体(100)の外界に関するとともに前記第1外界情報とは異なる第2外界情報に基づいて前記制御計画の修正処理を実行するステップである。前記制御ステップは、前記制御計画に基づいて前記駆動システム(30)を制御するステップである。この態様によれば、自律移動の安定性の向上が図れる。
 第11の態様は、プログラム(コンピュータプログラム)であって、1以上のプロセッサに、第10の態様の移動制御方法を実行させるための、プログラムである。この態様によれば、自律移動の安定性の向上が図れる。
 第12の態様は、移動体(100)であって、第1~第9の態様のいずれか一つの移動制御システム(10)と、前記駆動システム(30)と、を備える。この態様によれば、自律移動の安定性の向上が図れる。
 なお、第2~第9の態様は、第10の態様にも適宜変更して適用することが可能である。
 100 移動体
 10 移動制御システム
 30 駆動システム
 432 計画部
 433 修正部
 434 制御部

Claims (12)

  1.  駆動システムによって移動する移動体の移動制御システムであって、
     前記移動体の外界に関する第1外界情報を含む参照情報に基づいて前記駆動システムの制御計画を更新する更新処理を実行する計画部と、
     前記更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、前記移動体の外界に関するとともに前記第1外界情報とは異なる第2外界情報に基づいて前記制御計画の修正処理を実行する修正部と、
     前記制御計画に基づいて前記駆動システムを制御する制御部と、
     を備える、
     移動制御システム。
  2.  前記第1外界情報は、前記移動体の外界に関する画像情報、及び前記移動体の周囲の物体との距離情報の少なくとも一方を含む情報であり、
     前記第2外界情報は、前記移動体の外界から前記移動体に作用する慣性力情報を含む情報である、
     請求項1の移動制御システム。
  3.  前記制御部は、前記修正部で前記修正処理が実行されると、前記計画部で前記更新処理が実行されるまでは修正後の制御計画に基づいて前記駆動システムを制御する、
     請求項1又は2の移動制御システム。
  4.  前記修正部は、前記第2外界情報から得られる所定時刻での前記移動体の移動状態の予測値と、前記所定時刻での前記移動体の移動状態の目標値との差分に基づいて、前記修正処理を実行する、
     請求項1~3のいずれか一つの移動制御システム。
  5.  前記参照情報は、前記差分の情報を含む、
     請求項4の移動制御システム。
  6.  前記参照情報は、前記第2外界情報を含む、
     請求項1~5のいずれか一つの移動制御システム。
  7.  前記更新処理の周期よりも、前記修正処理の周期が短い、
     請求項1~6のいずれか一つの移動制御システム。
  8.  前記第1外界情報の更新周期よりも、前記第2外界情報の更新周期が短い、
     請求項1~7のいずれか一つの移動制御システム。
  9.  前記修正部は、前記移動体の速度が閾値以下である間は、前記修正処理を実行しない、
     請求項1~8のいずれか一つの移動制御システム。
  10.  駆動システムによって移動する移動体の外界に関する第1外界情報を含む参照情報に基づいて前記駆動システムの制御計画を更新する更新処理を実行する計画ステップと、
     前記更新処理が実行される複数の第1タイミング間の第2タイミングにおいて、前記移動体の外界に関するとともに前記第1外界情報とは異なる第2外界情報に基づいて前記制御計画の修正処理を実行する修正ステップと、
     前記制御計画に基づいて前記駆動システムを制御する制御ステップと、
     を含む、
     移動制御方法。
  11.  1以上のプロセッサに、請求項10の移動制御方法を実行させるための、
     プログラム。
  12.  請求項1~9のいずれか一つの移動制御システムと、
     前記駆動システムと、
     を備える、
     移動体。
PCT/JP2021/026857 2020-07-21 2021-07-16 移動制御システム、移動制御方法、プログラム、及び、移動体 WO2022019240A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN202180046218.9A CN115734906A (zh) 2020-07-21 2021-07-16 移动控制系统、移动控制方法、程序及移动体
JP2022537981A JPWO2022019240A1 (ja) 2020-07-21 2021-07-16
US18/004,812 US11866040B2 (en) 2020-07-21 2021-07-16 Movement control system, movement control method, program and moving body
EP21847067.2A EP4186766A4 (en) 2020-07-21 2021-07-16 MOTION CONTROL SYSTEM, MOTION CONTROL METHOD, PROGRAM AND MOVING BODY

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020-124691 2020-07-21
JP2020124691 2020-07-21

Publications (1)

Publication Number Publication Date
WO2022019240A1 true WO2022019240A1 (ja) 2022-01-27

Family

ID=79729503

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/026857 WO2022019240A1 (ja) 2020-07-21 2021-07-16 移動制御システム、移動制御方法、プログラム、及び、移動体

Country Status (5)

Country Link
US (1) US11866040B2 (ja)
EP (1) EP4186766A4 (ja)
JP (1) JPWO2022019240A1 (ja)
CN (1) CN115734906A (ja)
WO (1) WO2022019240A1 (ja)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017024637A (ja) * 2015-07-24 2017-02-02 トヨタ自動車株式会社 車両制御装置
JP2017226371A (ja) * 2016-06-24 2017-12-28 アイシン・エィ・ダブリュ株式会社 走行情報表示システムおよび走行情報表示プログラム
WO2018073887A1 (ja) * 2016-10-18 2018-04-26 本田技研工業株式会社 車両制御装置
JP2018194343A (ja) * 2017-05-12 2018-12-06 三菱自動車工業株式会社 ナビゲーション装置
JP2019073039A (ja) 2017-10-12 2019-05-16 本田技研工業株式会社 車両制御装置
JP2019078656A (ja) * 2017-10-25 2019-05-23 株式会社デンソー 車両用制御装置
JP2019189214A (ja) * 2018-04-18 2019-10-31 バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーBaidu USA LLC 自動運転車の経路計画用のドリフト補正の方法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006311791A (ja) * 2005-03-31 2006-11-09 Advics:Kk 車両用ブレーキ制御装置
JP5970322B2 (ja) * 2012-10-01 2016-08-17 日立オートモティブシステムズ株式会社 車両の運動制御装置
DE102015221481A1 (de) * 2015-11-03 2017-05-04 Continental Teves Ag & Co. Ohg Vorrichtung zur Umfeldmodellierung für ein Fahrerassistenzsystem für ein Kraftfahrzeug
EP3515780A1 (en) * 2016-09-29 2019-07-31 The Charles Stark Draper Laboratory, Inc. Autonomous vehicle with modular architecture
DE102018009927A1 (de) * 2018-12-17 2020-06-18 Trw Automotive Gmbh Steuerungssystem und Steuerungsverfahren für einen hybriden Ansatz zum Ermitteln einer möglichen Trajektorie für ein Kraftfahrzeug

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017024637A (ja) * 2015-07-24 2017-02-02 トヨタ自動車株式会社 車両制御装置
JP2017226371A (ja) * 2016-06-24 2017-12-28 アイシン・エィ・ダブリュ株式会社 走行情報表示システムおよび走行情報表示プログラム
WO2018073887A1 (ja) * 2016-10-18 2018-04-26 本田技研工業株式会社 車両制御装置
JP2018194343A (ja) * 2017-05-12 2018-12-06 三菱自動車工業株式会社 ナビゲーション装置
JP2019073039A (ja) 2017-10-12 2019-05-16 本田技研工業株式会社 車両制御装置
JP2019078656A (ja) * 2017-10-25 2019-05-23 株式会社デンソー 車両用制御装置
JP2019189214A (ja) * 2018-04-18 2019-10-31 バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーBaidu USA LLC 自動運転車の経路計画用のドリフト補正の方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP4186766A4

Also Published As

Publication number Publication date
EP4186766A1 (en) 2023-05-31
CN115734906A (zh) 2023-03-03
EP4186766A4 (en) 2024-01-24
US20230249681A1 (en) 2023-08-10
US11866040B2 (en) 2024-01-09
JPWO2022019240A1 (ja) 2022-01-27

Similar Documents

Publication Publication Date Title
KR102223270B1 (ko) 여분의 초음파 radar를 구비한 자율 주행 차량
US11467596B2 (en) Target abnormality determination device
US11042157B2 (en) Lane/object detection and tracking perception system for autonomous vehicles
US11628881B2 (en) Autonomous driving system
US10769793B2 (en) Method for pitch angle calibration based on 2D bounding box and its 3D distance for autonomous driving vehicles (ADVs)
JP6432116B2 (ja) 車両位置特定装置、車両制御システム、車両位置特定方法、および車両位置特定プログラム
US9796416B2 (en) Automated driving apparatus and automated driving system
CN108688660B (zh) 运行范围确定装置
US11113971B2 (en) V2X communication-based vehicle lane system for autonomous vehicles
US11467576B2 (en) Autonomous driving system
CN110096054B (zh) 用于使用多个线程生成用于自动驾驶车辆的参考线的方法和系统
CN108628298B (zh) 用于自动驾驶车辆的控制型规划和控制系统
US10438074B2 (en) Method and system for controlling door locks of autonomous driving vehicles based on lane information
JP7156924B2 (ja) 車線境界設定装置、車線境界設定方法
JP2017140857A (ja) 車両制御システム
CN115218888A (zh) 用于更新高清地图的系统和方法
WO2022019240A1 (ja) 移動制御システム、移動制御方法、プログラム、及び、移動体
US20230315935A1 (en) Controls simulation initialization
US11500389B2 (en) Vehicle control device
US20220009494A1 (en) Control device, control method, and vehicle
US20210357667A1 (en) Methods and Systems for Measuring and Mapping Traffic Signals
JP2022126341A (ja) 車両制御装置、車両制御方法、およびプログラム
US10788839B2 (en) Planning-control collaboration design for low cost autonomous driving technology
US11673606B2 (en) Driving support device, driving support method, and storage medium
WO2023188209A1 (ja) 車線変更支援装置

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: 21847067

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022537981

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2021847067

Country of ref document: EP

Effective date: 20230221