Control of a personal transporter based on user position

An apparatus controller for prompting a rider to be positioned on a vehicle in such a manner as to reduce lateral instability due to lateral acceleration of the vehicle. The apparatus has an input for receiving specification from the rider of a desired direction of travel, and indicating means for reflecting to the rider a propitious instantaneous body orientation to enhance stability in the face of lateral acceleration. The indicating may include a handlebar that is pivotable with respect to the vehicle and that is driven in response to vehicle turning.

Skip to: Description  ·  Claims  ·  References Cited  · Patent History  ·  Patent History
Description
CROSS-REFERENCE TO RELATED APPLICATIONS

The present application is a continuation of U.S. application Ser. No. 14/446,969, filed Jul. 30, 2014, which is a continuation of U.S. application Ser. No. 13/857,737, filed Apr. 5, 2013, now U.S. Pat. No. 8,830,048, which is a continuation of U.S. application Ser. No. 13/585,041, filed Aug. 14, 2012, now abandoned, which is a continuation of U.S. application Ser. No. 12/879,650, filed Sep. 10, 2010, now U.S. Pat. No. 8,248,222, which is a continuation of U.S. application Ser. No. 11/863,640, filed Sep. 28, 2007, now U.S. Pat. No. 7,812,715, which is a divisional of U.S. application Ser. No. 10/939,955, filed Sep. 13, 2004, now U.S. Pat. No. 7,275,607. The present application claims priority from all of the foregoing applications by virtue of the priority chain heretofore recited. All of the foregoing applications are incorporated herein by reference in their entirety.

TECHNICAL FIELD

The present invention pertains to control of personal transporters, and more particularly to devices and methods for providing user input with respect to either directional or velocity control of such transporters (having any number of ground-contacting elements) based on the position or orientation of a user.

BACKGROUND OF THE INVENTION

Dynamically stabilized transporters refer to personal transporters having a control system that actively maintains the stability of the transporter while the transporter is operating. The control system maintains the stability of the transporter by continuously sensing the orientation of the transporter, determining the corrective action to maintain stability, and commanding the wheel motors to make the corrective action.

For vehicles that maintain a stable footprint, coupling between steering control, on the one hand, and control of the forward motion of the vehicles is not an issue of concern since, under typical road conditions, stability is maintained by virtue of the wheels being in contact with the ground throughout the course of a turn. In a balancing transporter, however, any torque applied to one or more wheels affects the stability of the transporter. Coupling between steering and balancing control mechanisms is one subject of U.S. Pat. No. 6,789,640, which is incorporated herein by reference. Directional inputs that advantageously provide intuitive and natural integration of human control with the steering requirements of a balancing vehicle are the subject of the present invention.

SUMMARY OF THE INVENTION

In accordance with preferred embodiments of the present invention, a controller is provided that may be employed for providing user input of a desired direction of motion or orientation for a transporter. The controller has an input for receiving specification by a user of a value based on a detected body orientation of the user.

User-specified input may be conveyed by the user using any of a large variety of input modalities, including: ultrasonic body position sensing; foot force sensing; handlebar lean; active handlebar; mechanical sensing of body position; and linear slide directional input.

In those embodiments of the invention wherein the transporter is capable of balanced operation on one or more ground-contacting elements, an input is provided for receiving specification from the user of a desired direction of motion, or a desired velocity value based on a detected body orientation of the user. A processor generates a command signal based at least on the user-specified direction and velocity value in conjunction with a pitch command signal that is based on a pitch error in such a manner as to maintain balance of the transporter in the course of achieving the specified direction and velocity. The input of a desired direction may also include a user-specified yaw value, yaw rate value, or fore/aft direction.

In various other embodiments of the invention, the controller has a summer for differencing an instantaneous yaw value from the user-specified yaw value to generate a yaw error value such that the yaw command signal generated by the processor is based at least in part on the yaw error value. The input for receiving user specification may include a pressure sensor disposed to detect orientation of the user, an ultrasonic sensor disposed to detect orientation of the user, or a force sensor disposed on a platform supporting the user for detecting weight distribution of the user. In yet other embodiments, the input for receiving user specification includes a shaft disposed in a plane transverse to an axis characterizing rotation of the two laterally disposed wheels, the desired direction and velocity specified on the basis of orientation of the shaft.

In accordance with further embodiments of the invention, the balancing transporter may includes a handlebar, and the controller may further have a powered pivot for positioning the handlebar based at least upon one of lateral acceleration and roll angle of the transporter. In particular, the controller may have a position loop for commanding a handlebar position substantially proportional to the difference in the square of the velocity of a first wheel and the square of the velocity of a second wheel.

In accordance with yet other embodiments of the invention, an apparatus is provided for prompting a rider to be positioned on a vehicle in such a manner as to reduce lateral instability due to lateral acceleration of the vehicle. The apparatus has an input for receiving specification by the rider of a desired direction of travel and an indicating means for reflecting to the rider a desired instantaneous body orientation based at least on current lateral acceleration of the vehicle. The indicating means may include a handlebar pivotable with respect to the vehicle, the handlebar driven in response to vehicle turning.

BRIEF DESCRIPTION OF THE DRAWINGS

The foregoing features of the invention will be more readily understood by reference to the following detailed description, taken with reference to the accompanying drawings, in which:

FIG. 1 shows a personal transporter, as described in detail in U.S. Pat. No. 6,302,230, to which the present invention may advantageously be applied;

FIG. 2 shows a block diagram showing the constitutive inputs and outputs of a yaw command in a system architecture to which the present invention may be advantageously applied;

FIG. 3A is an exploded view of components of a yaw control mechanism showing a yaw control grip coupled to a user interface of a personal transporter, in accordance with an embodiment of the present invention;

FIG. 3B shows a detailed exploded view of the yaw control grip of FIG. 3A;

FIG. 3C shows the integral yaw control sensor of the yaw control mechanism of FIG. 3A;

FIG. 4 shows a schematic block diagram of a yaw-feedback control system in accordance with embodiments of the present invention;

FIG. 5A is a schematic top view of a rider in positions indicating full square positioning, a tilt to the left, and a counterclockwise rotation, respectively;

FIG. 5B is a front view of a hip collar for detecting changes in rider orientation to control yaw in accordance with an embodiment of the present invention;

FIG. 5C is a diagram of an ultrasound transmitter/receiver configuration in accordance with various embodiments of the present invention;

FIG. 5D is a waveform timing display of ultrasound signals transmitted and received by components of embodiments of the present invention depicted in FIG. 4A;

FIG. 6A is a top view of the platform of a personal transporter with the pressure plate removed, indicating the placement of feet-force pressure sensors in accordance with various embodiments of the present invention;

FIG. 6B is a diagram of a pressure plate for application of force by a user in embodiments of the present invention depicted in FIG. 6A;

FIG. 6C is a schematic depicting the development of a yaw command signal from the foot-force sensors of FIG. 6A, in accordance with an embodiment of the present invention;

FIG. 6D shows a deadband in the command as a function of yaw input;

FIG. 6E shows a ramp function for switching yaw command in reverse as a function of wheel velocity;

FIG. 7A shows a handlebar lean device for control input to a personal transporter in accordance with embodiments of the present invention;

FIG. 7B shows a handlebar lean device with flexure coupling of the control stalk to the ground-contacting module for control input to a personal transporter in accordance with embodiments of the present invention;

FIG. 7C shows a further handlebar lean device with separated handles for control input to a personal transporter in accordance with embodiments of the present invention;

FIG. 7D shows a rotating handlebar device for control input to a personal transporter in accordance with embodiments of the present invention

FIG. 7E shows a handlebar lean device for control input to a personal transporter in accordance with embodiments of the present invention;

FIG. 7F shows a shock absorber and damping adjustment for use with the embodiment of the invention depicted in FIG. 7A;

FIG. 7G is a block schematic of a mixer block for combining yaw input and roll information in accordance with embodiments of the present invention;

FIG. 7H shows a handlebar bearing and détente allowing the rotational degree of freedom of the handlebar to be locked in accordance with an embodiment of the present invention;

FIG. 8A shows the response of the active handlebar to a roll disturbance, in accordance with an embodiment of the present invention;

FIGS. 8B and 8C show front and back views of active handlebar response during a high-speed turn, in accordance with an embodiment of the present invention;

FIGS. 9A and 9B show the basic mechanical hardware layout of the powered handlebar embodiment of FIGS. 8A-8C;

FIG. 10A shows a front view of a knee position sensor for providing steering input to a personal transporter in accordance with embodiments of the present invention;

FIG. 10B shows a centering mechanism employed in conjunction with the knee position sensor of FIG. 10A;

FIG. 10C shows hip position sensors for providing user yaw input in accordance with an embodiment of the present invention;

FIG. 10D shows a torso position sensor for providing user yaw input in accordance with an embodiment of the present invention; and

FIG. 11 depicts a linear slide footplate mechanism in accordance with yet another embodiment of the present invention.

 DETAILED DESCRIPTION OF SPECIFIC EMBODIMENTS

