摘要:
An obstacle detection device (40) of an articulated vehicle (C), comprises a surrounding area calculation unit (41) that calculates a surrounding area (D) in a turning direction of a towing vehicle (X) and a towed vehicle (Y), a passage area calculation unit (42) that calculates a passage prediction area (B, A, AB, A1B1, A2B2), a monitoring area calculation unit (43) that calculates an area in which the surrounding area (D) and the passage prediction area (AB, A, B, A1B1, A2B2) overlap as a monitoring area (E, E1, E2), and an obstacle detection unit (44) that outputs an obstacle detection information indicating that an obstacle that may be entrapped by a turning of the towing vehicle (X) and the towed vehicle (Y) has been detected, in response to the obstacle detected by the obstacle sensor (30) being detected within the monitoring area (E, E1, E2).
摘要:
(A) One or both of an object and a robot (2) are measured by measuring units (12a and 12b) to acquire sensor information. (B) The internal state of one or both of the object and the robot (2) is predicted and updated by a state estimation unit (14) on the basis of the sensor information. (C) The internal state is stored by a data storage unit (16). (D) The robot (2) is controlled by a robot control unit (20). At (B), the internal state is updated by the state estimation unit (14) at an arbitrary timing that is independent of the control cycle of the robot. At (D), a prediction value necessary for controlling the robot is calculated by the robot control unit at a control cycle on the basis of the latest internal state stored in the data storage unit (16).