WO2013063901A1

WO2013063901A1 - Action mapping control system and land leveller having same

Info

Publication number: WO2013063901A1
Application number: PCT/CN2012/073894
Authority: WO
Inventors: 周风华; 李志勇; 李航洋
Original assignee: 湖南三一智能控制设备有限公司; 三一重工股份有限公司
Priority date: 2011-11-02
Filing date: 2012-04-12
Publication date: 2013-05-10
Also published as: CN102505719A; CN102505719B

Abstract

An action mapping control system comprises: a handle (11) with a plurality of degrees of freedom of motion, a plurality of sensors and a controller. The plurality of sensors is located on the handle (11) and corresponds to the plurality of degrees of freedom of motion of the handle (11) one by one. Each sensor is used for sensing motion information of the corresponding degree of freedom of the handle (11), and sending the motion information to the controller. The controller controls an operation device to move on the corresponding degree of freedom according to the motion information of the corresponding degree of freedom of the handle (11). Also disclosed is a land leveller having the action mapping control system. By means of the action mapping control system, the actions of the operation device are consistent with operation actions of the handle (11), so the operation difficulty is reduced, and the convenience is improved.

Description

Motion mapping control system and motor grader therewith

This application claims the priority of the Chinese Patent Application entitled "An Action Mapping Control System and a Grader with It", filed on November 2, 2011, with the application number of 201110340540. This is incorporated herein by reference.

Technical field

The present invention relates to the field of construction machinery, and in particular to an action mapping control system and a grader having the same.

Background technique

The grader's blade operation device has six degrees of freedom, namely the blade left lift, the blade right lift, the blade extension, the blade angle, the blade rotation, and the blade work yaw. For the action control of the blade operation device, the conventional method mostly uses the manual link to directly link the hydraulic valve block to achieve the purpose of the corresponding cylinder action. The more advanced control method uses an electronically controlled handle to control the movement of the corresponding cylinder through the function buttons on the electronically controlled handle. However, these control methods require a clear operational identification, and the operator needs to have a wealth of operational experience in order to operate the blade operation device with great precision, and the operation convenience is not high.

Summary of the invention

In order to overcome the above-mentioned deficiencies and deficiencies of the prior art, a first object of the present invention is to provide an easy-to-operate motion mapping control system for controlling the operation of a machine working device, including: a handle having a plurality of degrees of freedom of motion, and more Sensors, controllers; a plurality of sensors are located on the handle and correspond to a plurality of degrees of freedom of movement of the handles; each sensor is used to sense motion information of the handles in corresponding degrees of freedom, and send motion information to the controller The controller is configured to control the working device to move in corresponding degrees of freedom according to the movement information of the handle at the corresponding degree of freedom.

Further, the working device is a blade working device; the controller is configured to drive the blade working device to move in a corresponding degree of freedom by controlling the blade operating device to control the hydraulic cylinder of the corresponding degree of freedom according to the movement information of the handle at the corresponding degree of freedom. .

Further, the handle comprises a base, a handle body connected to the base, and a dialing member mounted on the outer surface of the handle body; the movement freedom of the handle comprises: the left end of the handle body moves up and down relative to the base, and the right end of the handle body is opposite to the base Moving, the handle body moves to the left and right relative to the base, the handle body rotates axially relative to the base, the handle body moves in a rake relative to the base, and the dial moves left and right relative to the handle body. Further, the handle further includes a first link, the handle body is coupled to the base through the first link, and is rotatable with the first link as a rotation axis; the plurality of sensors include a first sensor, and the first sensor is configured to sense the handle The rotation motion information of the body rotating with the first link as a rotation axis; the controller is configured to receive the rotation motion information, and control the blade rotation cylinder according to the rotation motion information to drive the blade rotation motion.

Further, the handle further includes a central shaft, the central shaft is disposed in the base; the first end of the first link is coupled to the central shaft, and can drive the handle body to move around the central axis; the plurality of sensors include the second sensor, the second The sensor is used for sensing the arc motion information of the handle body rotating around the central axis; the controller is configured to receive the arc motion information sent by the second sensor, and control the blade elevation cylinder according to the arc motion information to adjust the blade elevation angle.

Further, the handle further includes a second link, a third link and a fourth link; the handle body is an empty shell structure; the second link is disposed on an inner surface of the handle body; One end of the second link and one end of the fourth link are hinged; the second link, the third link and the fourth link form a zigzag structure; the other end of the fourth link and the second end of the first link Connected, the second end of the first link is located in the housing of the handle body.