A personal transporter may be said to act as ‘balancing’ if it is capable of operation on one or more wheels but would be unable to stand on the wheels but for operation of a control loop governing operation of the wheels. A balancing personal transporter lacks static stability but is dynamically balanced. The wheels, or other ground-contacting elements, that provide contact between such a personal transporter and the ground or other underlying surface, and minimally support the transporter with respect to tipping during routine operation, are referred to herein as ‘primary ground-contacting elements.’

FIG. 1 shows a balancing personal transporter, designated generally by numeral 10, and described in detail in U.S. Pat. No. 6,302,230, as an example of a device to which the present invention may advantageously be applied. A subject 8 stands on a support platform 12 and holds a grip 14 on a handle 16 attached to the platform 12. A control loop may be provided so that leaning of the subject results in the application of torque to wheel 20 about axle 22 by means of a motor drive depicted schematically in FIG. 2, as discussed below, thereby causing an acceleration of the transporter. Transporter 10, however, is statically unstable, and, absent operation of the control loop to maintain dynamic stability, transporter 10 will no longer be able to operate in its typical operating orientation. “Stability” as used in this description and in any appended claims refers to the mechanical condition of an operating position with respect to which the system will naturally return if the system is perturbed away from the operating position in any respect.

Different numbers of wheels or other ground-contacting members may advantageously be used in various embodiments of the invention as particularly suited to varying applications. Thus, within the scope of the present invention, the number of ground-contacting members may be any number equal to, or greater than, one. A personal transporter may be said to act as ‘balancing’ if it is capable of operation on one or more wheels (or other ground-contacting elements) but would be unable to stand stably on the wheels but for operation of a control loop governing operation of the wheels. The wheels, or other ground-contacting elements, that provide contact between such a personal transporter and the ground or other underlying surface, and minimally support the transporter with respect to tipping during routine operation, may be referred to herein as ‘primary ground-contacting elements.’ A transporter such as transporter 10 may advantageously be used as a mobile work platform or a recreational vehicle such as a golf cart, or as a delivery vehicle.

The term “lean”, as used herein, refers to the angle with respect to the local vertical direction of a line that passes through the center of mass of the system and the center of rotation of a ground-contacting element supporting the system above the ground at a given moment. The term “system” refers to all mass caused to move due to motion of the ground-contacting elements with respect to the surface over which the vehicle is moving.

“Stability” as used in this description and in any appended claims refers to the mechanical condition of an operating position with respect to which the system will naturally return if the system is perturbed away from the operating position in any respect.

One mechanism for providing user input for a yaw control system of a personal transporter is described in detail in U.S. Pat. No. 6,789,640. As described therein and as shown in FIGS. 3A-3C, a user mounted on the transporter may provide yaw control input to a yaw controller 502 (shown in FIG. 2) by rotating yaw grip assembly 800, shown in detail in FIG. 3B.

FIG. 2 depicts the differencing, in summer 522, of the current yaw value ψ with respect to the desired yaw value ψdesired to obtain the current yaw error ψerr. Desired yaw value ψdesired is obtained from a user input, various embodiments of which are described herein. The current value ψ of yaw is derived from various state estimates, such as the differential wheel velocities, inertial sensing, etc. Derivation of the yaw command from the yaw error is provided by motor controller 72 according to various processing algorithms described, for example, in U.S. Pat. No. 6,288,505, and applied to left and right motors 28 and 30, respectively.

With particular reference to FIG. 3A, one embodiment of user interface 14 has twin hollow stalks 802, one on either side, either of which may serve interchangeably to support yaw grip assembly 800. Thus yaw may advantageously be controlled by a specified hand (right or left), either side of central control shaft 16. Yaw grip assembly 800 comprises a grip 804 which is rotated about an axis 806 coaxial with stalks 802. Spring damper 808 provides an opposing force to rotation of yaw grip 804 and returns yaw grip 804 to the central neutral position. Yaw grip 804 contains at least one magnet 810 (two are shown in FIG. 3B, in accordance with a preferred embodiment), the rotation of which about axis 806 allows the rotational orientation of grip 804 to be sensed by sensor unit 812 (shown in FIG. 3C) which is disposed within protruding stalk 802. Thus, user interface 14 may be sealed at its ends with fixed yaw grips 814 and the integral sealed nature of the user interface is not compromised by the yaw control input. Sensor unit 812 may contain Hall effect sensors which are preferably redundant to ensure fail-safe operation. Other magnetic sensors may also be employed within the scope of the present invention.

FIG. 4 shows a block diagram for the yaw feedback control system, in accordance with one embodiment of the invention. The LateralAccelScale function 42 reduces the effect of the yaw input 40 at higher wheel speeds and at higher centripetal acceleration. Feedback 44, used to regulate the commanded yaw velocity, contains a yaw position term 45 to maintain yaw position, a velocity squared term 46 that will attempt to regulate the yaw velocity to zero, and a feedforward term 49 used to provide better yaw command response to the user.

From FIG. 4, it is apparent that the feedforward term 49 must dominate for rapid maneuvers in order to provide a responsive system. The velocity-squared feedback 46 deviates from linear control theory and has the effect of providing nonlinear yaw velocity damping.

Several alternatives to a twist grip input device for specifying user directional or velocity input are now described.

Body Position Sensing

In accordance with various embodiments of the present invention, a device which detects the body position of the rider is employed to control fore/aft motion or steering of a transporter. For purposes of yaw control, in accordance with various embodiments of the invention, sensors detect whether the hips or shoulders of a rider, shown schematically from above in FIG. 5A, are squarely aligned, or are translated in a lateral direction 51 or else rotated, such that one shoulder is thrust in a forward direction 52 while the opposing shoulder is thrust in a backward direction 53. These schemes can be used independently or to provide directional input.

Any method of sensing of body position to control vehicle yaw or fore/aft motion is within the scope of the present invention and of any appended claims. One embodiment of the invention, described with reference to FIG. 5B, entails mechanical contact with the rider 8. Pads 54 are mounted on yoke 55 and contain pressure transducers that transmit signals to the yaw controller based on changes in sensed position of the hips of the user. Other methods of sensing user position may rely upon optical or ultrasonic detection, an example of which is now described with reference to FIGS. 5C and 5D.

In one embodiment, an ultrasonic beacon is worn by the rider, and an array of receivers mounted to the machine detect the position of the rider. Time of flight information is obtained from transmitter to each receiver and used to calculate the lateral position of the user with respect to the center of the machine. To turn the machine to the right, the user leans to the right, and similarly for turning left. In addition to the intuitive appeal of a mechanism which translates body motion to transporter control, as in the case of fore-aft motion control of a personal transporter of the sort described in U.S. Pat. No. 6,302,230, the body-control modality also advantageously positions the user's center of gravity (CG) correctly for high speed turns.

A body lean system described with reference to FIGS. 5A and 5B consists of three distinct mechanical components—the transmitter beacon, the receiver array, and the processing electronics. In one embodiment of the invention, an ultrasonic (US)/RF transmitter beacon is worn by the rider, and an array of ultrasonic receivers and an RF receiver is mounted below the handlebars of the transporter, along with interface electronics. Various ultrasonic transmitters/receivers may be employed, such as those supplied by Devantech Ltd. of Norfolk, England. The transmitter beacon is a small piece of Delrin® acetal resin with three ultrasound transmitters, at a typical frequency of 40 kHz, mounted at 90 and ±45 degrees. This produces a cone of sound of about 160 degrees. The driver electronics are mounted on a printed circuit board buried behind the transmitters, and a small RF transmitter is mounted below. A belt clip from a wireless phone attaches the transmitter to the user, while power is supplied by batteries.

The receiver array is a bar with receivers mounted at various locations. The ultrasound receivers are also mounted in small pieces of Delrin®, with the electronics located behind the bar at each location. To increase the size of the reception cone, 2 US receivers are used at each location, one mounted facing straight out and the other at 45 degrees to that. For the outboard sensors, the 45-degree receiver faced inward and for the inboard receivers, the 45 degree receiver faced outwards. This makes it possible to use the two outboard receivers (left and right) for location when the rider is at the center of the machine, but as the rider moves right, the two right sensors take over, and the same when the rider moves to the left.

An ultrasonic rangefinder, such as a Devantech Model SRF-04, may provide both the transmitter and receiver functions and circuitry, however modifications are within the scope of the present invention. The beacon portion consolidates three drivers onto a single board. In addition, the microcontroller code residing on the transmitter boards allows the board to transmit continuously.

The board designed to interface to the computer was breadboarded with microcontrollers of the same type as the Devantech boards. The function of this board is to create a square wave that represents the time difference of arrival between the RF pulse and the ultrasonic pulse (wave goes high when the RF pulse arrives, and low when the US pulse arrives), and correctly interface this wave to the computer circuitry. Since RF travels at the speed of light, and sound at the speed of sound, this scheme results in an accurate ultrasonic time of flight (TOF) signal.

With reference to FIG. 5D, the counter timer board residing in the computer chassis receives 4 waveforms representing the 4 TOF's from the transmitter to the 4 receivers, and using a 400 KHz clock, determines the duration of each pulse (in counts of the 400 khz clock). This info is then passed to the algorithms for distance calculation and additional processing.

