US 4,910,673 AGranted

Apparatus for controlling arm movement of industrial vehicle

AssigneeHitachi Construction Machinery Co., Ltd.

InventorsJunichi Narisawa, Kenichiro Date, Kenichi Miyata, Yuhei Sato

Life of this patent

Estimating the term…

Loading patent…

Abstract

In an industrial vehicle having at least first and second arms rotatably coupled to each other, a locus depicted by a tip of the second arm during rotation of the first and second arms is controlled. An amount of positional deviation of the tip of the second arm in the direction (compensating direction) perpendicular to the direction of the targeted locus (operating direction) is detected. A command value for the compensating velocity is determined from a command value for the operating velocity and the deviation. The driving of the first and second arms is controlled by the two velocity command values in the operating and compensating directions in such a manner that the tip of the second arm moves along the targeted locus. In short, positional feedback is provided by means of the positional deviation in the direction perpendicular to the targeted locus. In addition, the direction of the targeted locus is set as the direction of installation of an operating attachment mounted on the tip of the second arm. In an industrial vehicle further having a third arm, the second and third arms are driven in such a manner that the tip of the third arm will not deviate from the targeted locus as a result of the rotation of the first arm. At this juncture, the aforementioned feedback is also provided.

Claims22

Dependent claims

An apparatus for controlling the arm movement of an industrial vehicle having at least first and second arms whose movement is controlled so that a tip of said second arm moves along a targeted locus, first and second driving means for respectively rotatively moving said arms, and an operating attachment installed at the tip of said second arm, said apparatus comprising:

means for setting the direction of said targeted locus along which said tip of said second arm is moved;
arm angle detecting means for detecting angles related to said first and second arms;
position detecting means for detecting the position of said tip of said second arm;
commanding means for commanding an operating velocity of said tip of said second arm along said targeted locus;
deviation calculating means for calculating an amount of deviation of the position of the tip of said second arm in a direction perpendicular to a direction of said targeted locus from said targeted locus, on the basis of the detected position of said tip of said second arm;
means for calculating a command value for the compensating velocity in the direction perpendicular to said targeted locus on the basis of said amount of deviation and said command value for said operating velocity;
means for calculating the rotating velocity of said first and second arms in such a manner that said tip of said second arm moves at said commanded operating velocity along said targeted locus on the basis of said angles related to said first and second arms, said command value of said operating velocity, said command value for the compensating velocity, and said direction of said targeted locus;
and
means for controlling the driving of said first and second driving means to ensure that rotating velocities of said first and second arms become identical with the rotational velocities calculated by said rotating velocity calculating means, respectively.

6 more elements

An apparatus for controlling the arm movement of an industrial vehicle having at least first, second, and third arms whose movement is controlled so that a tip of said third arm moves along a targeted locus, first, second, and third driving means for respectively rotatively moving said arms, and an operating attachment installed at the tip of said third arm, said apparatus comprising:

angle detecting means for detecting angles related to said first, second, and third arms;
position detecting means for detecting a position of said tip of said third arm;
means for commanding the operating velocity of said tip of said third arm along said targeted locus;
deviation calculating means for calculating an amount of deviation of the position of the tip of said third arm in a direction perpendicular to a direction of said targeted locus from said targeted locus, on the basis of the detected position of said tip of said third arm;
first means for calculating a command value for the compensating velocity for calcuating a first command value for the compensating velocity in a direction perpendicular to said targeted locus on the basis of said amount of deviation and said command value for said operating velocity;
second means for calculating a command value for the compensating velocity for calculating a second command value for the compensating velocity in the direction perpendicular to said targeted locus on the basis of said command value for said operating velocity and said position of said tip of said third arm;
first means for calculating the rotating velocity of said first arm on the basis of said command value for said operating velocity and said position of said tip of said third arm in such a manner that the moving velocity of said tip of said third arm in the direction of said targeted locus corresponds to said command value for said operating velocity;
second means for calculating the rotating velocity for calculating the rotating velocities of said second and third arms on the basis of said angles related to said second and third arms and said first and second command values for the compensating velocity in such a manner that the moving velocity of said tip of said third arm corresponds to a sum of said first and second command values for the compensating velocity;
and
means for controlling the driving of said first, second, and third driving means to ensure that the rotating velocities of said first, second, and third driving means become identical with that calculated by said first and second means for calculating the rotating velocity, respectively.

7 more elements

An apparatus for controlling the arm movement of an industrial vehicle having at least first, second, and third arms whose movement is controlled so that a tip of said third arm moves along a targeted locus, first, second, and third driving means for respectively rotatively moving said arms, and a operating attachment installed at the tip of said third arm, said apparatus comprising:

angle detecting means for detecting angles related to said first, second, and third arms;
position detecting means for detecting a position of said tip of said third arm;
means for commanding the operating velocity of said tip of said third arm along said targeted locus;
means for selecting either a first locus controlling system in which the position of the tip of said third arm is moved along said targeted locus by driving said second and third arms with said first arm fixed or a second locus controlling system in which the position of the tip of said third arm is moved along said targeted locus by driving said first to third arms;
deviation calculating means for calculating an amount of deviation of the position of the tip of said third arm in a direction perpendicular to a direction of said targeted locus from said targeted locus on the basis of the detected position of said tip of said third arm;
first means for calculating a command value for the compensating velocity for calculating a first command value for the compensating velocity in a direction perpendicular to said targeted locus on the basis of said amount of deviation and said command value for said operating velocity;
second means for calculating a command value for the compensating velocity for calculating a second command value for the compensating velocity in the direction perpendicular to said targeted locus on the basis of said command value for said operating velocity and said position of said tip of said third arm;
first means for calculating the rotating velocity which, when said first locus controlling system has been selected, sets the rotating velocity of said first arm to zero, and which, when said second locus controlling system has been selected, calculates the rotating velocity of said first arm on the basis of said command value for said operating velocity and said position of said tip of said third arm in such a manner that the moving velocity of said tip of said third arm in the direction of said targeted locus corresponds to said command value for said operating velocity;
second means for calculating the rotating velocity which, when said first controlling system has been selected, calculates the rotating velocities of said second and third arms on the basis of said angles related to said second and third arms, said command value for said operating velocity, and said first command value for said compensating velocity in such a manner that the moving velocity of said tip of said third arm corresponds to said first command value for said compensating velocity and said command value for said operating velocity, and which, when said second controlling system has been selected, calculates the rotating velocities of said second and third arms on the basis of said angles related to said second and third arms, said command value for said operating velocity, and said first and second command values for the compensating velocity in such a manner that the moving velocity of said tip of said third arm corresponds to a sum of said first and second command values for the compensating velocity and said command value for said operating velocity;
and
means for controlling the driving of said first, second, and third driving means to ensure that the rotating velocity of said first, second, and third driving means becomes identical with that calculated by said first and second means for calculating the rotating velocity.

8 more elements

Dependencies are inferred from the claim text.