Further, the plurality of sensors include a third sensor and a fourth sensor; the third sensor is provided with a movement information; the fourth sensor is disposed at a left end of the third link, and is configured to sense a movement of the right end of the handle body relative to the base Second, the mobile information; the controller is configured to control the blade left lifting cylinder according to the first movement information, and drive the left end of the blade to rise or fall; and is further configured to control the blade right lifting cylinder according to the second movement information to drive the right end of the blade to rise or fall.

Further, the plurality of sensors include a fifth sensor disposed in the central axis, the fifth sensor is configured to sense third movement information of the handle body moving left and right relative to the base; the controller is configured to receive the third movement information, and according to the third The mobile information controls the blade extension cylinder and drives the blade to move left and right.

Further, the plurality of sensors include a sixth sensor disposed on one side of the dial member, and the sixth sensor is configured to sense fourth movement information of the dial member moving left and right relative to the handle body; the controller is configured to receive the fourth movement information, and according to The fourth movement information controls the blade yaw cylinder to drive the blade yaw motion.

The motion mapping control system embodiment of the present invention operates by operating the freedom of the handle The mapping to the working device realizes that the operation of the working device is consistent with the operation of the handle, which can reduce the skill requirements of the operator, reduce the working intensity of the operator, and simplify the operation and improve the operation convenience.

DRAWINGS

1 is a schematic structural view of a first embodiment of a handle in a motion mapping control system according to the present invention; FIG. 2-1 is a schematic structural view of a second embodiment of a handle in a motion mapping control system according to the present invention; FIG. 2-2 is a schematic diagram of FIG. A schematic structural view of a part of the sensor installed in the structure;

Figure 2-3 is a schematic view showing the axial rotation of the handle body relative to the base in Figure 2-1;

Figure 2-4 is a schematic view of the front and rear arc movements of the handle body with respect to the base of Figure 2-1. Figure 2-5 is a schematic view of the left end of the handle body of Figure 2-1 moving up and down relative to the base; Figure 2-6 is Figure 2-5 Schematic diagram of the change in the medium angle α;

Figure 2-7 is a schematic view of the right end of the handle body of Figure 2-1 moving up and down relative to the base; Figure 2-8 is a schematic diagram of the change of the angle β in Figure 2-7;

Figure 2-9 shows the operation of the dialing device in Figure 2-1.

detailed description

The technical solutions in the embodiments of the present invention are clearly and completely described in the following with reference to the accompanying drawings in the embodiments of the present invention. It is obvious that the described embodiments are only a part of the embodiments of the present invention, but not all of the embodiments. All other embodiments obtained by a person of ordinary skill in the art based on the embodiments of the present invention without creative efforts are within the scope of the present invention.

The invention provides a motion mapping control system for a control machine working device, and an embodiment thereof mainly comprises: a handle 11 having a plurality of degrees of motion freedom as shown in FIG. 1 , a plurality of sensors (not shown), and a control The plurality of sensors are located on the handle 11 and correspond to a plurality of degrees of freedom of movement of the handle 11; each sensor is configured to sense motion information of the handle 11 at a corresponding degree of freedom, and The motion information is sent to the controller; the controller is configured to control the working device to move in the corresponding degree of freedom according to the motion information of the handle 11 at the corresponding degree of freedom.

In the following embodiments, the working device is exemplified as a blade working device. As shown in FIG. 1, the handle 11 may include a base 111, a handle body 113 connected to the base 111, and a dial 115 mounted on the outer surface of the handle body 113. Wherein, the degree of freedom of movement of the handle 11 includes: the left end of the handle body 113 moves up and down relative to the base 111 (ie, the direction indicated by the double-headed arrow c in FIG. 1), The right end of the handle body 113 moves up and down relative to the base 111 (ie, the direction indicated by the double arrow d in FIG. 1), the handle body 113 moves left and right relative to the base 111 (ie, the direction indicated by the double arrow e in FIG. 1), and the handle body 113 is opposite. The base 111 rotates axially (ie, the direction indicated by the double arrow a in FIG. 1), the handle body 113 moves forward and backward relative to the base 111 (ie, the direction indicated by the double arrow b in FIG. 1), and the dial 115 is opposite to the handle body 113. Move left and right (ie the direction indicated by the double arrow f in Figure 1). In a specific operation, the handle 11 may further include: a disc 118, which is a transitional joint between the handle body 113 and the base 111, which functions as a blocking engagement and does not participate in the action mapping; on the upper surface of the handle body 113 A grip portion 113a is also provided, in which the thumb of the worker is placed at the position of the dial 115, and the remaining four fingers are placed at the grip portion 113a.

