JPH07108480A - Posture and angle control device of manipulator - Google Patents

Abstract

PURPOSE:To realize the improvement of the accuracy of the posture and the angle control of a manipulator at a low cost. CONSTITUTION:The first arm of a working machine 21 is made in a four joint link mechanism 7, and the joints 7c and 7d of one end of the first arm 7 of the four joint link are provided rotatable on a base board 2, while two joints 7a and 7b at the other end of the first arm 7 are provided rotatable to a bracket 5, and furthermore, one ends 12a and 12b of the second arm 12 of the working machine 21, and one end 9a of an actuator 9 to drive the second arm 12, are provided rotatable to the bracket 5. And the first rotating angle sensor 22 to detect the rotating angle of the first arm 7, and the second rotating angle sensor 23 to detect the rotating angle of the second arm 12 are provided to the bracket 5.

Description

Detailed Description of the Invention

[0001]

BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a manipulator for operating a working machine in response to an operation of a control lever, and more particularly to a device for controlling a posture angle of the working machine.

[0002]

2. Description of the Related Art In a master-slave type manipulator in which a control lever similar to a working machine serves as a master and a working machine serves as a slave, a slave target posture corresponding to an operating angle of the control lever is used. The posture angle of the working machine is controlled so that the deviation between the angle and the current posture angle of the working machine becomes zero.

In this case, it is necessary to detect the posture angle of the working machine, that is, the rotation angle of each arm constituting the working machine by an angle sensor such as a potentiometer.

By the way, a conventional manipulator working machine, in particular, a self-supporting mobile manipulator working machine for performing outdoor civil works has a configuration as shown in FIG.

That is, the boom of the working machine (first arm)
An arm (second arm) c is attached to the tip of a, and a cylinder d that drives the arm c is also attached to the boom a. Therefore, when the boom a is driven by the boom cylinder b, the posture of the arm c changes in a large arc even though the arm cylinder d is not operated. Therefore, the inertial mass load applied to the boom cylinder b becomes extremely large, and it is difficult to realize good controllability.

Further, in the working machine having such a structure, the potentiometer for detecting the rotation angle of the boom c cannot be mounted on any place other than the root of the boom c. However, the root part of the boom c is located inside the revo frame, and the space is poor in maintainability, which makes adjustment work difficult. Further, a dedicated revo frame must be designed so that the potentiometer does not interfere with other parts, which inevitably leads to high cost.

The first invention of the present invention has been made in view of the above circumstances, and reduces the inertial mass load applied to the actuator for driving the first arm, thereby accurately controlling the attitude angle of the working machine. The purpose is to make it possible to detect the posture angle of the working machine with good maintainability and at low cost.

By the way, again, it is composed of a plurality of arms,
When operating a work machine with multiple degrees of freedom, prepare a control lever (master) that has a similar shape to the work machine (slave), and operate the control lever within an operation range similar to the working range of the work machine. It is effective to operate the to improve operability.

However, the operating range of the control lever, which does not impose a burden on the operator and can be operated reasonably, and the operating range required for the working machine are not always similar,
When the lever operation range is intentionally dissimilar, the load on the operator is reduced, the operability is improved, and the control accuracy may be improved.

Therefore, a concrete example of the conventional "non-similarization" for the control lever 14 having the two degrees of freedom in the plane and the working machine 21 composed of the first arm 3 (3 ') and the second arm 8 (8'). An example is shown in FIG.

That is, as shown in FIG. 1, 1) Attitude angle (operation amount) of the first arm 3'of the master 14
α and the attitude angle (operation amount) γ of the second arm 8 ′ are detected,
These detected values α and γ are added to the angle / coordinate conversion unit 25, and the angle / coordinate conversion unit 25 performs calculation to convert the coordinate positions xm and ym of the tip of the master 14.

2) Coordinate positions xm and ym at the tip of the master 21
Is added to the master / slave coordinate conversion unit 26, and calculation is performed in the master / slave coordinate conversion unit 26 to convert the target coordinate positions xs and ys at the tip of the slave 21.