When a balancing transporter is traveling at any significant speed, the rider needs to lean into a commanded turn in order to counteract the centripetal accelerations due to the turn. This machine uses the body location sensors to turn the machine. When the rider is centered on the machine, no turn input is generated. When the rider leans to the left, a left turn is commanded, and the same for the right. Thus the turn is not initiated until the users CG is properly located. In addition, by knowing the users exact CG location (as by positioning the transmitter at the waist of the rider), the system is able to exactly match the wheel speed/turn rate to the angle the user is at, theoretically exactly canceling out the forces acting on the body. Thus the amount of turn is tuned for the CG location of the rider and wheel speed.

In accordance with the invention, time-of flight (TOF) information from an ultrasonic transmitter is transmitted to at least 2 ultrasonic receivers. Time of flight was calculated from the difference of a RF received pulse edge to a US received pulse edge. Since the speed of sound is substantially a constant (within the operation of the machine), distance can be calculated from its time of flight from transmitter to receiver. The law of cosines along with the known distances of the receivers from center and from each other is then used to calculate the location of the transmitter in the lateral direction. Because of the redundant receivers, the lateral location is unique, and immune to changes in height and fore/aft distance from the bar (unless this change resulted in a loss of line-of sight (LOS).

Feet Force

In accordance with another embodiment of the invention, yaw control input is provided to a transporter by sensing the rider's weight distribution by using force sensors on the foot plate. In order to steer, the rider leans in the direction of desired turn. Lean, right: turn right; lean left: turn left. Many variations can be derived from a base system containing many force sensors located at the foot plate.

A PCB board provides all signal conditioning for the force sensors. The sensor signals are output from the PCB board as zero to five volt analog signals. Spare A/D inputs on the amplifiers are used to read in the 8 analog signals and provide an 8-bit count to the software for each sensor.

The primary variation implemented and tested uses sensors on the left and sensors on the right sides of the foot plate. When the person leans to the right, the right sensor signals become large, indicating a turn to the right. When the person leans to the left, the left sensor signals become large, indicating a turn to the left. A special foot plate was constructed to allow force distribution to be measured at four corners of a rigid plate.

The resulting system is advantageously very maneuverable at low speeds and a rider may became more proficient at this yaw input than the twist grip yaw input. There is a tradeoff between the bandwidth of the device that enables the system handle disturbances better, and the perceived responsiveness of the system.

As a natural movement, when turning on a personal transporter, a user tends to shift weight in the direction of the turn. The reason for this is the centripetal force generated by turning tends to push the person off the transporter. The same user movement is required when riding a 3-wheel or a 4-wheel all-terrain-vehicle (ATV). As a result, a natural input to turn that encourages good user position is to turn right when the user shifts their weight to the right. In this configuration, the user is in the ideal position to make a right turn.

Skiers and skaters tend to push off with their right foot to turn left. The reason for this is they shift their weight distribution from the right to the left by using their feet. On a personal transporter in accordance with the present invention, users needs to shift their weight from right to left not using their feet, but using the handlebars for this input device. If the sign were reversed to accommodate the skiers and skaters' preference to lean right and turn left, an unstable system would result. As the user leans right, the transporter turns left, generating a centripetal force that pushes the user more to right, generating more left turn command.

Referring to FIG. 6A, the force sensing element is located at the end of the flexible ribbon in a circle about the size of a dime. With no force on the sensor, the resistance is around 800 Mohms. With 100 lbs on the sensor, the output is around 200 Mohms. To condition the signal, op-amps were used to create an active amplifier and an active anti-aliasing filter. The goal of the amplifier is to generate an output that is proportional to the change in resistance. The goal of the filter is to prevent measurements above 50 Hz from being measured. An inverting amplifier is used since it provides an output proportional to the change in resistance. An inverting lowpass filter is used as an anti-aliasing filter and to change to the voltage back to 0 to 5 volts. A +/−12 Volt supply is used to power the op-amps to remain within the linear safe regions of the op-amps.

The sensors are located under a metal foot-plate, one in each corner, as shown in FIG. 6A. A metal plate on top allows the standard rider-detect buttons to be pressed while providing a hard surface to press against each of the 4 sensors. The metal plate is shown in FIG. 6B.

The overall yaw command from the sensor measurements to the yaw command delivered to the control system is shown in FIG. 6C.

Since a user often shifts his weight slightly while standing in place, a deadband is added to the sensor processing. As shown in FIG. 6D, deadband 48 provides a region around zero yaw input where slight yaw inputs result in no yaw command.

To calculate the yaw command from the sensors, the following equation is used:

ψ • cmd = ( right ⁢ ⁢ front + right ⁢ ⁢ rear ) 2 - ( left ⁢ ⁢ front + left ⁢ ⁢ rear ) 2 ,

    • where {dot over (ψ)}cmd is the commanded rate of change in yaw.

Each sensor provides 0 Volts, or 0 counts with no weight on it, and 5 Volts, or 255 counts fully loaded. A deadband of around 40 counts provided smooth enough control with enough room to feel comfortable. Additionally, filters may be employed to filter the command signal, with passbands typically centered from about 0.5 Hz to about 3 Hz.

When moving in reverse, if the same equations are used to generate the yaw command, the resulting system has positive feedback. When the transporter performs an “S-turn”, in reverse, if the user leans to the right, the transporter will turn to the left and create a centripetal force on the user, pushing the user to the right. To solve this issue, a “C-turn” may be implemented. A ramp function is used to reverse the yaw command when the transporter begins moving in reverse. To keep a consistent turning motion, when turning in place, the ramp only switches the direction of the yaw command when it moves in reverse. FIG. 6E shows the ramp function for switching yaw command in reverse as a function of wheel velocity. The rampRev function is used to modify the yaw velocity command as follows:
{dot over (ψ)}cmd={dot over (ψ)}cmd+2·rampRevLPF·{dot over (ψ)}cmd

The rampRev signal is lowpass filtered at 5.0 Hz to smooth the effects of the ramp.

A brake switch, such as brake switch 7 (shown in FIG. 3A) may be connected to turn the yaw command off when it is pressed. When the button is pressed, a yaw command multiplier of 0 is applied, whereas, if it is released, the yaw command multiplier is 1. A 0.5 Hz Low Pass Filter is used to smooth the transitions between on and off.

Handlebar Lean

One of the key properties of a good directional input device is its ability to provide directional input while managing lateral acceleration. High lateral acceleration turns require the user to lean into the turn to keep from falling off or tipping over the transporter. An optimal directional input device will require the user to have their body properly positioned when commanding a directional input. A twist grip yaw input, such as discussed above with reference to FIG. 3, encourages proper body positioning through the orientation of its rotation axis and the design of the knob and handle combination. It is possible, however, to make an uncoordinated input depending on the driver's technique

Another method of encouraging proper body positioning is to make one or more handlebars into a joystick. By pivoting the bar near the base of the machine, the user can move his or her body at high speeds and merely hold onto the handlebar and command an input. When properly tuned, the user's body is already in position to react against the lateral acceleration at the initiation of the turn, reducing the likelihood of an improperly coordinated turn.

In the handlebar lean machine, the yaw input is proportional to the handlebar angle with respect to the chassis. Preferably, the pivot axis is mounted as low as practical on the transporter ground-contacting module in order to allow the bar motion to follow the users body motion naturally, since a person leans most stably by pivoting at the ankles. In other words, a low pivot handlebar tracks the body kinematics. In this embodiment, the yaw input is converted into a yaw command using standard personal transporter algorithms, which apply a fixed gain to yaw input at low speeds, but scale the gain at higher speed to make the yaw input correspond to lateral acceleration instead of yaw rate. This works well with the handlebar lean device, since the desired lean angle is roughly proportional to lateral acceleration. The result is a very natural input method, where the user “thinks” right or left via leaning, and the machine follows.
{dot over (ψ)}cmd=K(ΦHB−ΦRoll)

    • a. where K is a constant;
    • ΦB is the handlebar angle with respect to the platform;
    • ΦRoll is the platform lean with respect to gravity
    • {dot over (ψ)}cmd is the yaw command.

Other embodiments of the invention may have an inclined or horizontally mounted pivot handlebar. In machines with inclined pivots, the angle of the pivot with respect to the contact patch and surface provided interesting turning dynamics. Specifically, the axis of rotation may affect the dynamics of turning on a slope or on a flat surface. Preferably, the machine has a low horizontal pivot. A horizontal pivot can easily track the kinematics of the body during a turn.

In accordance with yet other embodiment of the invention, with the direction of travel as the reference point, the pivoted handlebar may be either mounted in the front or the rear of the transporter. The configuration of a rear mounted pivot handlebar enables a user to steer the transporter with other parts of the body such as the knees, in addition to using a limb coupled to the handlebar. Furthermore, the transporter may include a feature that disables the lean steer when a user is mounting or dismounting. The feature may be activated when the transporter determines that a user is partially on/off the platform such that the transporter may not turn into or away from the user while mounting or dismounting.

Of the various mechanisms suited to provide for handlebar lean, a first is described with reference to FIG. 7A. Motion of handlebar 700 is constrained to a plane that is substantially transverse to the direction of forward motion of personal transporter 10 by means of parallel link bars 702 that are pivotally coupled both to platform 12 and to handlebar 700. Motion of the handlebar may also be biased to a central position and/or damped by means of springs 704 or shock absorbers. In an alternate embodiment shown in FIG. 7B, handlebar 700 may be coupled to platform 12 of the transporter 10 by flexure elements 708, again constraining motion of the handlebar substantially to a plane transverse to the direction of forward motion and allowing tilting of the handlebar in an arc centered upon a virtual pivot at, or near, the plane of platform 12. In either of the embodiments of FIGS. 7A and 7B, one or more sensors 710 detect the position of handlebar 700 or of members 702 coupling the handlebar to the rest of the transporter, either with respect to the vertical or with respect to a direction fixed with respect to the ground-contacting module. Sensor 710 may be a load cell, for example, disposed along control shaft 16. Furthermore, the springs or shock absorbers coupled to the handlebar may be used to limit the turning rate of the transporter if desired.

Preferably, the motion of the handlebar is not biased to a central position. In embodiments where the handlebar is not biased to a central position, there is no preloading around the center and thus a user can precisely and accurately steer the transporter.

In accordance with an embodiment depicted in FIG. 7C, two separate handlebar segments 720 and 722 may be moved separately, by leaning of the user 8, relative to platform 12 of the transporter. In the embodiment shown, the position of each handlebar segment is biased to a specified ‘neutral’ height within respective sleeves 724 and 726 by means of springs, or otherwise. A relative height offset is transmitted to the yaw controller to control turning, as described in connection with other user input modalities.

Yet a further embodiment of the invention is depicted in FIG. 7D, where rotation in clockwise and counterclockwise directions 730 and 732 of handlebar 700 relative to support stalk 16 is sensed to generate a signal that transmits a user input to yaw controller 502 (shown in FIG. 2). A shock absorber 734 is preferably built in to the pivotal coupling of handlebar 700 about shaft 16.

A handlebar lean device in accordance with a further embodiment of the invention features a pivot mechanism shown in FIG. 7E. Pivot 70 is adjustable in both spring constant and preload, and has a fixed range of motion of ±15°. Preferably, the pivot has an unlimited range of motion. The pivot is mounted as low as possible on the ground-contacting module chassis 26, and the handle 16 is mounted to the rotating portion of the mechanism. A pair of shock absorbers 74 may provide additional damping and stiffness. Shock absorbers 74 are mounted slightly off horizontal to maximize their perpendicularity to the control shaft 16 throughout the range of motion.

The shocks are adjustable in both spring constant and damping. The spring constant is adjustable by pressurizing the shock air reservoir. The damping adjustment is made with a knob that varies an orifice size internal to the shock. Shock absorbers 74 are shown in FIG. 7F. Internal to the pivot mechanism is a cam and spring loaded follower. The cam compresses the follower springs, which generates the restoring spring force. To change the spring constant, a different cam is substituted in the pivot and some cases the number of Belleville springs is changed. The preload is adjusted externally using a screw, which moves a wedge to position the Belleville spring stack. Various degrees of stiffness may be provided by interchangeable cams.

With the stiffest cam installed and the shock absorbers at ambient pressure, a preload of approximately 8 lbs. results, as measured at the handlebar. Approximately 40 pounds of force are required to deflect the handlebar to its full 15° travel.

One issue that must be addressed in handlebar lean control is the effect of terrain sensitivity. If the machine is driven over obstacles or rough terrain, a roll disturbance is forced on the machine/rider system since the resulting change in position of the user may cause an unintended yaw input is put into the system. Yaw control modalities that depend upon the overall body lean of a standing person are prone to be more sensitive to terrain than, say, yaw control by means of a twist grip.

To combat this roll sensitivity, a roll compensation algorithm may be employed. In such an algorithm, the yaw input is modified to compensate for the roll angle of the chassis, making the yaw input the angle of the handlebar with respect to gravity. Since it is easier for the user to maintain body position with respect to gravity rather than the platform, this facilitates rejection of roll disturbances.

In accordance with certain embodiments of the invention, a method for reducing terrain sensitivity employs an algorithm for filtering yaw inputs based on the roll rate of the chassis. The instantaneous rate of rolling, referred to as Roll Rate, is readily available from the Pitch State Estimator, such as that described, for example, in U.S. Pat. No. 6,332,103, which derives the orientation of the transporter based on one or more gyroscopes, an inclinometer, or combinations of the above. Large roll transients cause the rider to be accelerated and, if the roll transients were to be rigidly coupled, through the rider, to the yaw control mechanism, they would cause unintended yaw input.

There are two distinct parts of the solution: rejecting terrain while riding straight and rejecting terrain while turning; the first is a special case of the second. While disabling yaw during periods of large roll rates would solve the problem for motion in a fixed direction, more input is required in order to decouple roll from steered motion.

An unknown input is an estimate of the “intended” yaw input from the rider, i.e. the intention, say, to ride around in a 20′ circle. While this information is not directly available, it can be usefully inferred from the history of the yaw input. Simply low-pass filtering the data provides an estimate of yaw input. However, this causes a response delay that is noticeable to the rider. On the other hand, if low-pass filtered data are used only when high roll rates are present, the rider is less likely to notice the delay. The algorithm, then, in accordance with a preferred embodiment of the invention, employs a mixer, controlled by roll rate, between direct yaw input and a heavily filtered version.

A transfer function models the amount of roll rate that will couple into the yaw signal. It is a function of various factors, including the design of the yaw input, the rider's ability, and how the rider is holding on to the yaw input. By using this mixing method, the transfer function can largely be ignored or at most minimized through tuning.

The four main tuning points are: How fast the mixer slews to the filtered version, how fast the mixer slews back, what threshold the mix starts and ends, and the corner frequency of the low pass filter (LPF) on yaw input. There are limits to the amount of un-commanded yaw that can be removed due to setting the mix threshold. By setting it high there is more un-commanded yaw, by setting it low there are more false trips and the rider will begin to notice the time lag on the yaw signal. Setting the LPF frequency also has tradeoffs. If yaw is too heavily filtered, then there will be a noticeable delay and a possibility of yaw transients coupling in from the past. Setting it too low reduces the ability of the mixer to remove the transients.

Referring now to FIG. 7G, the mixer block is defined as:
yaw command=F*Yaw Input+(1−F)*Yaw Filtered,

    • where F is the mixer function which is a continuously varying signal between 0.0 and 1.0.

In accordance with various further embodiments of the invention, unintended yaw control is reduced while reacting against the shaft to reposition the body of the rider. The center of rotation at the handlebar may be repositioned, allowing the user to pull laterally on the bar without causing any displacement. In another embodiment, shown in FIG. 7H, shaft 16 is free to move in two coupled degrees of freedom. The user is able lock the bar by limiting one DOF by engaging gears 78 when they are needed to react against the bar. A yaw command may be comprised of an admixture, linear or otherwise, of inputs derived from torque of shaft 16 about its axis and from motion of shaft 16 with respect to the vertical direction.

Alternatively, a force or torque input may be used. A lateral force load cell allows the user to torque the bar in order to reposition it. Likewise, a torque sensitive bar may be provided to allow the user to pull laterally on the bar.

Another issue that must be addressed in handlebar lean control is the effect of turning while moving backwards or in reverse. As described supra, the system may deal with lean turning while moving backward, by switching the direction of the yaw command, to perform a “S-turn” or a “C-turn”. Preferably, the system performs a “S-Turn”. The system may further compensate for the dynamics of turning while moving backward by desensitizing the lean steering movement. Desensitizing the lean steering while reversing can advantageously facilitate using the same equations to generate the yaw command, the resulting system has positive feedback.

Any of these foregoing embodiments may be combined, within the scope of the present invention, with a rotary yaw control input device such as that depicted in FIGS. 3A-3C. In this arrangement the rotary control is used for low speed yaw, and the lean device would be used to command lateral acceleration at higher speeds.

Active Handlebar

In accordance with further embodiments of the invention, an active handlebar system provides for active control of the handlebar angle with respect to the chassis. The handlebar is mounted on a powered pivot. The handlebar is positioned with respect to the chassis based on lateral acceleration and roll angle of the chassis. If the user maintains good coupling with the handlebar, the bar provides assistance in positioning their body to improve lateral stability. A skilled user leans automatically with the bar, exerting almost no lateral force. If an unexpected obstacle or turn is made, however, the active bar can provide assistance to even the most experienced operator. This system is also particularly useful on slopes, both while traversing and during turning maneuvers.

In order to keep the user most stable, the bar should be positioned parallel the resultant vector of lateral acceleration and gravity. In the system described here, lateral acceleration was determined only using the wheel velocities, without taking advantage of any other available state estimator information. Lateral acceleration is given by the equation:
alat=ωv

    • Where ω is the yaw rate and v is the velocity of the transporter. ω is based on the difference in wheel velocities (Vl and Vr) and the wheel track, T.

ω = V l - V r T

v is determined by the average wheel velocity:

v = V l + V r 2

Combing these equations gives:

a lat = ( V l - V r ) T · ( V l + V r ) 2 = V l 2 - V r 2 2 ⁢ ⁢ T

Since tan (alat)≈alat for small angles, the bar position from vertical is proportional to the difference in the square of each wheel speed. This position must be compensated by adding the roll angle of the chassis, which results in a handlebar position based on the vector sum of lateral acceleration and the acceleration due to gravity.

The operation of the active handlebar is further described as follows. The user commands yaw, such as with the rotary yaw input shown in FIGS. 3A-3C. The user may allow the active bar to assist in the user's positioning by rigidly coupling to the handlebar with his arms, or he can maintain a softer coupling and use the active bar to provide him with feedback. In another embodiment, the user preferably commands yaw with the lean of the handlebar as shown in FIGS. 8A-8C. FIGS. 8A-8C show the handlebar response to roll and turning events. Note, in FIG. 8C, the alignment of the handlebar with the user's legs.

FIGS. 9A and 9B show the basic mechanical hardware layout of a powered pivot. The powered pivot is made up of a harmonic drive reduction unit 92 powered by an electric motor 90. The output of the drive is coupled to the control shaft via an adapter 94. The powered pivot creates a torque between the chassis 12 and the control shaft 16 (shown in FIG. 8A), which can be regulated to provide the position control required by the active handlebar system. A harmonic drive is a very compact high reduction ratio gear set that is efficient and backdriveable. It works by using an elliptical bearing, called the “wave generator”, to “walk” a slightly smaller flexible gear 96, called the “flex spline” around the inside of a larger rigid gear, called the “circular spline”. Suitable harmonic drives are available from HD Systems, Inc. of Hauppauge, NY and are described in the appended pages.

The active handlebar system uses standard algorithms to control the wheels. The handlebar is controlled with a position loop that commands a position proportional to the difference in the square of the wheel velocities. Although a theoretical gain can be calculated and converted to the proper fixed point units, in practice it was determined empirically.

The position loop is a standard PID loop using motor encoder data for feedback. The tuning objectives are good ramp tracking, minimum settling time, and minimum overshoot. The loop was tuned using a modified triangle wave.

The handlebar controller used the position at startup as the zero (center) position. The user had to position the bar and hold it centered at startup. Absolute position feedback may be provided to allow the bar to self-center.

Some filtering and dead banding are done to the command before commanding the motor. In a specific embodiment, the filtering was ultimately needed to smooth out any noise on the wheel speeds and dead banding was used to keep the bar still when turning in place on slightly inclined terrains. A 1 Hz first order filtered estimate of lateral acceleration is multiplied by a first gain (typically, on the order of 0.001) and roll compensated by adding roll angle multiplied by a second gain (typically, on the order of 0.15). Afterwards a software induced dead band, and later compensation, of 15% of the max motor position command (typically, 400 counts.) The final result is filtered by a 0.2 Hz filter. This filter may be used to round out the knee introduced at the dead band and to slow down the movement of the handlebar.

Further Mechanical Sensing of Body Position

In accordance with other embodiments of the invention, the position of the rider's body, or of one or more parts thereof, may be sensed mechanically as a means to command yaw or fore/aft motion of a personal transporter. One such embodiment has been described with reference to FIG. 5B. In accordance with another such embodiment, described with reference to FIG. 10A, body sensing is accomplished by a device 910 that tracks the motion of the right knee through a pivot 912 in line with the ankle. Pivot 912 is instrumented with a potentiometer 914, with potentiometer gains adjusted appropriately to the range of motion of the knee. A controller distinguishes between rider motion intended as account for input anomalies caused by terrain. The rider commands a yaw input by shifting his body in the direction he would like to turn, as an experienced rider of a personal transporter would do, shifting his center of gravity towards the inside of the turn to prevent the centripetal acceleration of the powerbase from pulling his feet from under him.

The yaw input device tracks body position by recording the motion of the right knee as it rotates about a longitudinal axis through the right ankle. The rider interacts with the device through a cuff 910 which fits closely around the upper shin just below the knee. The cuff is height-adjustable and padded to allow a snug fit without discomfort. The cuff is attached via an arm to a pivot ahead of the foot, located such that its axis runs longitudinally in relation to the chassis, and in line with the ankle. (Anthropometric data from Dreyfuss Associates' The Measure of Man and Woman suggested the ankle pivot should be approximately 4″ from the baseplate for an average rider wearing shoes). A potentiometer records the angle of the arm in a manner very similar to the twist-grip yaw input device described above with reference to FIGS. 3A-3C.

A mechanical body position yaw input device incorporates a centering mechanism that is described with reference to FIG. 10B. A centering mechanism 920 returns the device to neutral (no yaw input) position when the rider is not in contact with the mechanism, and provides tactile feedback to the user as to the location of the neutral position. Preload (adjustable by adding or subtracting washers) was set such that the rider needed to exert a force of 1 kg to move the device from center. At maximum travel (25° in either direction) the rider experiences a force of approximately 2 kg.

In addition to the pivot axis on which the potentiometer is located, there is another non-encoded axis at ankle height, perpendicular to the first, which allows the cuff to move with the knee as the rider bends knees and ankles during active riding. A torsion spring acts about this non-encoded axis to keep the cuff pressed firmly against the rider. The spring is not preloaded and generates approximately 20 kg/mm per degree, such that the rider experiences a force of 1.5 kg at his knee in a typical riding posture (25° forward of unloaded position) and 3 kg at full forward travel)(50°. At full forward position there is a stop which allows the rider to command pitch torque to the chassis through forward knee pressure.

Due to variations in the underlying terrain, there are situations in which the rider's body position does not necessarily correlate to intended yaw input. One situation is traversing a sideslope, during which time the rider will need to lean uphill to stay balanced. Another situation is striking an obstacle with one wheel, which may cause the machine to roll sharply while the rider stays upright. During both of these situations the potentiometer will record that the body position has moved relative to the machine, which is normally interpreted as a yaw command. While terrain-induced body position presents a challenge to a system which translates body position into yaw, steps can be taken to mitigate these situations. A system discussed below addresses the terrain-induced yaw inputs described above with separate algorithms for side slopes and sudden wheel impacts.

On machines with yaw inputs derived from body position it is necessary to compensate for the difference in roll angle to the bodies' natural tendency to line up with gravity. The only exception to this is the case where there is a sufficient restoring force on the yaw input to overcome the rider's natural tendency to keep the yaw input in-line with their body.

In order to roll compensate the yaw input a calculation needs to be made. This calculation entails measuring the amount of roll angle that couples into the yaw input. The following function is used to calculate a roll compensated yaw input:
roll compensated yaw input=yaw input−(Gain_RollContributionToYawInput*roll).
For example: Gain_RollContributionToYawInput=(1.44/1.0), where 1 count of roll gives 1.44 counts of yaw.

In accordance with another embodiment of the invention, the rider may hit a button which resets their current knee position as neutral.

Although there is no measurable backlash in the centering device, the mechanism can flex before overcoming the centering device preload. This translates to about 1° of knee motion in either direction which does not command a yaw. This can be reduced by increasing the stiffness of the structure relative to the preload. A loose fit between the knee cuff and the knee adds an additional 1-2° of motion that does not produce a signal.

Additionally, the potentiometer may exhibit hysteresis, which may be compensated by addition of a software dead band. Dead band has the advantage of allowing the rider a small amount of motion, which reduces fatigue. However, precision and slalom performance is compromised by dead band. User-adjustable or speed-sensitive deadband may also be embodied.

Asymmetrical gains may be useful to compensate for the asymmetry inherent in measuring the motion of one of two legs. Since body position determines yaw input, appropriate mapping of rider position to lateral acceleration at speed is more significant in this device than in a hand-steered device.

In accordance with another embodiment of the invention, described with reference to FIG. 10C, two steel “whiskers” 930 (approximately 50 cm long and 35 cm apart), are provided at approximately hip height. Leaning left or right pushes on the whiskers and twist the potentiometer (gains are doubled in software). The length of the whiskers is preferred so that the rider, in the course of leaning backwards and forwards, does not exit the device and lose yaw input capability.

Another embodiment of the invention, discussed with reference to FIG. 10D, employs two body torso position sensors 940 with handgrips 942 bolted to either side of the chassis. Smooth planks 944 (approximately 60 cm long and adjustably spaced), are attached to a leaning shaft on either side of the rider's ribcage to sense body position above the waist so as to account for body lean accomplished by bending at the waist. A longitudinal axis of rotation advantageously eliminates lean-sensitive gains that might be present in other designs.

Linear Slide Directional Input

The “linear slide” directional input device is a shear force sensitive means of steering a personal transporter. The device has a platform that can slide in the lateral direction of the machine, directly in line with lateral accelerations seen during turning.

During a turn the user feels a lateral acceleration in the vehicle frame of reference. The lateral acceleration causes a shear force between the user and the vehicle, which is reacted through the footplate and the handlebar. Because the user has two points to react this force, one can be used as a directional input driven through the other. In this implementation the user reacts on the handlebar. The linear slide mechanism measures this reaction through displacement of the platform, and uses it as a directional command. This input method is directly coupled to lateral acceleration, with the user modulating the coupling by reacting off the handlebar. At zero lateral acceleration, the user can create a directional input by pushing laterally on the handlebar. At non-zero acceleration, the user's handlebar force adds to the lateral acceleration force to create the input.

The linear slide mechanism was designed to sit on top of the chassis of a personal transporter, replacing the foot mat assembly. It is marginally smaller that the existing foot plate area to allow for plate displacement. The platform wraps around the control shaft base. The maximum platform travel is approx +/−1 inch. The footplate mechanism 950 is shown in FIG. 11.

The assembly is clamped to the platform of a human transporter with four blocks that capture the base plate of the slide. The blocks allow the assembly to move vertically in order to activate the rider detect switches. Because the weight of the assembly alone is sufficient to activate the switches, it is counterbalanced with two ball plungers. These insure that the rider detect switches only activate when a rider is on the transporter.

The upper platform rides on ½ inch linear ball bearings which, in turn, ride on a ground rod mounted to the lower platform. A spring and stop arrangement provides preloaded centering force.

A linear potentiometer converts the platform position to an analog voltage, which is input to the user interface circuit board in place of the potentiometer employed in conjunction with the twist grip embodiment described above with reference to FIG. 3.

Algorithms for operation of the linear slide yaw input are essentially those of the twist grip yaw input, as described in detail in U.S. Pat. No. 6,789,640, albeit with an opposite yaw gain polarity.

Several embodiments of the invention are related to the device just described. In accordance with one embodiment, individual pivoting footplates are shear sensitive and pivot at a point above the surface of the plate, preferably 4 to 6 inches above the surface. This allows some lateral acceleration coupling, but give the user the ability to stabilize the coupling through leg or ankle rotation.

Alternatively, the linear slide may be moved to the handlebar. This allows a user to use his legs for reacting to lateral accelerations without commanding input. However, since most of the lateral acceleration is reacted in the legs, coupling with lateral acceleration is largely lost by moving the linear slide to the handlebar.

Speed Limiting

In a further embodiment, any of the foregoing embodiments of a vehicle in accordance with the present invention may be provided with speed limiting to maintain balance and control, which may otherwise be lost if the wheels (or other ground-contacting members) were permitted to reach the maximum speed of which they are currently capable of being driven.

Speed limiting is accomplished by pitching the vehicle back in the direction opposite from the current direction of travel, which causes the vehicle to slow down. (As discussed above, the extent and direction of system lean determine the vehicle's acceleration.) In this embodiment, the vehicle is pitched back by adding a pitch modification to the Pitch State Estimator pitch value. Speed limiting occurs whenever the vehicle velocity of the vehicle exceeds a threshold that is the determined speed limit of the vehicle. The pitch modification is determined by looking at the difference between the vehicle velocity and the determined speed limit, integrated over time.

Alternatively, the balancing margin between a specified maximum power output and the current power output of the motors may be monitored. In response to the balancing margin falling below a specified limit, an alarm may be generated to warn the user to reduce the speed of the vehicle. The alarm may be audible, visual, or, alternatively the alarm may be tactile or may be provided by modulation of the motor drives, providing a ‘rumbling’ ride that is readily perceived by the user.

The automatic pitch modification sequence, in response to a detected speed at a specified speed limit, is maintained until the vehicle slows to the desired dropout speed (some speed slightly below the speed limit), and then the pitch angle is smoothly returned to its original value.

One method for determining the speed limit of the vehicle is to monitor the battery voltage, which is then used to estimate the maximum velocity the vehicle is currently capable of maintaining. Another method is to measure the voltages of the battery and the motor and to monitor the difference between the two; the difference provides an estimate of the amount of velocity margin (or ‘balancing margin’) currently available to the vehicle.

The described embodiments of the invention are intended to be merely exemplary and numerous variations and modifications will be apparent to those skilled in the art. In particular, many of the controllers and methods of direction and speed control described herein may be applied advantageously to personal transporters that are not balancing personal transporters. Balancing transporters present particular requirements for combining yaw and balance controls, as discussed in the foregoing description and in U.S. Pat. No. 6,789,640. All such variations and modifications are intended to be within the scope of the present invention as defined in any appended claims.

Claims

1. A method for controlling a transporter, the transporter having at least one ground-contacting element and a controller operatively communicating with the at least one ground-contacting element, the method comprising:

receiving, by the controller, a desired yaw and a desired yaw rate, the desired yaw and the desired yaw rate being based on a body orientation of a load on the transporter;
computing, by the controller, a desired direction of motion of the transporter based on the received desired yaw and the received desired yaw rate;
receiving, by the controller, a pitch of the transporter;
computing, by the controller, a pitch command signal based on the pitch;
computing, by the controller, a command signal based on the desired direction and the pitch command signal; and
providing, by the controller, the command signal to maintain balance of the transporter and motion in the desired direction.

2. The method as in claim 1 further comprising:

receiving, by the controller, the body orientation at least in part from an ultrasonic sensor.

3. The method as in claim 1 further comprising:

receiving, by the controller from an RF transmitter, signals into RF receivers mounted on the transporter; and
processing the signals by electronics mounted on the transporter.

4. The method as in claim 1 further comprising:

receiving, by the controller, signals from an array of receivers mounted on the transporter, the signals identifying the body orientation based on at least one transmitter signal generated by transmitters on the load.

5. The method as in claim 4 further comprising:

receiving, by the controller, time of flight information from the array of receivers; and
computing, by the controller, a lateral position of the load with respect to the transporter based on the time of flight information.

6. The method as in claim 1 further comprising:

computing, by the controller, the command signal based at least in part on pressure exerted by the load on at least one protrusion disposed upon the transporter.

7. The method as in claim 1 further comprising:

computing, by the controller, the command signal based at least in part on pressure exerted by the load on a linear slide mechanism on the transporter.

8. The method as in claim 1 further comprising:

controlling, by the controller, a position of a handlebar disposed upon a shaft disposed upon a platform, the platform supported by the ground-contacting element, the controlling based at least upon one of lateral acceleration and roll angle of the transporter.

9. The method as in claim 1 wherein the transporter comprises a shaft having parallel link bars pivotally coupled to a platform and to a handlebar disposed on the transporter, the platform supported by the ground-contacting element.

10. The method as in claim 1 wherein a handlebar is coupled to a platform by at least one flexure element, the platform supported by the ground-contacting element.

11. A system for controlling a transporter, the system comprising:

at least one ground-contacting element; and
a controller operatively communicating with the at least one ground-contacting element, the controller including: receiving a desired yaw and a desired yaw rate of the transporter, the desired yaw and the desired yaw rate being based on a body orientation of a load on the transporter; computing a desired direction of motion of the transporter based on the received desired yaw and the received desired yaw rate; receiving a pitch of the transporter; computing a pitch command signal based on the pitch; computing a command signal based on the desired direction and the pitch command signal; and providing the command signal to maintain balance of the transporter and motion in the desired direction.

12. The system as in claim 11 wherein the controller further comprises:

receiving the body orientation at least in part from an ultrasonic sensor.

13. The system as in claim 11 wherein the controller further comprises:

receiving, from an RF transmitter, signals into RF receivers mounted on the transporter; and
processing the signals by electronics mounted on the transporter.

14. The system as in claim 11 wherein the controller further comprises:

receiving signals from an array of receivers mounted on the transporter, the signals providing the body orientation based on at least one transmitter signal generated by transmitters on the load.

15. The system as in claim 14 wherein the controller further comprises:

receiving time of flight information from the array of receivers; and
computing a lateral position of the load with respect to the transporter based on the time of flight information.

16. The system as in claim 11 wherein the controller further comprises:

computing the yaw based at least in part on pressure exerted by the load on at least one protrusion disposed upon the transporter.

17. The system as in claim 11 wherein the controller further comprises:

controlling a position of a handlebar disposed upon a shaft, the shaft disposed upon a platform, the platform supported by the ground-contacting element, the controlling based at least upon one of lateral acceleration and roll angle of the transporter.

18. The system as in claim 11 wherein the transporter comprises a shaft including parallel link bars pivotally coupled to a platform and to a handlebar disposed upon the transporter, the platform supported by the ground-contacting element.

19. The system as in claim 11 wherein a handlebar is coupled to a platform by at least one flexure element, the platform supported by the ground-contacting element.

20. The system as in claim 11 wherein the controller further comprises:

receiving a relative height offset of at least one handlebar segment disposed upon the transporter, the desired direction based at least in part on the relative height offset.
Referenced Cited
U.S. Patent Documents
584127 June 1897 Daullette et al.
849270 April 1907 Schafer et al.
2742973 April 1956 Johannesen et al.
3145797 August 1964 Taylor
3179355 April 1965 Pickering et al.
3260324 July 1966 Suarez
3283398 November 1966 Andren
3288234 November 1966 Feliz
3306626 February 1967 Kawada
3348518 October 1967 Forsyth
3374845 March 1968 Selwyn
3399742 September 1968 Malick
3446304 May 1969 Alimanestiano
3450219 June 1969 Fleming
3515401 June 1970 Gross
3580344 May 1971 Floyd
3596298 August 1971 Durst, Jr.
3790150 February 1974 Lippert
3860264 January 1975 Douglas et al.
3872945 March 1975 Hickman et al.
3952822 April 27, 1976 Udden et al.
4018440 April 19, 1977 Deutsch
4062558 December 13, 1977 Wasserman
4076270 February 28, 1978 Winchell
4088199 May 9, 1978 Trautwein
4094372 June 13, 1978 Notter
4109741 August 29, 1978 Gabriel
4111445 September 5, 1978 Hailbeck
4151892 May 1, 1979 Francken
4222449 September 16, 1980 Feliz
4264082 April 28, 1981 Fouchey, Jr.
4266627 May 12, 1981 Lauber
4293052 October 6, 1981 Daswick et al.
4325565 April 20, 1982 Winchell
4354569 October 19, 1982 Eichholz
4363493 December 14, 1982 Veneklasen
4373600 February 15, 1983 Buschbom et al.
4375840 March 8, 1983 Campbell
4414937 November 15, 1983 Ueda et al.
4510956 April 16, 1985 King
4556997 December 10, 1985 Takamiya et al.
4560022 December 24, 1985 Kassai
4566707 January 28, 1986 Nitzberg
4570078 February 11, 1986 Yashima et al.
4571844 February 25, 1986 Komasaku et al.
4624469 November 25, 1986 Bourne, Jr.
4657272 April 14, 1987 Davenport
4685693 August 11, 1987 Vadjunec
4709772 December 1, 1987 Brunet
4716980 January 5, 1988 Butler
4740001 April 26, 1988 Torleumke
4746132 May 24, 1988 Eagan
4770410 September 13, 1988 Brown
4786069 November 22, 1988 Tang
4790400 December 13, 1988 Sheeter
4790548 December 13, 1988 Decelles et al.
4794999 January 3, 1989 Hester
4796716 January 10, 1989 Masuda
4797826 January 10, 1989 Onogi et al.
4798255 January 17, 1989 Wu
4802542 February 7, 1989 Houston et al.
4809804 March 7, 1989 Houston et al.
4834200 May 30, 1989 Kajita
4840248 June 20, 1989 Silverman
4863182 September 5, 1989 Chern
4867188 September 19, 1989 Reid
4869279 September 26, 1989 Hedges
4874055 October 17, 1989 Beer
4890853 January 2, 1990 Olson
4919225 April 24, 1990 Sturges
4941854 July 17, 1990 Takahashi et al.
4953851 September 4, 1990 Sherlock et al.
4964679 October 23, 1990 Rath
4984754 January 15, 1991 Yarrington
4985947 January 22, 1991 Ethridge
4998596 March 12, 1991 Miksitz
5002295 March 26, 1991 Lin
5011171 April 30, 1991 Cook
5012176 April 30, 1991 LaForge
5044457 September 3, 1991 Aikman
5052237 October 1, 1991 Reimann
5098041 March 24, 1992 Uetrecht
5111899 May 12, 1992 Reimann
5124938 June 23, 1992 Algrain
5136219 August 4, 1992 Takahashi et al.
5158493 October 27, 1992 Morgrey
5161820 November 10, 1992 Vollmer
5165711 November 24, 1992 Tsai
5168947 December 8, 1992 Rodenborn
5171173 December 15, 1992 Henderson et al.
5186270 February 16, 1993 West
5215159 June 1, 1993 Nishida
5221883 June 22, 1993 Takenaka et al.
5241875 September 7, 1993 Kochanneck
5248007 September 28, 1993 Watkins et al.
5314034 May 24, 1994 Chittal
5350033 September 27, 1994 Kraft
5366036 November 22, 1994 Perry
5376868 December 27, 1994 Toyoda et al.
D355148 February 7, 1995 Orsolini
5397890 March 14, 1995 Schueler et al.
5408411 April 18, 1995 Nakamura et al.
5419624 May 30, 1995 Adler et al.
5430432 July 4, 1995 Camhi et al.
5502432 March 26, 1996 Ohmamyuda et al.
5645135 July 8, 1997 Peterson, Jr.
5652486 July 29, 1997 Mueller et al.
5676217 October 14, 1997 Torji et al.
5695021 December 9, 1997 Schaffner et al.
5701965 December 30, 1997 Kamen et al.
5701968 December 30, 1997 Wright-Ott et al.
5705746 January 6, 1998 Trost et al.
5746282 May 5, 1998 Fujiwara et al.
5757161 May 26, 1998 Ikkai et al.
5775452 July 7, 1998 Patmont
5791425 August 11, 1998 Kamen et al.
5794730 August 18, 1998 Kamen
5925084 July 20, 1999 Gotoh et al.
5931254 August 3, 1999 Loraas et al.
5971091 October 26, 1999 Kamen et al.
5973463 October 26, 1999 Okuda et al.
5975225 November 2, 1999 Kamen et al.
5979586 November 9, 1999 Farmer et al.
5986221 November 16, 1999 Stanley
6003624 December 21, 1999 Jorgensen et al.
6036619 March 14, 2000 Tashiro et al.
6037861 March 14, 2000 Ying
6037862 March 14, 2000 Ying
6039142 March 21, 2000 Eckstein et al.
6050357 April 18, 2000 Staelin et al.
6052647 April 18, 2000 Parkinson et al.
6059062 May 9, 2000 Staelin et al.
6065558 May 23, 2000 Wielenga
6125957 October 3, 2000 Kauffmann
6131057 October 10, 2000 Tamaki et al.
6141613 October 31, 2000 Fan
6154692 November 28, 2000 Cielaszyk et al.
6205375 March 20, 2001 Naito
6223104 April 24, 2001 Kamen et al.
6225977 May 1, 2001 Li
D444184 June 26, 2001 Kettler
6263261 July 17, 2001 Brown et al.
6288505 September 11, 2001 Heinzmann et al.
6302230 October 16, 2001 Kamen et al.
6332103 December 18, 2001 Steenson, Jr. et al.
6356188 March 12, 2002 Meyers et al.
6367817 April 9, 2002 Kamen et al.
6538411 March 25, 2003 Field et al.
6561294 May 13, 2003 Kamen et al.
6571176 May 27, 2003 Shinmura et al.
6571892 June 3, 2003 Kamen et al.
6581714 June 24, 2003 Kamen et al.
6593849 July 15, 2003 Chubb et al.
6654675 November 25, 2003 Pedersen et al.
D489027 April 27, 2004 Waters
D489029 April 27, 2004 Waters
D489300 May 4, 2004 Chang et al.
D493127 July 20, 2004 Waters et al.
D493128 July 20, 2004 Waters et al.
D494099 August 10, 2004 Maurer et al.
6789640 September 14, 2004 Arling et al.
6868931 March 22, 2005 Morrell et al.
6907949 June 21, 2005 Wang
D507206 July 12, 2005 Wang
6969079 November 29, 2005 Kamen et al.
D528468 September 19, 2006 Arling et al.
7174976 February 13, 2007 Kamen et al.
7370713 May 13, 2008 Kamen
7546889 June 16, 2009 Kamen et al.
7589643 September 15, 2009 Dagci et al.
7789174 September 7, 2010 Kamen et al.
8186462 May 29, 2012 Kamen et al.
8248222 August 21, 2012 Kamen et al.
8830048 September 9, 2014 Kamen et al.
20020063006 May 30, 2002 Kamen et al.
20040007399 January 15, 2004 Heinzmann et al.
20040055796 March 25, 2004 Kamen et al.
20040135434 July 15, 2004 Honda
20050134014 June 23, 2005 Xie
20070001830 January 4, 2007 Dagci et al.
20080197599 August 21, 2008 Comstock et al.
20090115149 May 7, 2009 Wallis et al.
20090224524 September 10, 2009 Rathsack
20120197470 August 2, 2012 Inui
20140058600 February 27, 2014 Hoffmann et al.
Foreign Patent Documents
2048593 May 1971 DE
3128112 February 1983 DE
3242880 June 1983 DE
3411489 October 1984 DE
4110905 October 1991 DE
4404594 August 1995 DE
19625498 November 1997 DE
29808091 August 1998 DE
29808096 August 1998 DE
0109927 May 1984 EP
0193473 September 1986 EP
0537698 April 1993 EP
0551986 July 1993 EP
0663313 July 1995 EP
0746089 April 1996 EP
0958978 November 1999 EP
1063530 December 2000 EP
980237 May 1951 FR
2502090 September 1982 FR
152664 January 1922 GB
1213930 November 1970 GB
2139576 November 1984 GB
52-44933 August 1977 JP
57-87766 January 1982 JP
S57-110569 July 1982 JP
S59-73372 April 1984 JP
60-25580 December 1985 JP
S61-31685 February 1986 JP
62-12810 January 1987 JP
63-305082 December 1988 JP
H01-316810 December 1989 JP
2-190277 July 1990 JP
H04-201793 July 1992 JP
H05-213240 August 1993 JP
H06-171562 June 1994 JP
H06-105415 December 1994 JP
H07-255780 October 1995 JP
8605752 October 1986 WO
8906117 July 1989 WO
9623478 August 1996 WO
9846474 October 1998 WO
0075001 December 2000 WO
Other references
  • Kanoh, H., “Adaptive Control of Inverted Pendulum”, Computrol, vol. 2 (1983), pp. 69-75.
  • Kawaji et al., “Stabilization of Unicycle Using Spinning Motion”, Denki Gakkai Ronbunshi, vol. 107-D, No. 1, Japan (Jan. 1987), pp. 21-28.
  • Koyanagi et al., “A Wheeled Inverse Pendulum Type Self Contained Mobile Robot”, The Society of Instrument and Control Engineers, Special issue of the 31st SICE Annual Conference Demonstration Session, Japan (Jul. 22, 1992), pp. 51-56.
  • Koyanagi et al., “A Wheeled Inverse Pendulum Type Self-Contained Mobile Robot and Its Posture Control and Vehicle Control”, The Society of Instrument and Control Engineers, Special issue of the 31st SICE Annual Conference, Japan (Jul. 22, 1992), pp. 13-16.
  • Koyanagi et al., “A Wheeled Inverse Pendulum Type Self-Contained Mobile Robot and its Two Dimensional Trajectory Control”, Proceedings of the Second International Symposium on Measurement and Control in Robotics, Japan (Nov. 15-19, 1992), pp. 891-897.
  • Momoi & Yamafuji, “Motion Control of the Parallel Bicycle-Type Mobile Robot Composed of a Triple Inverted Pendulum (2nd Report: Driving Control)”, Paper Read at Meeting of Japan Society of Mechanical Engineering (vol. C), vol. 57, No. 541 (Sep. 1991), pp. 154-159.
  • Osaka et al., “Stabilization of Unicycle”, Systems and Control, vol. 25, No. 3, Japan (Mar. 1981) (Abstract only), pp. 159-166.
  • Roy et al., “Five-Wheel Unicycle System”, Medical & Biological Engineering & Computing, vol. 23, No. 6, United Kingdom (Nov. 1985), pp. 593-594.
  • Schoonwinkel, A., “Design and Test of a Computer-Stabilized Unicycle”, Dissertation Abstracts International, vol. 49/03-B, Stanford University (1988), pp. 890-1294.
  • Vos et al., “Dynamics and Nonlinear Adaptive Control of an Autonomous Unicycle—Theory and Experiment”, American Institute of Aeronautics and Astronautics dynamics Specialists Confernece, A90-26772 10-39, Washington, D.C. (Apr. 5-6, 1990), pp. 487-494 (Abstract only).
  • Vos, D., “Dynamics and Nonlinear, Adaptive Control of an Autonomous Unicycle”, Massachusetts Institute of Technology, (Jun. 7, 1989).
  • Vos, D., “Nonlinear Control of an Autonomous Unicycle Robot: Practical Issues”, Massachusetts Institute of Technology, (Jun. 5, 1992).
  • Yamafuji, K. and Kawamura, T., “Study of Postural and Driving Control of Coaxial Bicycle”, Paper Read at Meeting of Japan Society of Mechanical Engineering (vol. C), vol. 54, No. 501, pp. 1114-1121 (May 1988).
  • Yamafuji, K., “A Proposal for Modular-Structured Mobile Robots for Work that Principally Involve a Vehicle with Two Parallel Wheels”, Automation Technology, vol. 20, pp. 113-118 (1988). [[no tie between this reference and the publication document]].
  • Yamafuji et al., “Synchronous and Steering Control of Parallel Bicycle”, Paper Read at Meeting of Japan Society of Mechanical Engineering (vol. C), vol. 55, No. 513, pp. 1229-1234 (May 1989).
  • International Search Report for Application No. PCT/US00/15144 dated Sep. 26, 2000.
  • International Search Report for Application No. PCT/US01/42657 dated Dec. 11, 2002.
  • International Search Report for Application No. PCT/US03/18940 dated Jun. 2, 2004.
  • International Search Report for Application No. PCT/US03/21625 dated Nov. 26, 2003.
  • International Search Report for Application No. PCT/US00/06668 dated Jun. 14, 2000.
  • File History for U.S. Pat. No. 7,370,713, U.S. Appl. No. 09/325,976.
  • File History for U.S. Pat. No. 7,546,889, U.S. Appl. No. 10/462,379.
  • Advisory Action for U.S. Appl. No. 08/474,313 dated Jun. 6, 1997.
  • Office Action for U.S. Appl. No. 08/474,313 dated Dec. 13, 1995.
  • Office Action for U.S. Appl. No. 08/474,313 dated Aug. 5, 1996.
  • Final Office Action for U.S. Appl. No. 08/474,313 dated Feb. 18, 1997.
  • Office Action for U.S. Appl. No. 10/044,590 dated Apr. 5, 2002.
  • Office Action for U.S. Appl. No. 10/044,590 dated Jun. 21, 2002.
  • Watson Industries, Inc., Vertical Reference Manual ADS-C132-1A, 1992, pp. 3-4.
  • Osaka et al., Systems and Control, vol. 25, No. 3, Japan 1981, pp. 159-166 (Abstract Only).
  • Self Supported Carrier Machine and Automatic Carrier Device Using the Same in Patent Abstracts of Japan, Dec. 21, 1989, #63149523, Japanese Patent Office, Japan.
  • Office Action for U.S. Appl. No. 14/619,763 dated Apr. 14, 2015.
  • Office Action for U.S. Appl. No. 14/619,806 dated Apr. 14, 2015.
  • Office Action for U.S. Appl. No. 14/620,284 dated Apr. 10, 2015.
  • Office Action for U.S. Appl. No. 14/626,606 dated Apr. 10, 2015.
  • Office Action for U.S. Appl. No. 14/626,606 dated Apr. 14, 2015.
  • File History for U.S. Pat. No. 6,302,230 , U.S. Appl. No. 09/325,978.
  • File History for U.S. Pat. No. 6,367,817, U.S. Appl. No. 09/635,936.
  • File History for U.S. Pat. No. 6,581,714, U.S. Appl. No. 09/687,757.
  • File History for U.S. Pat. No. 6,796,396, U.S. Appl. No. 10/272,480.
  • File History for U.S. Pat. No. 6,789,640, U.S. Appl. No. 10/308,850.
  • File History for U.S. Pat. No. 6,827,163, U.S. Appl. No. 10/460,053.
  • File History for U.S. Pat. No. 6,779,621, U.S. Appl. No. 10/461,720.
  • File History for U.S. Pat. No. 7,210,544, U.S. Appl. No. 10/617,598.
  • File History for U.S. Pat. No. 6,868,931, U.S. Appl. No. 10/669,879.
  • File History for U.S. Pat. No. 6,553,271, U.S. Appl. No. 09/322,431.
  • File History for U.S. Pat. No. 7,789,174, U.S. Appl. No. 11/672,743.
  • File History for U.S. Pat. No. 8,453,768, U.S. Appl. No. 11/691,903.
  • File History for U.S. Pat. No. 8,925,657, U.S. Appl. No. 13/908,587.
  • File History for U.S. Pat. No. 8,248,222, U.S. Appl. No. 12/879,650.
  • File History for U.S. Pat. No. 6,581,714, U.S. Appl. No. 09/687,789.
  • File History for U.S. Appl. No. 14/446,969.
Patent History
Patent number: 9268333
Type: Grant
Filed: Feb 11, 2015
Date of Patent: Feb 23, 2016
Patent Publication Number: 20150151808
Assignee: DEKA Products Limited Partnership (Manchester, NH)
Inventors: Dean Kamen (Bedford, NH), Robert R. Ambrogi (Manchester, NH), James J. Dattolo (Somerville, MA), Robert J. Duggan (Strafford, NH), J. Douglas Field (Bedford, NH), Richard Kurt Heinzmann (Francestown, NH), Matthew M. McCambridge (Madison, WI), John B. Morrell (Bedford, NH), Michael D. Piedmonte (Warrenton, VA), Richard J. Rosasco (Millersville, MD)
Primary Examiner: Daryl Pope
Application Number: 14/619,763
Classifications
Current U.S. Class: Operation Efficiency (e.g., Engine Performance, Driver Habits) (340/439)
International Classification: G05D 1/02 (20060101); A63C 17/01 (20060101); A63C 17/08 (20060101); A63C 17/12 (20060101); B62D 37/00 (20060101); B62D 51/00 (20060101); B62D 51/02 (20060101); B62D 61/00 (20060101); B62K 1/00 (20060101); B62K 3/00 (20060101); B60L 15/20 (20060101); G08B 6/00 (20060101); G05D 1/08 (20060101);