Method of measuring pose of mobile robot and method and apparatus for measuring position of mobile robot using the same
A method of measuring pose of mobile robot, and method and apparatus for measuring for measuring position of mobile robot using the same are provided. The apparatus for measuring the pose of a mobile robot includes an accelerometer measuring acceleration of the mobile robot in a forward direction, a uniform-motion-determining unit determining whether the mobile robot belongs to a uniform motion section, an acceleration section, or a deceleration section, and a pose-calculating unit calculating a pitch and a roll of the mobile robot in the uniform motion section, using the relationship between the measured acceleration in the forward direction and the acceleration due to gravity.
1. An apparatus for measuring the pose of a mobile robot, comprising:
an accelerometer measuring acceleration of the mobile robot in a forward direction;
a uniform-motion-determining unit determining whether the mobile robot belongs to a uniform motion section, an acceleration section, or a deceleration section; and
a pose-calculating unit calculating a pitch and a roll of the mobile robot in the uniform motion section, using the relationship between the measured acceleration in the forward direction and the acceleration due to gravity, wherein
the accelerometer is mounted to a front end of the mobile robot; and
the pose-calculating unit calculates the pitch in the acceleration and deceleration sections from d/L,
where d is a lifting distance of the mobile robot, and L is the distance from a center of the mobile robot to the accelerometer.
2. The apparatus of claim 1 , further comprising:
an encoder detecting the rotational speed of traveling wheels of the mobile robot,
wherein the uniform-motion-determining unit determines which of these sections the mobile robot belongs to, on the basis of a profile of the rotational speed.
3. The apparatus of claim 1 , further comprising:
a pose-compensating unit calculating the acceleration of the mobile robot in the forward direction in a global coordinate system using the calculated pitch, roll, and acceleration in the forward direction.
4. The apparatus of claim 3 , wherein the pose-compensating unit calculates the acceleration in the forward direction in the global coordinate system by multiplying the measured acceleration in the forward direction by a transform matrix based on the calculated pitch and roll,
where the transform matrix is represented by
[
cos
θ
sin
ϕsin
θ
cos
ϕsin
θ
0
cos
ϕ
-
sin
ϕ
-
sin
θ
sin
ϕcos
θ
cos
ϕcos
θ
]
,
θ indicates the calculated pitch, and Φ indicates the calculated roll.
5. The apparatus of claim 1 , wherein:
the pose-calculating unit calculates the pitch from arcsin (acc_x/g), and
when the calculated pitch is Φ, the pose-calculating unit calculates the roll from arcsin (acc_y/g/cosθ),
where acc_x indicates an acceleration component in the traveling direction of the mobile robot in a local coordinate system, acc_y indicates an acceleration component in a direction vertical to the traveling direction of the mobile robot in the local coordinate system, and g indicates the acceleration due to gravity.
6. An apparatus for measuring the position of a mobile robot, comprising:
an accelerometer measuring the acceleration of the mobile robot in a forward direction;
a uniform-motion-determining unit determining whether the mobile robot belongs to a uniform motion section, an acceleration section, or a deceleration section;
a pose-calculating unit calculating a pitch and a roll of the mobile robot in the uniform motion section, using the relationship between the measured acceleration in the forward direction and the acceleration due to gravity;
a camera disposed on an upper surface of the mobile robot to capture a ceiling image;
a feature-point-extracting unit extracting feature points from the captured ceiling image;
a feature-point-compensating unit compensating for the coordinates of the extracted feature point using the calculated pitch and roll; and
a position-calculating unit calculating the displacement of the mobile robot on the basis of the feature point whose coordinates are compensated.
7. The apparatus of claim 6 , wherein:
the pose-calculating unit calculates the pitch from arcsin (acc_x/g); and
when the calculated pitch is θ, the pose-calculating unit calculates the roll from arcsin (acc_y/g/cosθ),
where acc_x indicates an acceleration component in the traveling direction of the mobile robot in a local coordinate system, acc_y indicates an acceleration component in a direction vertical to the traveling direction of the mobile robot in the local coordinate system, and g indicates the acceleration due to gravity.
8. The apparatus of claim 6 , further comprising:
a pose-compensating unit calculating acceleration in the forward direction in a global coordinate system, using the calculated pitch and roll and the measured acceleration in the forward direction; and
a height-calculating unit calculating the height from the mobile robot to the compensated feature point using the moving distance obtained from the calculated acceleration in the forward direction.
9. The apparatus of claim 8 , wherein the pose-compensating unit calculates the acceleration in the forward direction in the global coordinate system by multiplying the measured acceleration in the forward direction by a transform matrix based on the calculated pitch and roll,
and represented by
[
cos
θ
sin
ϕsin
θ
cos
ϕsin
θ
0
cos
ϕ
-
sin
ϕ
-
sin
θ
sin
ϕcosθ
cos
ϕcos
θ
]
,
where θ indicates the calculated pitch, and Φ indicates the calculated roll.
10. The apparatus of claim 8 , wherein the height-calculating unit calculates the height from D*f/x,
where D indicates the moving distance of the mobile robot that is calculated from the acceleration in the forward direction, f indicates a focal distance, and x indicates the displacement of the feature point in the ceiling image captured by the camera.
11. The apparatus of claim 6 , wherein the position-calculating unit calculates the displacement of the mobile robot from H*f/x,
where H indicates the height of the feature point, f indicates a focal distance, and x indicates the displacement of the feature point in the ceiling image captured by the camera.
12. The apparatus of claim 6 , wherein the feature-point-compensating unit compensates for the coordinates by multiplying the coordinates of the extracted feature point by a transform matrix:
[
cos
θ
cos
ψ
-
cos
ϕsinψ
+
sin
ϕsinθcos
ψ
sin
ϕsinψ
+
cos
ϕsin
θcosψ
cos
θsinψ
cos
ϕcosψ
+
sin
ϕsinθsinψ
-
sin
ϕcosψ
+
cos
ϕsinθsinψ
-
sin
θ
sin
ϕcosθ
cos
ϕcos
θ
]
.
where θ and Φ respectively indicate the pitch and the roll calculated by the pose-calculating unit, and ψ indicates a yaw calculated by a yaw gyrosensor.
13. A method of measuring the pose of a mobile robot, comprising:
measuring acceleration of the mobile robot in a forward direction using an accelerometer;
determining, by at least one processor, whether the mobile robot belongs to a uniform motion section, an acceleration section, or a deceleration section; and
calculating a pitch and a roll of the mobile robot in the uniform motion section, using the relationship between the measured acceleration in the forward direction and the acceleration due to gravity, wherein
the accelerometer is mounted to a front end of the mobile robot; and
the calculating includes calculating the pitch in the acceleration and deceleration sections from d/L,
where d is a lifting distance of the mobile robot, and L is the distance from a center of the mobile robot to the accelerometer.
14. The method of claim 13 , further comprising:
detecting the rotational speed of traveling wheels of the mobile robot,
wherein the determining of the section of the mobile robot is performed on the basis of a profile of the rotational speed.
15. The method of claim 13 , further comprising:
calculating the acceleration of the mobile robot in the forward direction in a global coordinate system using the calculated pitch and roll and the measured acceleration in the forward direction.
16. The method of claim 13 , wherein the calculating of the pitch and the roll comprises:
calculating the pitch from arcsin (acc_x/g); and
when the calculated pitch is θ, calculating the roll from arcsin (acc_y/g/cosθ),
where acc_x indicates an acceleration component in the traveling direction of the mobile robot in a local coordinate system, acc_y indicates an acceleration component in a direction vertical to the traveling direction of the mobile robot in the local coordinate system, and g indicates the acceleration due to gravity.
17. A method of measuring the position of a mobile robot, comprising:
measuring acceleration of the mobile robot in a forward direction using an accelerometer;
determining, by at least one processor, whether the mobile robot belongs to a uniform motion section, an acceleration section, or a deceleration section;
calculating a pitch and a roll of the mobile robot in the uniform motion section, using the relationship between the measured acceleration in the forward direction and the acceleration due to gravity;
capturing a ceiling image;
extracting feature points from the captured ceiling image;
compensating for the coordinates of the extracted feature point using the calculated pitch and roll; and
calculating the displacement of the mobile robot on the basis of the feature point whose coordinates have been compensated.
18. The method of claim 17 , further comprising:
calculating acceleration in the forward direction in a global coordinate system, using the calculated pitch and roll and the measured acceleration in the forward direction; and
calculating the height from the mobile robot to the compensated feature point using the moving distance obtained from the calculated acceleration in the forward direction.
19. The method of claim 18 , wherein the calculating of the height comprises:
calculating the height from D*f/x,
where D indicates the moving distance of the mobile robot that is calculated from the acceleration in the forward direction, f indicates. a focal distance, and x indicates the displacement of the feature point in the ceiling image captured by the camera.
20. The method of claim 17 , wherein the calculating of the displacement comprises:
calculating the displacement of the mobile robot from H*f/x,
where H indicates the height of the feature point, f indicates a focal distance, and x indicates the displacement of the feature point in the ceiling image captured by the camera.