3) Slave 21 tip target coordinate position x
s and ys are added to the coordinate / angle conversion unit 27, and the target posture angle βd of the slave 21 is calculated in the coordinate / angle conversion unit 27.
An operation for converting into δd is performed.

4) The attitude angle β of the first arm 3 and the attitude angle δ of the second arm 8 of the slave 21 are detected, and the detected current slave attitude angles β, δ and the target attitude angle βd,
δd is compared with each, the respective deviations are obtained, and a drive command value corresponding to each deviation is output to the drive system of the slave 21.

In this control device, the operation amounts α and β of the master 14 are set within a desired operation range, and the conversion units 25, so that the slave 21 performs a desired operation within the set operation range. A conversion operation is performed at 26 and 27.

However, in the processing of 1) above, it is necessary to solve the forward kinematics problem, and in the processing of 3) above, it is necessary to solve the inverse kinematics problem. Therefore, complicated calculation is required, and the load on the computer is reduced. It requires a large amount of time for calculation.
For this reason, it is inevitable to use a CPU with a high computing ability, which inevitably leads to high cost.

The second invention of the present invention has been made in view of the above circumstances, and "dissimilarity" is realized without requiring complicated calculation to improve operability, that is, control accuracy. The purpose is to realize improvement at low cost.

As described above, the first and second aspects of the present invention relate to an attitude angle control device for a working machine of a manipulator, and a common problem to be solved is to realize improvement in control accuracy at low cost. It is a thing.

[0019]

Therefore, the first aspect of the present invention
In the main invention of the invention, in a posture angle control device of a manipulator for controlling the posture angle of the working machine based on the operation angle of the control lever and the current posture angle of the working machine,
The first arm of the working machine is a four-node link mechanism, and two nodes at one end of the first arm are rotatably arranged on a base, and two nodes at the other end of the first arm serve as a bracket. A working machine is provided that is rotatably disposed, and one end of a second arm of the working machine and one end of an actuator that drives the second arm are rotatably disposed on the bracket. A first rotation angle sensor for detecting a rotation angle of the first arm is arranged on the first arm attachment portion of the bracket, and a rotation angle of the second arm is detected on the second arm attachment portion of the bracket. A second rotation angle sensor for controlling the posture angle of the working machine based on each rotation angle detected by the first and second rotation angle sensors and the operation angle of the control lever. I have to.

Further, in the main invention of the second aspect of the present invention, a master / slave which controls to change the posture angle of the working machine provided on the slave side in accordance with the operation angle of the control lever provided on the master side. In a posture angle control device for a system manipulator, a plurality of different operation angles are extracted from a desired operation range of the control lever, and the work machine is desired when the control lever is operated in the desired operation range. Interpolating means for associating the extracted plurality of operation angles with the posture angles of the working machine and interpolating between the associated plurality of angles so as to operate in the operation range of Storage means for storing a correspondence relationship between a steering lever operation angle in the desired operation range and a work machine posture angle in the desired operation range, which is obtained by interpolation by The posture angle of the working machine corresponding to the current operation angle of the bar is obtained based on the correspondence relationship stored in the storage means, and the posture angle of the working machine is controlled so that the obtained posture angle is obtained. And control means.

[0021]

According to the structure of the first invention, as shown in FIG. 2, the first arm of the working machine 21 is the four-node link mechanism 7, and the two-node of one end of the first arm 7 of the four-node link is used. 7
c and 7d are rotatably disposed on the base 2a, and the two nodes 7a and 7b at the other end of the first arm 7 are rotatably disposed on the bracket 5. One ends 12a and 12b of the two arms 12 and the second arm 12
One end 9a of the actuator 9 that drives the bracket 5
It is rotatably mounted on the.

The bracket 5 has a first rotation angle sensor 22 for detecting the rotation angle of the first arm 7 and a second rotation angle sensor 2 for detecting the rotation angle of the second arm 12.
And 3 are provided. In this way, the rotation angle sensor is not arranged at the base of the first arm 7. Where the first
Even if the arm 7 rotates, the posture of the bracket 5 does not change because it is a four-node link mechanism. Therefore,
The angle sensor 22 provided on the bracket 5 can detect the relative rotation angle β of the first arm 7 with respect to the bracket 5.

