Method for controlling a driving operation of an autonomously controlled vehicle
The present disclosure relates to method for controlling a driving operation of an autonomously controlled vehicle. In particular, a navigation system is controlled to autonomously operate the vehicle in a direction from a position of loss of location to a first upcoming stop position; and to controlling the vehicle to a stand-still operation when the vehicle arrives at the stop position for calibration of a sensor arranged to measure an angular velocity of the vehicle.
1. A method for controlling a driving operation of an autonomously controlled vehicle, the vehicle comprising a sensor arranged to measure an angular velocity of the vehicle in at least one direction during operation, the method comprising:
obtaining a signal indicative of a road path to an end destination for operation of the vehicle;
generating a plurality of stop positions along the road path; and when determining a loss of location of the vehicle:
determining a position along the road path at the loss of vehicle location;
controlling a navigation system of the vehicle, using angular velocity data from the sensor, to autonomously operate the vehicle in a direction from the position of loss of location to a first upcoming stop position of the plurality of stop positions;
controlling the vehicle to a stand-still operation when the vehicle arrives at the stop position for calibration of the sensor;
controlling the navigation system to autonomously operate the vehicle to the remaining stop positions; and
controlling the vehicle to the stand-still operation and calibrate the sensor at each of the remaining stop positions.
2. The method according to claim 1 , further comprising:
controlling the vehicle to the stand-still operation for calibration of the sensor when determining the loss of location.
3. The method according to claim 1 , further comprising:
obtaining a signal indicative of an angular velocity of the sensor, and
controlling the vehicle to an intermediate stand-still operation when the angular velocity exceeds a predetermined threshold limit.
4. The method according to claim 1 , wherein the number of plurality of stop positions is dependent on the length of the road path to the end destination.
5. The method according to claim 1 , wherein calibration of the sensor comprises:
obtaining a signal indicative of a value of the angular velocity of the sensor when the vehicle is arranged in the stand-still operation;
setting the value as an offset angular velocity; and
calibrating the sensor by subtracting the offset angular velocity from the obtained angular velocity value.
6. The method according to claim 1 , wherein the navigation system is arranged in a limp-home mode when determining the loss of location of the vehicle.
7. The method according to claim 1 , wherein the position along the road path at the loss of vehicle location is received from a positioning system of the vehicle.
8. The method according to claim 7 , wherein the positioning system is at least one of a GPS, a GNSS or a LIDAR system.
9. The method according to claim 1 , wherein the navigation system is configured to receive the road path to the end destination comprising the plurality of stop positions in the form of offline available data prior to vehicle departure.
10. The method according to claim 1 , wherein sensor data from the sensor is used in the navigation system of the vehicle, to autonomously operate the vehicle in a direction from the position of loss of location to an upcoming stop position.
11. The method according to claim 1 , wherein the sensor is a yaw rate sensor configured to measure a yaw angular velocity during vehicle operation.
12. The method according to claim 1 , wherein the sensor is a wheel speed sensor configured to measure a wheel angular velocity during vehicle operation.
13. The method according to claim 1 , further comprising:
obtaining a verification signal indicative of a completed sensor calibration; and
controlling the navigation system of the vehicle to, using angular velocity data from the sensor, autonomously operate the vehicle in a direction towards an upcoming stop position.
14. A control system for autonomously controlling a vehicle, the control system being connectable to a navigation system and to a sensor arranged to measure an angular velocity of the vehicle in at least one direction during operation, wherein the control system is configured to:
obtain a signal indicative of a road path to an end destination for operation of the vehicle;
generate a plurality of stop positions along the road path; and when the control system determines a loss of location of the vehicle;
determine a position along the road path at the loss of vehicle location;
transmit a navigation signal to the navigation system of the vehicle, the navigation signal being arranged to, when executed by the navigation system, cause the navigation system to autonomously operate the vehicle, using angular velocity data from the sensor, in a direction from the position of loss of location to a first upcoming stop position of the plurality of stop positions and to arrange the vehicle in a stand-still operation when the vehicle arrives at the stop position;
transmit a calibration signal to the sensor, the calibration signal being arranged to, when executed by the sensor, calibrate the sensor when the vehicle is arranged in the stand-still operation;
transmit a navigation signal to the navigation system of the vehicle, the navigation signal being arranged to, when executed by the navigation system, cause the navigation system to autonomously operate the vehicle, using angular velocity data from the sensor, to the remaining stop positions and to arrange the vehicle in a stand-still operation when the vehicle arrives at each of the remaining stop positions; and
transmit a calibration signal to the sensor, the calibration signal being arranged to, when executed by the sensor, calibrate the sensor when the vehicle is arranged in the stand still operation at each of the remaining in the stand-still operation.
15. The autonomously controlled vehicle, comprising the navigation system, a sensor arranged to measure the angular velocity of the vehicle in at least one direction during operation, and the control system according to claim 14 , wherein the control system is connected to the navigation system and the sensor for communication of control signals therebetween.