Automatic steering method and apparatus for a non- railed transfer crane
First Claim
1. A method for automatically steering a non-railed transfer crane travelling along a lane indicant, comprising the steps of:
- photographing a lane indicant along the crane'"'"'s travelling direction with a photographing unit having a previously set horizontal center line intersecting with a previously set vertical center line to define a video center point and generating an image signal;
calculating an actual deviation distance between said video center point and the lane indicant; and
generating a motor control signal for controlling the rotation of a motor which drives wheels of the crane so that the crane travels toward minimizing said calculated actual deviation distance wherein said generating step further comprises the sub-steps ofcalculating a differential deviation distance δ
E equal to the difference between said calculated actual deviation distance and a reference deviation distance, andcalculating a voltage signal Vref '"'"' for controlling said motor so that said differential deviation distance can approach zero, wherein said voltage signal Vref '"'"' is calculated with the following equation;
##EQU2## wherein Kp represents a proportionality constant having units of voltage per differential deviation distance;
Kv represents a differential constant having units of voltage per time variation of differential deviation distance;
Ki represents an integral constant having units of voltage per accumulated values of differential deviation distance; and
Δ
T represents a sampling period having units of time.
0 Assignments
0 Petitions
Accused Products
Abstract
The present invention relates to an automatic system for controlling the steering of a non-railed transfer crane travelling along a lane indicant. The system comprises a vision sensor for continuously photographing the condition of a crane'"'"'s actual travelling direction with respect to lanes represented by the lane indicant, and outputting predetermined deviations (distance as well as angle) showing off-centered degrees between the crane'"'"'s actual travelling direction and the lanes based on the photographed image signal, and a deviation processor for outputting a control signal to a motor driver so that the crane can travel toward removing the deviation distance. By properly changing a rotative velocity of the crane'"'"'s wheels, the present invention prevents the crane'"'"'s travelling direction from being off-centered from the lanes.
-
Citations
3 Claims
-
1. A method for automatically steering a non-railed transfer crane travelling along a lane indicant, comprising the steps of:
-
photographing a lane indicant along the crane'"'"'s travelling direction with a photographing unit having a previously set horizontal center line intersecting with a previously set vertical center line to define a video center point and generating an image signal; calculating an actual deviation distance between said video center point and the lane indicant; and generating a motor control signal for controlling the rotation of a motor which drives wheels of the crane so that the crane travels toward minimizing said calculated actual deviation distance wherein said generating step further comprises the sub-steps of calculating a differential deviation distance δ
E equal to the difference between said calculated actual deviation distance and a reference deviation distance, andcalculating a voltage signal Vref '"'"' for controlling said motor so that said differential deviation distance can approach zero, wherein said voltage signal Vref '"'"' is calculated with the following equation;
##EQU2## wherein Kp represents a proportionality constant having units of voltage per differential deviation distance;Kv represents a differential constant having units of voltage per time variation of differential deviation distance; Ki represents an integral constant having units of voltage per accumulated values of differential deviation distance; and Δ
T represents a sampling period having units of time.
-
-
2. An automatic steering apparatus for controlling a non-railed transfer crane travelling along a lane indicant defining a lane, comprising:
-
a camera having a photographing unit for continuously photographing an off-centered condition between the direction of travel of said crane and said lane during the travel of said crane, said photographing unit having a previously set horizontal line intersecting with a previously set vertical line to define a video center point at said intersection; means for converting a video signal input from said camera into a digital image signal; means for calculating an actual deviation distance between said video center point and said lane indicant from said image signal; a deviation processor for receiving the calculated actual deviation distance from said calculating means, said deviation processor calculating a differential deviation distance δ
E equal to the difference between said calculated actual deviation distance and a reference deviation distance, calculating a voltage signal Vref '"'"' so that said differential deviation distance can approach zero, and generating a control signal based upon said calculated voltage signal to control a motor which drives wheels of said crane to travel toward minimizing the actual deviation distance; anda motor driver for controlling said motor according to the control signal supplied from said deviation processor, wherein said voltage signal Vref '"'"' is calculated with the following equation;
##EQU3## wherein Kp represents a proportionality constant having units of voltage per differential deviation distance;Kv represents a differential constant having units of voltage per time variation of differential deviation distance; Ki represents an integral constant having units of voltage per accumulated values of differential deviation distance; and Δ
T represents a sampling period having units of time. - View Dependent Claims (3)
-
Specification