Then, the attitude angle of the working machine 21 is controlled based on the respective rotation angles detected by the first and second rotation angle sensors 22 and 23 and the operation angle of the control lever.

Further, according to the configuration of the second aspect of the invention, as shown in FIGS. 4, 5 and 6, a plurality of operation angles α different from the desired operation range αmin to αmax of the control lever 14.
1, α2, α3 are extracted, and a plurality of extracted operation angles so that the work implement 21 operates in the desired operation range βmin to βmax when the control lever 14 is operated in the desired operation range αmin to αmax. The α1, α2, α3 are associated with the posture angles β1, β2, β3 of the work machine 21, and the associated angles are interpolated to obtain the association L1 or L2. Then, the desired operation range αmin to α
Control lever operating angle of max and desired operating range βmin to βmax
The corresponding relationship L1 or L2 with the working machine posture angle is stored in the storage means 24.

Then, the current operating angle α of the control lever 14
The attitude angle βd of the working machine corresponding to
The posture angle of the working machine 21 is controlled so that the determined posture angle βd can be obtained based on the correspondence L1 or L2 stored in the table.

As described above, according to the second aspect of the present invention, the correspondences L1 and L2 need only be found and stored in advance and read out, and no complicated calculation is required.

[0027]

DESCRIPTION OF THE PREFERRED EMBODIMENTS Embodiments of a manipulator attitude angle control apparatus according to the present invention will be described below with reference to the drawings.

FIG. 1 is a view showing the structure of a self-supporting movable manipulator for performing a predetermined work. FIG. 1 (a) is a front view, and FIG. 1 (b) is a view from the top of FIG. 1 (a). The figure is shown. Now, as shown in FIG. 1, the manipulator is roughly composed of a moving carriage 1, an upper swing body 2 on which a master control lever 14 is arranged, and a working machine 21 which is a slave. ing.

That is, an upper swing body 2 is rotatably mounted on a crawler-type movable carriage 1, and a boom, that is, a first arm 3 is mounted on a support member 2a which is integral with the swing body 2. One end 7c and one end 4a of the first arm drive cylinder 4 that rotationally drives the first arm 3 are attached so that the first arm 3 and the drive cylinder 4 are rotatable. The tip 7a of the first arm 3 is connected to the intermediate bracket 5 so that the first arm 3 can rotate.

On the other hand, the first link 6 is mounted on the support member 2a and the bracket 5 in the same manner as the first arm 3 so as to be parallel to the first arm 3. That is, the first
One end 7d of the link 6 is attached to the support member 2a, and the other end 7b of the first link 6 is attached to the bracket 5 so that the first link 6 is rotatable.

As described above, the four nodes 7a are formed by the first arm 3, the first link 6, the support member 2a, and the bracket 5.
A vertical link 7, which is a parallel link mechanism of ~ 7d, is configured.

Further, on the intermediate bracket 5, one end 12a of the second arm 8 and one end 9a of the second arm drive cylinder 9 for rotationally driving the second arm 8 connect the second arm 8 and the drive cylinder 9. Each is attached so as to be rotatable. The tip 12c of the second arm 8 is connected to the tip bracket 10 so that the arm 8 can rotate.

On the other hand, the second link 11 is attached to the intermediate bracket 5 and the tip bracket 10 in the same manner as the second arm 8 so as to be parallel to the second arm 8. That is, one end 12b of the second link 11 is attached to the intermediate bracket 5, and the other end 12d of the second link 11 is attached to the tip bracket 10 so that the second link 11 is rotatable.

As described above, the second arm 8, the second link 11, the intermediate bracket 5, and the tip bracket 10 are also the same as the vertical link 7, and the four nodes 12a to 12d.
The horizontal link 12 which is a parallel link mechanism of is constructed.

A hand 13 is rotatably mounted on the tip bracket 10 of the horizontal link 12, and a predetermined work is performed by gripping a work with the hand 13.

Further, the revolving structure 2 is provided with a control lever 1
4, the cockpit 15, the engine 16, the hydraulic pump 17, and other equipment necessary for running and operating the working machine. In FIG. 2, it is assumed that the moving carriage 1 is of the crawler type, but of course, it may be of the tire type.

