Position and posture estimation apparatus of a forklift pallet
A position and posture estimation apparatus includes: a laser sensor configured to be disposed on at least one of left and right sides of a forklift, to emit laser light to a side surface of a pallet lifted by a fork, and to receive reflected light of the laser light and acquire a laser measurement point group; and an estimation calculation unit configured to estimate a position and a posture of the pallet with respect to the fork based on the laser measurement point group acquired by the laser sensor.
1. A position and posture estimation apparatus that estimates a position and a posture of a pallet lifted by a fork of a forklift, comprising:
a first laser sensor disposed on a left side of the forklift and a second laser sensor disposed on a right side of the forklift, which emit laser light in a direction that is angled inward toward each of a left side surface and a right side surface of the pallet lifted by the fork, and receive reflected light of the laser light to acquire laser measurement points,
wherein a distance between the first laser sensor and the second laser sensor disposed on the left side and the right side of the forklift is longer than a distance between the left side surface and the right side surface of the pallet lifted by the fork;
wherein each of the left side surface and the right side surface of the pallet, which receive the emitted laser light from the first and second laser sensors, is an outer side surface which forms an outer contour of the pallet; and
a processor, and a memory that stores a program that is executed by the processor, wherein the processor is programmed to:
extract only the laser measurement points corresponding to the reflected light reflected from the right side surface and the left side surface of the pallet to acquire a laser measurement point group,
remove outliers in the laser measurement point group, wherein the outliers are laser measurement points in the laser measurement point group which deviate from an average value of the extracted laser measurement points by at least two standard deviations,
estimate the position and the posture of the pallet with respect to the fork based on the laser measurement point group from which the outliers have been removed.
2. The position and posture estimation apparatus according to claim 1 ,
wherein processor is further programmed to calculate a function representing a relationship between the extracted laser measurement points in the laser measurement point group from which the outliers have been removed.
3. The position and posture estimation apparatus according to claim 1 , wherein the processor is further programmed to:
control a lift cylinder that moves the fork up and down,
wherein the lift cylinder is controlled such that the pallet moves up and down to a height position corresponding to a height position of the first and second laser sensors.