Corresponding to the above six degrees of freedom, six sensors (not shown) are disposed on the handle 11, one-to-one corresponding to the motion information of the sensing handle 11 in each degree of freedom, and the sensed motion information is sent to the control. Device. The controller controls the blade operating device to move the hydraulic control cylinder at the degree of freedom according to the movement information of the handle 11 at a certain degree of freedom, thereby driving the blade operating device to move in corresponding degrees of freedom. For example, the controller controls the blade left lifting cylinder according to the movement information of the lifting and lowering of the left end of the handle 11, and then drives the left end of the blade working device to move up and down.

Preferably, as shown in Fig. 2-1, the handle body 113 is coupled to the base 111 via the first link 117, and is rotatable with the first link 117 as a rotational axis.

Preferably, as shown in FIG. 2-1, the handle 11 further includes a central shaft 119, and the central shaft 119 is disposed in the base 111; the first end of the first link 117 is coupled to the central shaft 119, and can drive the handle body 113 around The center shaft 119 rotates.

Preferably, as shown in FIG. 2-1, the handle 11 further includes a second link 112, a third link 114 and a fourth link 116; the handle body (113) is a hollow shell structure; the second link 112 is disposed at On the inner surface of the handle body 113, the specific mounting position of the second link 112 may be fixed directly below the grip portion 113a; the two ends of the third link 114 and the one end of the second link 112 and the fourth link 116, respectively One end of the second link 112, the third link 114 and the fourth link 116 form a Z-shaped structure; the other end of the fourth link 116 is connected with the second end of the first link 117, the first link The second end of the 117 is located in the housing of the handle body 113.

As shown in FIG. 2-2, the first sensor 13a may be disposed in the first link 117 for sensing rotational motion information of the handle body 113 with the first link 117 as a rotation axis. As shown in Figure 2-3 As shown, when the handle body 113 is in a rotational motion, the handle body 113 is axially rotated relative to the base 111 with the first link 117 as a rotation axis. The first sensor 13a installed at the first link 117 can detect the amount of change of its action (i.e., the change of the angle A1 in FIGS. 2-3), and the first sensor 13a outputs the rotational motion information of the handle body 113 to the controller. After the controller processes and amplifies, the control signal is output to the electromagnetic hydraulic valve, and the electromagnetic hydraulic valve passes through a series of intermediate hydraulic devices to control the rotary cylinder of the blade to realize the rotary motion of the blade.

As shown in Fig. 2-2, the second sensor 13b may be disposed at one end of the central axis 119 for sensing the arc motion information of the handle body 113 rotating about the central axis 119. As shown in FIGS. 2-4, the first link 117 is fixed relative to the handle body 113, and the central shaft 119 can be fixed on the base 111. When the handle body 113 is curved in front and rear, the handle body 113 together with the first link 117 With the arcuate motion relative to the central axis 119, the second sensor 13b mounted at one end of the central axis 119 can detect the amount of change in the motion of the central axis 119 (i.e., the amount of change in the angle A2 shown in FIGS. 2-4, corresponding to the handle body 113 arc motion information), the second sensor 13b outputs the arc motion information of the handle body 113 to the controller, through the controller's operation processing and amplification, outputs a control signal to the electromagnetic hydraulic valve, and the electromagnetic hydraulic valve passes through a series of intermediate hydraulic devices Control the blade elevation cylinder to adjust the blade elevation angle.

As shown in FIG. 2-5, the third sensor may be disposed at a position indicated by "A", that is, at the right end of the second link 112, and the fourth sensor may be disposed at a position indicated by "B", that is, the third link 114. On the left end. As shown in FIG. 2-5 and FIG. 2-6, when the left end of the handle body 113 moves up and down, the second link 112 moves upward or downward with the point A as a fulcrum, and the second link 112 and the third link 114 are moved. The angle α between them will increase or decrease correspondingly, and the angle β of point B will not change. The third sensor installed at point A can detect the amount of change of the action of the second link 112 (corresponding to the first movement information of the up and down movement of the left end of the handle body 113), and the third sensor outputs the first movement information to the controller, after being controlled The operation processing and amplification of the device, the output control signal is sent to the electromagnetic hydraulic valve, and the electromagnetic hydraulic valve passes through a series of intermediate hydraulic devices to control the left lift cylinder of the blade to realize the ascending or descending action of the left end of the blade.