Here, the working machine 21 is controlled by using the control lever 14 as a master and the working machine 21 as a slave.
A known master / slave method is used. And
Control of the attitude angle of the working machine 21 by the master / slave method, that is, the rotation angles of the first arm 3 and the second arm 8 is generally performed by feeding back these rotation angles.

Therefore, in order to detect the feedback amount,
A potentiometer 22 for detecting a rotation angle β of the first arm 3 is arranged at the first arm 3 attachment portion (rotation fulcrum) 7a of the outer surface 5a of the intermediate bracket 5, and a second arm of the outer surface 5a is also provided. Arm 8 attachment part (rotation fulcrum) 12
A potentiometer 23 for detecting the rotation angle δ of the second arm 8 is provided at a.

Now, when the first arm drive cylinder 4 is expanded and contracted, as shown in FIG. 2, since the vertical link 7 is a parallel link mechanism, even if the posture of the first arm 3 is changed, the intermediate The posture of the bracket 5 does not change. Therefore, the second arm 8 is moved up and down while maintaining the parallel state.

As described above, since the attitude of the bracket 5 does not change and only the attitude of the first arm 3 changes, the potentiometer 22 arranged on the bracket 5 allows
The relative rotation angle β of the first arm 3 with respect to the bracket 5 can be detected. On the other hand, the potentiometer 23 disposed on the bracket 5 also causes the bracket 5
The relative rotation angle δ of the second arm 3 with respect to is detected.

According to the working machine 21 having the above structure,
Since it is not necessary to dispose a potentiometer at the base of the vertical link 7, the maintainability is improved, adjustment can be performed easily, and a dedicated revo frame is prepared to prevent interference with other parts. Since it is not necessary to use a general-purpose frame as it is, the cost can be kept low.

Then, these potentiometers 22, 2
The attitude angle of the working machine 21 is controlled as described below based on the deviation between the rotation angles β and δ detected in 3 and the target attitude angle corresponding to the operation angle of the control lever 14.

By the way, the loci of the center of gravity W1 of the first arm 3 and the center of gravity W2 of the second arm 8 are shown by the alternate long and short dash line in FIG. 2. At this time, the moment of inertia J acting on the first arm drive cylinder 4 is given. Is J = (W1 / g) * r * 2 + (W2 / g) * R * 2 (1). In addition, "* 2" is defined to mean "square" (the same applies hereinafter), while the center of gravity W1 'and the arm of the boom (first arm) a of the working machine of the conventional structure are The locus of the center of gravity W2 'of the (second arm) c is as shown by the alternate long and short dash line in FIG. 7, and the moment of inertia J'acting on the boom cylinder (first arm driving cylinder) b at this time is J'. = (W1 '/ g) * r * 2 + (W2' / g) * (r1) * 2 (2)

Comparing these equations (1) and (2), since R <r1 is usually satisfied, R * 2 << (r1) * 2 is established, and thus J << J ', and when the first arm 3 rotates. The moment of inertia acting on the first arm drive cylinder 4 is extremely smaller than that of a work machine having a conventional structure. Therefore, the inertial load is reduced and the control accuracy is improved. As described above, according to this embodiment, the cost can be reduced and the attitude angle can be accurately controlled.

Now, FIG. 3 is a diagram showing another embodiment, showing only the components of the working machine 21 '. In addition,
Those having the same reference numerals as those in FIG. 1 have the same functions. That is, in FIG. 3, only the portion corresponding to the first arm 3 is configured by the parallel link 7 having four nodes, and the portion corresponding to the second arm 8 is a general configuration without a link configuration. A tip bracket drive cylinder 20 for rotating the bracket 10 is connected to the second arm 8.

In the embodiment described above, the potentiometers 22 and 23 are mounted on the same surface 5 on one side of the intermediate bracket 5.
Although it is mounted on a, the mounting surface may be different.

Further, in the embodiment described above, the working machine 2
1 is controlled by the control lever 14 as the master and the work machine 21
It is assumed that the operation is performed by a known master-slave method, in which the manipulator in general,
That is, "a handling instrument, device or machine having a grip or a work head, which allows for tangible movements and changes of direction in space, such movements and changes being optionally controlled by means remote from the head."
The present invention is not limited to the master-slave manipulator in which “both the control unit and the controlled unit make corresponding spatial movements”.

