# US 5,350,912 A · System for controlling movement of a mobile body along a target path > Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt - Number: US 5,350,912 A - Document ID: US5350912A - Status: Granted - Kind: A - Application number: 08/005,026 - Filed: 1993-01-15 - Granted: 1994-09-27 - Earliest claimed: 1992-01-17 - Assignees: Honda Giken Kogyo Kabushiki Kaisha - Inventors: Shinnosuke Ishida - Web page: https://patentgrep.com/patent/US5350912A ## CPC - B62D 6/00: Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits (means for initiating a change in direction B62D1/00; steering valves B62D5/06; combined with means for inclining the vehicle body or wheels on bends B62D9/00) - G05D 1/0246: {using a video camera in combination with image processing means} - B62D: MOTOR VEHICLES; TRAILERS (steering, or guiding on a desired track, of agricultural machines or implements A01B69/00; wheels, castors, axles, increasing wheel adhesion B60B; vehicle tyres, tyre inflation or tyre changing B60C; connections between vehicles of a train or the like B60D; vehicles for use on rail and road, amphibious or convertible vehicles B60F; suspension arrangements B60G; heating, cooling, ventilating or other air treating devices B60H; windows, windscreens, non-fixed roofs, doors or similar devices, protective coverings for vehicles not in use B60J; propulsion plant arrangements, auxiliary drives, transmissions, controls, instrumentation or dashboards B60K; electric equipment or propulsion of electrically-propelled vehicles B60L; power supply for electrically-propelled vehicles B60M; passenger accommodation not otherwise provided for B60N; adaptations for load transportation or to carry special loads or objects B60P; arrangement of signalling or lighting devices, the mounting or supporting thereof or circuits therefor, for vehicles in general B60Q; vehicles, vehicle fittings or vehicle parts not otherwise provided for B60R; servicing, cleaning, repairing, supporting, lifting, or manoeuvring, not otherwise provided for, B60S; brake arrangements, brake control systems or parts thereof B60T; air-cushion vehicles B60V; motor-cycles, accessories therefor B62J, B62K; testing of vehicles G01M) - G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES ## Abstract A mobile body such as an automobile is controlled to move substantially along a target path by a control system. The control system determines a target point on the target path, a control quantity such as a yaw rate to reach the target point to cause the mobile body to reach the target point from an optional position, the direction in which the mobile body moves at the target point based on the control quantity to reach the target point, the angular difference between the direction and the target path at the target point as a target point angular difference, and a target control quantity such as a target yaw rate for the mobile body by correcting the control quantity to reach the target point based on the target point angular difference. The mobile body is controlled based on the target control quantity. ## Claims ### Claim 1 A system for controlling movement of a mobile body substantially along a target path, comprising: means for determining a target point on the target path; means for determining a control quantity which will cause said mobile body to reach said target point from an original position; means for determining a direction in which to move said mobile body toward said target point based on said control quantity; means for determining an angular difference between said direction and said target path at the target point as a target point angular difference; means for determining a target control quantity for the mobile body by correcting the control quantity such that the mobile body reaches the target point based on said target point angular difference; and means for controlling said mobile body based on said target control quantity. ### Claim 2 (depends on 1) A system according to claim 1, wherein said means for determining a target control quantity comprises means for determining a target control quantity using a condition quantity of said target path. ### Claim 3 (depends on 2) A system according to claim 2, wherein said condition quantity of said target path is a curvature of said target path, the arrangement being such that the control quantity to reach the target point is corrected into said target control quantity by an amount which is smaller as said curvature is greater. ### Claim 4 (depends on 2) A system according to claim 2, wherein said condition quantity of said target path is a width of said target path, the arrangement being such that the control quantity to reach the target point is corrected into said target control quantity by an amount which is greater as said width is greater. ### Claim 5 (depends on 1) A system according to claim 1, wherein said means for determining a target control quantity comprises means for determining a target control quantity using a condition quantity of said mobile body. ### Claim 6 (depends on 5) A system according to claim 5, wherein said condition quantity of said mobile body is a speed of said mobile body, the arrangement being such that the control quantity to reach the target point is corrected into said target control quantity by an amount which is greater as said speed is higher. ### Claim 7 (depends on 1) A system according to claim 1, wherein said mobile body comprises an automatic running vehicle having a steerable wheel, said control quantity being a yaw rate of the automatic running vehicle. ### Claim 8 (depends on 7) A system according to claim 7, wherein said means for controlling said mobile body based on said target control quantity as the target yaw rate comprises means for determining a target steering angle for the steerable wheel to generate the target yaw rate based on a predetermined yaw rate and a steering angle of the steerable wheel, and means for correcting said steering angle into said target steering angle. ### Claim 9 (depends on 7) A system according to claim 7, wherein said means for determining a target control quantity comprises means for multiplying an amount to correct said yaw rate which is required to eliminate said target point angular difference by a corrective coefficient having a value ranging from 0 to 1 depending on a curvature and a width of said target path and a speed of said mobile body, to determine an amount to correct a yaw rate to reach the target point as said control quantity to reach the target point into a target yaw rate as said target control quantity. ### Claim 10 (depends on 9) A system according to claim 9, wherein said means for determining a target control quantity comprises means for determining said corrective coefficient from said curvature, said width, and said speed according to a fuzzy reasoning process such that said corrective coefficient is smaller as said curvature is larger, said corrective coefficient is larger as said width is larger, and said corrective coefficient is larger as said speed is higher. ### Claim 11 (depends on 7) A system according to claim 7, wherein said means for determining a direction comprises means for determining said direction taking into account the response of the steering angle of the steerable wheel when the steerable wheel is steered to generate the yaw rate to reach said target point, and the response of the yaw rate to the steering angle.