As shown in FIG. 2-7 and FIG. 2-8, when the right end of the handle body 113 moves up and down, the right end of the third link 114 is a force point, and the third link 114 has a point B as a fulcrum, together with the second connection. The rod 112 moves upward or downward as a whole, and the angle β between the third link 114 and the fourth link 64 increases or decreases correspondingly, and the clip between the second link 112 and the third link 114 The angle α does not change. Ann The fourth sensor installed at point B can detect the change amount of the movement of the third link 114 (corresponding to the second movement information of the up and down movement of the right end of the handle body 113), and the fourth sensor outputs the second movement information to the controller, after being controlled The operation processing and amplification of the device, the output control signal is sent to the electromagnetic hydraulic valve, and the electromagnetic hydraulic valve passes through a series of intermediate hydraulic devices to control the right lifting cylinder of the blade to realize the ascending or descending action of the right end of the blade.

As shown in Fig. 2-2, the fifth sensor 13e can be disposed in the central axis 119 for sensing the third movement information of the handle body 113 moving left and right relative to the base 111. The first link 117 is fixed relative to the handle body 113, and the center shaft 119 is fixed to the base 111. When the handle body 113 moves left and right, the handle body 113 moves with the first link 117 left and right with respect to the central axis 119. The fifth sensor 13e mounted on the central axis 119 can detect the amount of change in the action of the first link 117 (i.e., the third movement information of the handle body 113 moving left and right), and the fifth sensor 13e outputs the third movement information to the controller. The controller processes and amplifies the output control signal to the electromagnetic hydraulic valve. The electromagnetic hydraulic valve passes through a series of intermediate hydraulic devices to control the blade extension cylinder to realize the left and right movement of the blade.

As shown in FIG. 2-2, the sixth sensor can be disposed at a position adjacent to the side of the dial 115 (as shown by the "C" point in FIG. 2-2) for sensing the dial 115 relative to the handle body 113. The fourth movement information moved left and right. As shown in Figure 2-9, the sixth sensor can also be set at the position shown by the "D" point in Figure 2-9. When the operator presses the dial 115 to move it left and right, the sixth sensor can detect it. The amount of change of the action of the dialing member 115 (ie, the fourth movement information), the sixth sensor outputs the fourth movement information to the controller, and after the operation processing and amplification of the controller, the control signal is output to the electromagnetic hydraulic valve, and the electromagnetic hydraulic valve passes through a series of The intermediate hydraulic device controls the blade yaw cylinder to realize the yaw motion of the blade operation device.

The handle 11 has the degrees of freedom of moving the left end up and down, the right end up and down, the right and left movement, the rotation, the curvature adjustment, and the left and right movement of the dial. By operating the freedom of the handle, the motion is mapped to the grader blade working device, and the control is intuitive. The upper left and lower blade lift, the blade right lift, the blade extension, the blade rotation, the blade angle, and the slanting device of the blade device are aligned to achieve the operation of the blade working device in accordance with the operation of the handle. According to the personal habits of the staff, the handle 11 of the handle 11 can be arranged in an elongated shape. When the handle 11 is placed on the left side, it is convenient to operate the left thumb. Similarly, when the handle 11 is placed on the right side, the right thumb can also operate the dial 115. The handle 11 can be removed and mounted to the wireless remote control unit for normal operation.

Those skilled in the art can understand that the types of signals sent by the above sensors are not limited to proportional voltage, proportional current, variable resistance, switching amount, etc.; the installation position of each sensor can be optimized according to its motion space and actual conditions; in addition, the sensor will The sensed motion information can also be sent to the controller in a wireless manner. The invention mainly uses the operation degree of the handle to be consistent with the actual degree of freedom of the working device, that is, the operation object is consistent with the action of the execution object, and the operation convenience is improved. Therefore, it is not limited to the grader working device, and is not limited to the blade working device of the grader. For example, the front ripper, the middle ripper, and the rear ripper can be controlled by the above-mentioned handle having multiple degrees of freedom. , snow plows, snow wings, etc.; controlled objects can also be such as bulldozers, excavators, loaders, cranes, etc. The above handles can also be extended to function and function accessories to meet more demanding object requirements, such as sound and light indication, position feedback, speed feedback, force feedback, wireless remote control, etc.

Each embodiment of the motion mapping control system of the present invention maps the operation action to the working device by operating the degree of freedom of the handle, so that the action of the working device is consistent with the operation of the handle, which can reduce the skill requirements of the operator, and the operator does not need to have very Strong work experience and skills, the general operator can accurately control the operating device; Reduce the operator's work intensity, the operation difficulty, and improve the convenience of operation.