Next, the control of the attitude angle of the manipulator having the working machine having the above-described structure will be described with reference to FIGS.

Here, the master control lever 14 is
As shown in FIG. 4, the first arm 3 ′ and the second arm 8 ′ having similar shapes to the first arm 3 and the second arm 8 of the work machine 21.
have. Therefore, the first arm 3 of the control lever 14
By rotating ′ by the operation amount (posture angle) α, the first arm 3 of the work machine 21 rotates by the angle β corresponding to the operation angle α, and the posture angle is changed. Similarly, the second arm 8 ′ of the control lever 14 is rotated by the operation amount (posture angle) γ, whereby the second arm 8 of the work machine 21 is rotated by the angle δ according to the operation angle γ. Then, the posture angle is changed. Since the control contents of the first arm 3 and the second arm 8 are the same, only the first arm 3 will be described below as a representative.

Before the control is started, the following processing is performed as preprocessing.

That is, first, a desired operation range αmin to αmax is determined for the first arm 3'of the control lever 14. The criterion for this decision is that it does not impose a burden on the operator and that the operator can operate it comfortably. In addition, FIG.
As shown separately from (a) and (b), the operation range can be changed according to the type of work performed by the work machine 21.

Next, the desired operation range αmin to αmax
A plurality of different operation angles α1, α2, α3 are extracted from among the above (see FIG. 5). On the other hand, the desired operation range βmin to βmax of the first arm 3 of the work machine 21 is determined.
Also in this case, as shown in FIGS. 6 (a) and 6 (b),
The operation range can be changed according to the type of work performed by the work machine 21.

Therefore, the first arm 3'of the control lever 14
Is operated in the desired operating range αmin to αmax, the first arm 3 of the work implement 21 operates in the desired operating range βmin to βm.
To operate at ax, each operation angle α1, extracted above,
The α2, α3 and the posture angles β1, β2, β3 of the working machine 21 are associated with each other as shown by the broken lines in FIGS. 5 and 6.

Then, an operation for interpolating between the plurality of associated angles is performed, and the calculation is performed as shown in FIG.
As shown in, the predetermined correspondence L1 or L2 is obtained. Here, the method of interpolation can be different according to the type of work.

FIG. 6 (a) shows an interpolation method which emphasizes fine operability in the vicinity where the operation angle of the control lever 14 is α1, while FIG. 6 (b) shows operation angles near α1, α3. This is a method of interpolation for reducing the speed of the work machine, and correspondences L1 and L2 of different characteristics are obtained according to the work content.

As described above, the desired operation range αmin
αmax control lever operating angle and desired operating range βmin to βma
When the correspondence L1 or L2 with respect to the work machine posture angle of x is obtained, these correspondences L1 and L2 are stored in the table 24 in association with work types, for example, work mode 1 and work mode 2, respectively. .

The preprocessing is completed as described above.

Hereinafter, the control content of the posture angle after the completion of the preprocessing will be described with reference to the control block diagram shown in FIG.

First, the operator operates a selection switch (not shown) to select a work mode suitable for the current work content. Now, as the working mode, the above correspondence L1
It is assumed that the work mode 1 corresponding to is selected.

On the other hand, a current operation angle α of the first arm 3'is detected by a potentiometer (not shown) attached to the control lever 14, and the first arm of the working machine 21 corresponding to the current operation angle α is detected. The target posture angle βd of 3 is
It is obtained based on the correspondence relationship stored in the table 24. In this case, since the work mode 1 is currently selected, the correspondence L1 corresponding to the selected work mode 1 is read from the table 24, and the target posture angle βd is obtained based on this correspondence L1. To be

