Patent Application
20060209024
This disclosure relates generally to a machine interface, and more particularly to machine interface control methods and systems.
A modern work machine often is equipped with several input devices, such as driving wheels, joysticks, levers, buttons, and/or keyboards, etc, to provide control interfaces to an operator to perform one or more control functions. One type of such interface device may be configured to be manipulated by an operator and control the machine by generating and sending electric signals based on the manipulation of the device, such as a joystick. The operator may move the joystick to steer the work machine or to operate other work machine components, such as a work machine tool. Many joysticks are spring-loaded so that the joystick is biased toward a central, neutral position. When the joystick is released at a location other than the neutral position, the biasing force restores the joystick to the central, neutral position.
To improve the reliability and manipulability of joystick control, multi-axis joysticks using Hall effect sensors have been developed. However, using Hall effect sensors for multi-axis joysticks may also introduce interference between different axes during simultaneous control manipulations, which may cause unwanted movement of the work machine. The unwanted movement may further hamper work machine applications and reduce work machine controllability.
To determine a desired control command from simultaneous control input signals, certain systems, such as described in U.S. Patent Application Publication No. 2003/0112219 to Gharsalli et al. (published on Jun. 19, 2003), choose individual signals based on the existence of predetermined potential conditions. However, such systems do not address issues of interference between the control signals, such as signals corresponding to different axes of a multi-axis joystick control device.
Methods and systems consistent with certain features of the disclosed systems are directed to solving one or more of the problems set forth above.
One aspect of the present disclosure includes a method for processing control signals of a multi-axis joystick. The method may include processing a first control signal corresponding to movement in a first direction of the joystick and processing a second control signal corresponding to movement in a second direction of the joystick. The method may also include determining a first residue signal based on interference characteristics the first and second control signals and generating a first desired control signal corresponding to the first control signal by subtracting the first residue signal from the first control signal.
Another aspect of the present disclosure includes a method for operating a work machine by using a multi-axis joystick. The method may include moving the joystick in a side-to-side direction to generate a steering signal and concurrently moving the joystick in a fore-aft direction to generate a tool control signal to operate a work tool of the work machine. The method may also include processing the steering signal and the tool control signal and determining a residue signal caused by interference between signals from the side-to-side direction and the fore-aft direction based on stored information indicating interference characteristics of the multi-axis joystick. Further, the method may include subtracting the residue signal from the steering signal to generate a desired steering signal.
Another aspect of the present disclosure includes a machine interface control system. The system may include an input device configured to generate a first control signal and a second control signal. The first control signal may include a first residue signal caused by interference between the first control signal and the second control signal. The system may also include a memory device configured to store information indicating interference characteristics between the first control signal and the second control signal. Further, the system may include a controller configured to process the first control signal and the second control signal. The controller may also be configured to determine the first residue signal based on the stored information and the first and second control signals and subtract the first residue signal from the first control signal to generate a first desired control signal.
Another aspect of the present disclosure includes a work machine. The work machine may include a steering device, a work tool, and a multi-axis joystick capable of generating a first axis control signal and a second axis control signal. The first axis control signal may include a first residue signal caused by interference between the first axis control signal and the second axis control signal. The work machine may also include a controller. The controller may be configured to determine the first residue signal based on the first and second control signals and stored information indicating interference characteristics of the multi-axis joystick. The controller may also be configured to subtract the first residue signal from the first control signal to generate a first desired control signal and control the steering device of the work machine based on the first desired control signal.
Reference will now be made in detail to exemplary embodiments, which are illustrated in the accompanying drawings. Wherever possible, the same reference numbers will be used throughout the drawings to refer to the same or like parts.
As shown in
Joystick 108 may be any appropriate type of joystick used to control certain operations of work machine 100. For example, joystick 108 may be configured to provide control signals to a steering device (not shown), which automatically controls driving directions of work machine 100. Joystick 108 may also be configured to provide control signals to an activation device (not shown), which may operate tools on work machine 100. In certain embodiments, joystick 108 may be a multi-axis joystick using Hall effect sensors to control movement of work tool 104 and/or to steer work machine 100.
Further, shaft magnet 204 may be coupled with shaft 206 such that shaft magnet 204 may be moveable by an operator via shaft 206. Shaft magnet 204 may be disposed centrally among Hall effect sensors 208-1 to 208-4, and may be moveable relative to Hall effect sensors 208-1 to 208-4. When an operator manipulates joystick 202, shaft 206 may displace shaft magnet 204 relative to Hall effect sensors 208-1 to 208-4. The manipulation may then result in changes of proximity between shaft magnet 204 and Hall effect sensors 208-1 to 208-4 and, thus, may cause the sensors to generate electrical signals corresponding to movement in directions of the manipulation. In certain embodiments, such manipulation directions may include a fore-aft direction and/or a side-to-side direction. Other directions, however, may also be used.
A fore-aft axis 210 and a side-to-side axis 212 are shown for reference to the fore-aft direction and the side-to-side direction. Shaft magnet 204 may be movable to any position within a central area of base portion 202. Movement in the fore-aft direction may generate a fore-aft signal, while movement in the side-to-side direction may generate a side-to-side signal. In certain embodiments, the fore-aft signal and the side-to-side signal may control different work machine operations. For example, the side-to-side signal may be a steering signal for steering work machine 100, while the fore-aft signal may be a lift signal for controlling work tool 104 of work machine 100.
Because Hall effect sensors 208-1 to 208-4 generate electrical signals based upon their proximity to shaft magnet 204, displacement of shaft magnet 204 may cause the sensors to generate electrical signals, especially when the displacement is in more than one axis. For example, when shaft magnet 204 moves along fore-aft axis 210 while keeping a same amount of displacement along side-to-side axis 212, Hall effect sensors 208-1 and 208-3, which monitor displacement of shaft magnet 204 along side-to-side axis 212, may still generate electrical signals because the displacement of shaft magnet 204 in fore-aft axis may cause the intensity and direction of the entire magnetic field produced by shaft magnet 204 to change. Similarly, displacement of shaft magnet 204 along side-to-side axis while keeping a same amount of displacement along fore-aft axis 210 may cause sensors 208-2 and 208-4 to generate electrical signals as well.
These undesired electrical signals corresponding to displacements of shaft magnet 204 in unrelated axes may introduce electrical noises or interference in both the fore-aft signal and the side-to-side signal. The fore-aft signal and the side-to-side signal may no longer be the ideal signals appropriately reflecting movement in the fore-aft and side-to-side directions, respectively. For example, the fore-aft signal may include a residue signal that is caused by the interference from the side-to-side signal; and the side-to-side signal may also include a residue signal that is caused by the interference from the fore-aft signal. When the operator manipulates joystick 108 in both fore-aft and side-to-side directions simultaneously to, for example, lift work tool 104 and steer work machine 100, the steering signal and the lifting signal may interfere with each other by generating residue signals. The steering signal and the lifting signals generated by joystick 108 may thus no longer be the ideal steering and lifting signals.
Furthermore, the greater the distance that shaft magnet 204 travels from the central area, the more electrical noise that may be generated. To obtain desired steering and lifting signals that are matching with or close to the ideal steering and lifting signals, both the fore-aft signal and the side-to-side signal, including electrical noise or residue signals, may further be communicated to control system 110. Control system 110 may then automatically process the electrical signals and reduce and/or remove the residue signals to generate desired fore-aft and side-to-side signals.
Control system 110 may be any appropriate type of control system to provide signal processing, data collection, data analysis, data communication, and any other data and/or control functionalities. As shown in
Processor 302 may include any appropriate type of processor, such as one or more general purpose central processing units (CPUs), digital signal processors (DSPs), or microcontrollers. In certain embodiments, processor 302 may communicate with other on-board systems to control other components (e.g., engine 102, work tool 104, etc.) of work machine 100 via predetermined protocols, such as J1939. Other communication protocols, however, may also be used.
Memory module 304 may include one or more memory devices including, but not limited to, a ROM, a flash memory, a dynamic RAM, and a static RAM. Memory module 304 may be configured to store information used by processor 302. Further, memory module 304 may be external or internal to processor 302. I/O interfaces 306 may include one or more input/output interface devices receiving data (e.g., control signals) from processor 302 and sending data (e.g., electrical signals from Hall effect sensors 208-1 to 208-4) to processor 302 via I/O connections 308.
After control system 110 receives electrical signals from joystick 108, processor 302 may execute software programs to further process the electrical signals.
Similarly, transfer function 406-2 may be a transfer function that generates an ideal side-to-side signal S2 that reflects the actual movement in the side-to-side direction without interference. As explained above, an interference may be caused by fore-aft movement 402. Transfer function 406-21 may then be presented to generate a residue signal S21 corresponding to the interference. A measured side-to-side signal Y2 may therefore include both ideal side-to-side signal S2 and residue signal S21.
Although the ideal fore-aft signal, side-to-side signal, and residue signals in fore-aft direction and side-to-side direction are shown to be generated by separate transfer functions, transfer functions may be performed by physical sensor devices simultaneously and automatically. Thus, the ideal fore-aft signals and side-to-side signals may be inseparable from the residue signals by joystick 108. Joystick 108 may only provide measured signals, rather than the ideal signals to control system 110. Accordingly, both measured signals Y1 and Y2 may then be passed by joystick 108 to control system 110 for further processing to generate desired signals that are matching with or close to the ideal signals S1 and S2.
Processor 302 may cause signals Y1 and Y2 to be processed by signal processing unit 420. Signal processing unit 420 may be any appropriate type of signal processing component, such as a signal processing hardware device. Alternatively, signal processing unit 420 may be implemented by software programs executed by processor 302. Signal processing unit 420 may amplify and filter signals Y1 and Y2, and may further convert signals Y1 and Y2 into digital signals D1 and D2, respectfully.
Processor 302 may then determine measured positions in both fore-aft direction and side-to-side direction based on signals D1 and D2. The measured positions may be percentage values indicating proximities relative to the neutral point of joystick 108 that may correspond to degrees of manipulations on work machine 100. For example, a 50% movement in the side-to-side direction may cause work machine 100 to be steered at a particular angle of, for example, 45 degrees. On the other hand, a 50% movement in the fore-aft direction may cause work tool 104 to be lifted, for example, half way between a lowest position and a highest position. Once processor 302 determines the measured positions or percentage values, processor 302 may further search a 3D compensation table 422 to determine residue signals Z12 and Z21 that are included in signals D1 and D2, respectively.
3D compensation table 422 may be created based on relationships among fore-aft signals, side-to-side signals, and residue signals. Such relationships may be predetermined based on experimental data or may be created dynamically by processor 302 based on predetermined criteria that may be specific to particular applications.
As shown in
Returning to
Further, processor 302 may also interpolate corresponding residue signals when a particular position value cannot be found. For example, a residue signal of a steering signal at 45%, if not found in the table, may be proportionally calculated based on steering signals at 40% and, for example, 50%. An average value between a residue signal value of a 40% steering signal and a residue signal value of a 50% steering signal may then be determined to be the residue signal value of the 45% steering signal. Other methods of interpolation, however, may also be used.
After determining fore-aft residue signal Z12, processor 302 may use subtractor 424-1 to deduct residue Z12 from fore-aft signal D1 to generate a desired fore-aft signal R1 corresponding to ideal fore-aft signal S1. Similarly, after determining side-to-side residue signal Z21, processor 302 may also use subtractor 424-2 to deduct residue Z21 from side-to-side signal D2 to generate a desired side-to-side R2 corresponding to ideal side-to-side signal S2. In certain embodiments, R1 may be equal to ideal fore-aft signal S1, if estimated residue signal Z12 is equal to residue signal S12. R2 may be equal to ideal side-to-side signal S2, if estimated residue signal Z21 is equal to residue signal S21. Processor 302 may further communicate desired signals R1 and R2 to other components of work machine 100 to cause operations of the components according to desired signals R1 and R2. Alternatively, processor 302 may directly control certain operations of work machine 100 based on desired signals R1 and R2. For example, work machine 100 may be steered by desired side-to-side signal R2 and work tool 104 may be operated by desired fore-aft signal R1. In certain other embodiments, desired signals R1 and R2 may approximately correspond to the respective ideal signals such that residue signals are reduced below a certain predetermined noise level.
The disclosed systems and methods may eliminate or reduce the interference between correlated control signals of an input device, such as a multi-axis joystick. The disclosed systems and methods may determine the interference based on relationships among control signals corresponding to axes of the multi-axis joystick and residue signals. These relationships may be determined by experimentation or in real time by software programs. By determining and removing interference based on these relationships, complex and costly circuitries processing individual signals to filter or reduce interference may be eliminated. The disclosed systems and methods may thus provide accurate and low cost solutions where multiple control signals need to be processed and interference or noise among the multiple control signals need to be eliminated or reduced, such as control signals from work machine input devices or any other types of input devices.
Other embodiments, features, aspects, and principles of the disclosed exemplary systems will be apparent to those skilled in the art and may be implemented in various environments not limited to work site environments.