The above are only the preferred embodiments of the present invention, and are not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc., which are within the spirit and scope of the present invention, should be included in the scope of the present invention. within.

Claims

Rights request

An action mapping control system, configured to control an action of a working device, comprising: a handle (11) having a plurality of degrees of freedom of motion, a plurality of sensors, and a controller;

The plurality of sensors are located on the handle (11) and correspond to a plurality of degrees of freedom of movement of the handle (11); each sensor is for sensing the handle (11) at a corresponding degree of freedom Motion information, and transmitting the motion information to the controller;

The controller is configured to control the working device to move in the corresponding degree of freedom according to the movement information of the handle (11) at a corresponding degree of freedom.

The motion mapping control system according to claim 1, wherein the working device is a blade working device;

The controller is configured to drive the blade working device in the corresponding position according to the movement information of the handle (11) at a corresponding degree of freedom by controlling the blade working device at the corresponding degree of freedom hydraulic control cylinder Freedom of movement.

The motion mapping control system according to claim 2, wherein the handle (11) comprises a base (111), and a handle body (113) connected to the base (111) is mounted on the handle a dialing member (115) on the outer surface of the body (113);

The freedom of movement of the handle (11) includes: the left end of the handle body (113) moves up and down relative to the base (111), and the right end of the handle body (113) is up and down relative to the base (111) Moving, the handle body (113) moves left and right relative to the base (111), the handle body (113) rotates axially relative to the base (111), and the handle body (113) is opposite to the handle The base (111) moves in a front-rear direction, and the dial member (115) moves left and right relative to the handle body (113).

4. The motion mapping control system according to claim 3, wherein the handle (11) further comprises a first link (117), and the handle body (113) passes through the first link (117) Connected to the base (111) and rotatable with the first link (117) as a rotational axis; the plurality of sensors including a first sensor (13a), the first sensor (13a) for Sensing rotational motion information of the handle body (113) rotating with the first link (117) as a rotation axis;

The controller is configured to receive the rotational motion information, and control the blade rotary cylinder according to the rotational motion information to drive the blade rotational motion.

The motion mapping control system according to claim 4, wherein the handle (11) further comprises a central axis (119), and the central axis (119) is disposed in the base (111); a first end of the first link (117) is coupled to the central axis (119), and can drive the handle body (113) to move in an arc about the central axis (119);

The plurality of sensors include a second sensor (13b) for sensing arc motion information of the handle body (113) in a circular motion about the central axis (119); the control The device is configured to receive the arc motion information sent by the second sensor (13b), and control the blade elevation cylinder according to the arc motion information to adjust the blade elevation angle.

The motion mapping control system according to claim 4 or 5, wherein the handle (11) further comprises a second link (112), a third link (114) and a fourth link (116) The handle body (113) is a hollow shell structure; the second link (112) is disposed on an inner surface of the handle body (113); the two ends of the third link (114) are respectively One end of the second link (112) and one end of the fourth link (116) are hinged; the second link (112), the third link (114) and the fourth link (116) ) forming a zigzag structure;

The other end of the fourth link (116) is connected to the second end of the first link (117), and the second end of the first link (117) is located at the handle body (113) In the housing.

The motion mapping control system according to claim 6, wherein the plurality of sensors comprise a third sensor and a fourth sensor;

The third sensor is disposed at a right end of the second link (112) for sensing first movement information of a left end of the handle body (113) moving up and down relative to the base (111); a fourth sensor is disposed at a left end of the third link (114) for sensing second movement information of a right end of the handle body (113) moving up and down relative to the base (111); Controlling the blade left lift cylinder according to the first movement information, driving the left end of the blade to rise or fall; and further for controlling the blade right lift cylinder according to the second movement information to drive the right end of the blade to rise or fall.

The motion mapping control system according to claim 5, wherein the plurality of sensors comprise a fifth sensor (13e) disposed in the central axis (119), the fifth sensor (13e) Means for sensing third movement information of the handle body (113) moving left and right relative to the base (111); The controller is configured to receive the third movement information, and control the blade extension cylinder according to the third movement information to drive the blade to move left and right.

The motion mapping control system according to any one of claims 3 to 4, wherein the plurality of sensors comprise a sixth sensor disposed on a side of the dial (115), the sixth a sensor for sensing fourth movement information of the dial member (115) moving left and right relative to the handle body (113);

The controller is configured to receive the fourth movement information, and control the blade yaw cylinder according to the fourth movement information to drive the blade yaw motion.

A grader comprising the motion map control system according to any one of claims 1-9.