Next, the obtained target posture angle βd
The posture angle of the first arm 3 of the work machine 21 is controlled so that That is, the current rotation angle β of the first arm 3 is detected by the potentiometer 22, the detected value β is used as the feedback amount, the deviation between the target value βd and the feedback amount β is obtained, and this is It is added to the gain multiplication unit 25. Gain multiplication unit 2
In step 5, the deviation βd−β is multiplied by a predetermined gain K, and the drive command value corresponding to the deviation βd−β multiplied by the predetermined gain K is
It is added to a drive control unit (not shown). In this drive control unit, the drive cylinder 4 of the work machine 21 is moved to the above deviation βd−β.
Drive so that becomes zero.

As described above, according to this embodiment, the correspondences L1 and L2 are obtained in advance, these are stored in the table 24, and it is only necessary to read them out, and control is performed without requiring complicated calculation. It Therefore, since the load on the computer is reduced, it is not necessary to prepare a CPU having high calculation ability, and the cost is dramatically reduced.

Further, the time required for the arithmetic processing can be greatly reduced.

Since the operating range of the control lever 14 is set within a range that the operator can operate without difficulty,
Operability is improved, and the accuracy of posture angle control can be improved.

Further, since the operation is performed according to the operation characteristic suitable for the type of work, the operability is improved and the accuracy of the posture angle control is improved.

Although the control of the first arm 3 has been described as a representative in this embodiment, the control of the second arm 8 can be performed in the same manner as described above.

As the method of storing the correspondences L1 and L2 in the table 24, they may be stored in the form of a mathematical expression such as a function, or may be stored as a numerical table. However,
The method of storing as a numerical table and directly reading βd from the input value α is stored in the form of a mathematical expression such as a function, and βd (function value) is calculated from the input value α (variable). The effect is that the calculation time can be shortened more than the method.

In this embodiment, the manipulator having the working machine 21 having the structure shown in FIG.
Although the case where the posture angle control shown in FIG. 4 is performed has been described, the configuration of the working machine when performing the posture angle control in FIG. 4 is arbitrary, and may be the configuration shown in FIG. 3, for example. It may have the configuration shown in FIG. 7.

[0069]

As described above, according to the present invention, since the first arm of the manipulator working machine has the four-node link structure, the arm rotation angle sensor is provided not at the arm root portion but at the arm tip portion. can do. As a result, the load applied to the actuator that drives the arm can be reduced, control can be performed accurately, and a dedicated levo frame is required as in the case where a sensor is provided at the base portion, which reduces maintainability. The cost is dramatically reduced and the maintainability is dramatically improved.

Further, according to the present invention, the operation range of the control lever can be set to a desired range, and calculation at the time of control becomes unnecessary. As a result, the control accuracy is improved due to the improved operability, and a computer having a high calculation capability is not required, so that the cost is drastically reduced. In addition, the arithmetic processing capacity is also dramatically improved.

[Brief description of drawings]

1A and 1B are a front view and a top view showing a configuration of a self-standing manipulator which is an embodiment of a posture angle control device for a manipulator according to the present invention.

FIG. 2 is a diagram showing a configuration of a working machine of the manipulator shown in FIG. 1 and a diagram for explaining the movement thereof.

FIG. 3 is a diagram showing another configuration example of the work machine shown in FIG. 1.

FIG. 4 is a control block diagram showing a configuration of a control device which is an embodiment of the attitude angle control device for a master / slave manipulator according to the present invention.

5 is a diagram for explaining the contents stored in the table shown in FIG. 4, and is a diagram showing the correspondence between the operation angle of the master and the posture angle of the slave by the posture of the arm.

6A and 6B are views for explaining the contents stored in the table shown in FIG. 4, and are graphs showing the correspondence between the operation angle of the master and the attitude angle of the slave. Is.

FIG. 7 is a diagram showing a configuration of a conventional working machine.

FIG. 8 is a control block diagram showing a configuration of a conventional control device.

[Explanation of symbols]

 3 1st arm 4 1st arm drive cylinder 5 Intermediate bracket 6 1st link 7 Vertical link 8 2nd arm 9 2nd arm drive cylinder 14 Steering lever 21 Working machine 22 Potentiometer 23 Potentiometer 24 Table

