Position calculating system and haulage vehicle
First Claim
1. A position calculating system for being mounted on a haulage vehicle including wheels and a body frame which is mounted on the wheels via suspensions and carries a body mounted thereon, comprising:
- an acceleration sensor configured to measure acceleration applied to the body frame;
a gyro sensor configured to measure rotation angular velocity of the body frame;
a wheel rotational speed sensor configured to measure rotational speed of one of the wheels; and
a calculating device configured to receive information from the acceleration sensor, information from the gyro sensor, and information from the wheel rotational speed sensor to calculate a position of the haulage vehicle based on the received information,wherein the calculating device is further configured to;
determine whether the haulage vehicle is moving or at stop based on the information output from the wheel rotational speed sensor,determine whether the body frame is in a loaded state with a load carried thereon or in an unloaded state without a load carried thereon based on the information received from the acceleration sensor and the gyro sensor,when the haulage vehicle is determined to be at stop and a loading state of the body frame is determined to be changed from an unloaded state to a loaded state or determined to be in a loaded state, set a first correction amount required for bringing detection axes, which are to be used upon measuring the rotation angular velocity by the gyro sensor into coincidence with corresponding detection axes, which are to be used upon measuring the rotation angular velocity in an unloaded state,when the haulage vehicle is determined to be moving and the loading state of the body frame is determined to be changed from a loaded state to an unloaded state or determined to be in an unloaded state, set a second correction amount required for maintaining the detection axes, which are to be used upon measuring the rotation angular velocity by the gyro sensor,calculate a velocity vector of the haulage vehicle based on either the first correction amount or the second correction amount, andcalculate a position of the haulage vehicle based on the velocity vector.
1 Assignment
0 Petitions
Accused Products
Abstract
A position calculating system for a haulage vehicle including wheels and a body frame mounted on the wheels. The system includes an attitude detection sensor fixed on the body frame, a wheel rotational speed sensor, a loading status information acquiring unit, a correction amount setting unit, a velocity vector calculating unit, and a position calculating unit. The loading status information acquiring unit acquires loading status information indicating whether the body frame is in a loaded state or in an unloaded state. The correction amount setting unit calculates, based on the attitude information, a correction amount required for bringing detection axes in the loaded state into coincidence with corresponding detection axes in the unloaded state. The velocity vector calculating unit calculates the velocity vector of the haulage vehicle. The position calculating unit calculates a position of the haulage vehicle by using the velocity vector.
-
Citations
4 Claims
-
1. A position calculating system for being mounted on a haulage vehicle including wheels and a body frame which is mounted on the wheels via suspensions and carries a body mounted thereon, comprising:
-
an acceleration sensor configured to measure acceleration applied to the body frame; a gyro sensor configured to measure rotation angular velocity of the body frame; a wheel rotational speed sensor configured to measure rotational speed of one of the wheels; and a calculating device configured to receive information from the acceleration sensor, information from the gyro sensor, and information from the wheel rotational speed sensor to calculate a position of the haulage vehicle based on the received information, wherein the calculating device is further configured to; determine whether the haulage vehicle is moving or at stop based on the information output from the wheel rotational speed sensor, determine whether the body frame is in a loaded state with a load carried thereon or in an unloaded state without a load carried thereon based on the information received from the acceleration sensor and the gyro sensor, when the haulage vehicle is determined to be at stop and a loading state of the body frame is determined to be changed from an unloaded state to a loaded state or determined to be in a loaded state, set a first correction amount required for bringing detection axes, which are to be used upon measuring the rotation angular velocity by the gyro sensor into coincidence with corresponding detection axes, which are to be used upon measuring the rotation angular velocity in an unloaded state, when the haulage vehicle is determined to be moving and the loading state of the body frame is determined to be changed from a loaded state to an unloaded state or determined to be in an unloaded state, set a second correction amount required for maintaining the detection axes, which are to be used upon measuring the rotation angular velocity by the gyro sensor, calculate a velocity vector of the haulage vehicle based on either the first correction amount or the second correction amount, and calculate a position of the haulage vehicle based on the velocity vector. - View Dependent Claims (2, 3)
-
-
4. A haulage vehicle including wheels and a body frame which is mounted on the wheels via suspensions and carries a body mounted thereon, comprising a position calculating system which includes:
-
an acceleration sensor configured to measure acceleration applied to the body frame; a gyro sensor configured to measure rotation angular velocity of the body frame; a wheel rotational speed sensor configured to measure rotational speed of one of the wheels; and a calculating device configured to receive information from the acceleration sensor, information from the gyro sensor, and information from the wheel rotational speed sensor to calculate a position of the haulage vehicle based on the received information, wherein the calculating device is further configured to; determine whether the haulage vehicle is moving or at stop based on the information output from the wheel rotational speed sensor, determine whether the body frame is in a loaded state with a load carried thereon or in an unloaded state without a load carried thereon based on the information from the acceleration sensor and the gyro sensor, when the haulage vehicle is determined to be at stop and a loading state of the body frame is determined to be changed from an unloaded state to a loaded state or determined to be a loaded state, set a first correction amount required for bringing detection axes, which are to be used upon measuring the rotation angular velocity by the gyro sensor, into coincidence with corresponding detection axes, which are to be used upon measuring the rotation angular velocity in the unloaded state, when the haulage vehicle is determined to be moving and the loading state of the body frame is determined to be changed from a loaded state to an unloaded state or determined to be in an unloaded state, set a second correction amount required for maintaining the detection axes, which are to be used upon measuring the rotation angular velocity by the gyro sensor, calculate a velocity vector of the haulage vehicle based on either the first correction amount or the second correction amount, and calculate a position of the haulage vehicle based on the velocity vector.
-
Specification