Front page continuation (72) Inventor Kazuhiko Otsubo 1200 Manda, Hiratsuka-shi, Kanagawa Central Research Laboratory, Komatsu Ltd. (72) Minor Oura 23 Tsutsumachi, Komatsu-shi, Ishikawa Prefecture Komatsu Manufacturing Awazu Plant Co., Ltd. (72) Inventor, Ikuo Kita, 23, Tsutsu, Otsu, Komatsu, Ishikawa Prefecture Komatsu Ltd., Awazu Plant (72) Inventor, Shinji Takeuchi, 9-406, Imaicho, Komatsu, Ishikawa Prefecture

Claims (7)

[Claims] 1. A posture angle control device for a manipulator for controlling a posture angle of a working machine based on an operation angle of a control lever and a current posture angle of the working machine, wherein a first arm of the working machine has a four-node link. As a mechanism, two nodes at one end of the first arm are rotatably arranged on a base, and two nodes at the other end of the first arm are rotatably arranged on a bracket. A working machine configured to rotatably dispose one end of a second arm of the machine and one end of an actuator that drives the second arm on the bracket is provided, and A first rotation angle sensor for detecting a rotation angle of one arm is provided, and the second arm mounting portion of the bracket is provided with the second rotation angle sensor.
A second rotation angle sensor for detecting the rotation angle of the arm is provided, and the second rotation angle sensor detects the rotation angle of the working machine based on each rotation angle detected by the first and second rotation angle sensors and the operation angle of the control lever. A posture angle control device for a manipulator configured to control a posture angle. 2. The attitude angle control device for a manipulator according to claim 1, wherein the first and second rotation angle sensors are arranged on the same outer surface of the bracket. 3. A posture angle control device for a manipulator, which controls a posture angle of a working machine based on an operation angle of a control lever and a current posture angle of the working machine, wherein a first arm of the working machine has a four-node link. As a mechanism, two nodes at one end of the first arm are rotatably arranged on a base, and two nodes at the other end of the first arm are rotatably arranged on a bracket. A working machine configured to rotatably dispose one end of a second arm of the machine and one end of an actuator that drives the second arm on the bracket, and detects a rotation angle of the first arm. And a second rotation angle sensor for detecting the rotation angle of the second arm, and the respective rotation angles detected by the first and second rotation angle sensors and Control A posture angle control device for a manipulator configured to control the posture angle of the working machine based on an operation angle of a bar. 4. A posture angle control device for a master / slave manipulator, which controls the posture angle of a working machine provided on the slave side in accordance with an operation angle of a control lever provided on the master side. A plurality of different operation angles are extracted from the desired operation range of the lever, and when the operating lever is operated in the desired operation range, the working machine is operated so as to operate in the desired operation range. A plurality of operation angles and the posture angle of the work machine are associated with each other, and an interpolating means for interpolating between the associated plurality of angles; and the operation of the desired operation range obtained by the interpolation by the interpolating means. Storage means for storing a correspondence relationship between a lever operation angle and a work machine posture angle in the desired operation range, and a working machine corresponding to a current operation angle of the control lever A master unit including a control unit that determines a bias angle based on the correspondence relationship stored in the storage unit and controls the posture angle of the working machine so as to obtain the determined posture angle.
Attitude angle control device for slave manipulators. 5. The interpolation means performs interpolation according to the type of work performed by the work machine, and the storage means stores the correspondence relationship in association with the work type. When the work type is selected, the control unit reads the correspondence relationship corresponding to the selected work type from the storage content of the storage unit, and performs the work based on the read correspondence relationship. The attitude angle control device for a master-slave manipulator according to claim 4, which controls the attitude angle of the machine. 6. The working machine includes a plurality of arms each having different degrees of freedom, and the control lever operates the plurality of arms separately, and the correspondence relationship is different from each other. The attitude angle control device for a master / slave manipulator according to claim 4, which is obtained for each arm and is stored in the storage means in association with each arm. 7. The working machine has a first arm and a second arm, the first arm is a four-node link mechanism, and two nodes at one end of the first arm are rotatable on a base. And a second node of the other end of the first arm is rotatably disposed on the bracket, and one end of the second arm and one end of an actuator for driving the second arm are rotated around the bracket. The attitude angle control device for a master-slave manipulator according to claim 6, wherein the attitude angle control device is arranged so as to be movable.