Patent Grant
10806649
It is an object of this invention to define improvements over the previously patented construction by this inventor (U.S. Pat. No. 6,484,829) entitled “BATTERY POWERED STAIR-CLIMBING WHEELCHAIR” with these new designs offering semi-autonomous control logic with criteria for selecting level, stair, and slope modes, phases for each mode, duties for each axis and command values for each axis to seek target values. A further improvement is means to forward-ascend and backward-descend low height steps, adjust seat height, and adjust legrest while improving the capacity to back up high steps and climb stairs, as well as provide improved sensing spider crowd engagement of steps and stairs. A further improvement is the ability to approach operational stair angle, step height, and slope angle limits and reverse direction to avoid exceeding the operational limits. While this invention is primarily intended for use as a wheelchair for carrying occupants, it could also be used as a vehicle for transporting packages or instruments with the seating removed.
No Federal funds received.
While U.S. Pat. No. 6,484,829 is well suited for aft climbing and forward descending of multiple height steps and stairs, it is not suitable for forward ascending and aft descending of even small steps. Turning around to negotiate low height steps would be a hindrance that would not be tolerated by wheelchair occupants. This invention will provide means to address rising low-height steps in the direction that the wheelchair is facing.
Large diameter wheels are well suited for single low height steps, but larger diameter wheels and tracks do not properly load stairs by resting on stair treads. While large diameter wheels and tracks have been shown to climb stairs, they require high friction to grab step edges. Inadequate coefficient of friction can result in a stair-climbing device sliding down the stairs. This invention will provide means to limit the traction required by U.S. Pat. No. 6,484,829 for balancing force provided by slanted runners resting on a step edge.
U.S. Pat. No. 6,484,829 included spring biased cams that were used to provide control signals which maintain spider crowd engagement with the steps and stairs. The means for monitoring cam angles had several issues, including adjustment slipping, failure to hold the lower cam tips off the ground, lack of absolute angle measurement and large volume required to house it. This invention addresses those issues. This invention also adds additional functions to make the wheelchair more useful including: seat height adjustment for 3-dimensional space home access, legrest forward adjustment to lift feet for forward step or slope climbing and aft legrest adjustment to shorten the wheelchair for tight turns and a folding seatback for compact transport. This invention is shown in
For this invention, down steps in the direction that the wheelchair faces, such as for aft ascending and forward descending are defined as forward down steps, FDS. Up steps in the direction the wheelchair faces, such as for forward ascending and aft descending steps are defined as forward up steps, FUS. Climbing refers to either ascending or descending. The front balancing means or skid system 200 includes articulated skid runners 204 and balancing wheels, or skid wheels 207 and is named the skid system 200 and is shown in
The U.S. Pat. No. 6,484,829 patent accommodated sensing loads from below and the rear on FDS steps by sensing rotation of linkages. This arrangement is not effective for sensing FUS steps when approaching. This invention includes optical distance sensors to indicate the presence of FUS steps. The sensors are time-of-flight, ToF, LIDAR laser distance sensors such as the VL6180 or VL53LOX made by Pololu of Las Vegas, Nev. and mounted to a small circuit board. They measure the time it takes for laser light to reach a surface and return for measuring distance. Several ToF sensors are also used in this invention to determine when a wheel is approaching an up step, approaching a down step, is contacting a surface, or is near or engaging a surface. The vehicle or wheelchair comprises multiple systems attached to a frame.
Skid System 200.
A front balancing means or a skid system 200 is provided for climbing stairs and FDS 203 steps and steep down slopes 455. When not supporting, the skid system 200 is quickly available to provide support by engaging the floor, stair tread or stair edge.
Skid system 200 engagement is monitored by three means. A pair of forward step ToF sensors 202 monitor virtual engagement to up steps 201 (FUS) forward of the skid wheel 207 (see
To engage, the skid system 200 is controlled to target a given engagement to a step in front of the skid wheel 207 (KLFT_EMT or KRFT_EMT) or is controlled to target a skid wheel 207 distance to the floor (KWT_EMT) or is controlled to target a given skid runner 204 deflection (KGLA_EMT or KGRA_EMT). The pair of skid runner 204 rotary sensors 216 are included in skid runner deflection sensing devices 206. Sensing devices 206 are included on the left and right sides of the skid system 200 and are used to control engagement, steering, or supporting as required. The wheelchair forward step height (WF_HT) 231 and advancing direction (ADV) are monitored to sense the skid system 200 approaching and up (FUS) or down step (FDS).
(SKD_APR_FUS=(WF_HT>1) & ADV) and
(SKD_APR_FDS=(WF_HT<−1) & ADV) to begin the STAIR mode logic (MSL).
A positive skid engagement axis command value (SKD_ENG) lowers the skid system 200 increasing the skid system engagement (SKD_EMT) for a skid system engagement target (SKD_EN_TG) higher than the engagement (SKD_EMT).
(SKD_ENG=JEL*(SKD_EN_TG−SKD_EMT)).
A positive skid system axis position command value (SKD_PN) lowers the skid system 200 and increases the skid system position value (SKD_ANG) for an angle target (SKD_PN_TG) higher than the skid system angle.
(SKD_PN=+JEL*(SKD_PN_TG−SKD_ANG))
A positive skid system axis pitch control command value (SKD_PC) lowers the skid system 200 and raises the pitch (CHR_ATT) for target (PTC_TG) higher than the pitch.
(SKD_PC=+JEL*(PTC_TG−CHR_ATT))
Caster System 300.
The caster system 300 provides rear balance support for climbing stairs, FUS 301 steps, FDS 302 steps and steep slopes 324. The caster system 300, like the skid system 200 must be available to quickly provide support when needed. This invention includes one centrally located caster multi-direction wheel 303 for support and a caster wheel-to-step ToF sensor 304 for sensing engagement or support. Caster multi-direction wheel 303 also provides support for PHS_1, LEVEL TRAVEL, to enable lifting the aft drive wheels 602 off the horizontal surface 101 to avoid tire scrubbing. See
A positive caster axis engagement command value (CST_ENG) raises the caster system 300 reducing caster engagement (CST_EMT) for an engagement larger than the engagement target (CST_EN_TG).
(CST_ENG=+JEL*(CST_EMT−CST_EN_TG))
A positive caster position control command value (CST_PN) raises the caster system 300 increasing the caster position (CST_ANG) for a position target (CST_PN_TG) larger than the caster position.
(CST_PN=+JEL*(CST_PN_TG−CST_ANG))
A positive caster pitch control command (CST_PC) raises the caster system 300 increasing the pitch for a pitch target (PTC_TG) higher than the pitch (CHR_ATT).
(CST_PC=+JEL*(PTC_TG−CHR_ATT))
Spider System 400.
Drive wheels 601/602 provide primary wheelchair support on step treads 225 and other horizontal surfaces 101. To maintain the drive wheels 606 axis within step treads 225 fore and aft limits during climbing steps, spider crowd engagement (CWD_LFT and CWD_RHT) to riser is controlled. Devices existing in the prior art employed cams that rotated in unison with the wheel clusters or spiders by a gear system connecting the spider cams and the spiders. A spring-loaded joint permitted the cams to deflect as an indication of engagement. A friction joint provided adjustment means and a mechanical fuse to avoid overloading the system. These prior-art systems can slip out of adjustment and require correction. The system also did not provide an absolute angle reading, so the wheelchair must be powered up from a known spider angle to report accurate readings. The spider spoke angle (SD_ANG) 951 is measured clockwise as viewed in
The spider system 400 addresses prior issues with new features. The means to force the spider cams 401 to move in unison with the spider spokes 402, permit limited deflection, and preload to move in unison is relocated to the spiders 403 and accomplished with posts 404 inside spider internal cam cutouts 405 in the spider cam 401 rather than with gearing. See
The measured difference between spider 403 and spider cam 401 angles is the spider crowd engagement angle (CWD_LFT or CWD_RHT). The drive wheels 601/602 travel is controlled to a target cam engagement angle during climbing to maintain engagement to FDS 410 step riser. See
Front drive wheel-to-step height sensors 411 on the front side of the gearbox 102 and in line with front drive wheels 601 monitor the distance to a surface below. See
RDW wheel-to-step sensor 412 is provided on the back side of the gearbox 102 and in line with the RDW wheels 602. See
Spider Drive System 500.
The spider motor 501 is a brushless direct drive motor located inside the gearbox 102. See
The spider motor 501 rotor is connected to two planetary gear stages. See
A positive spider rotate command (SPD_RO) increases the spider angle to ascend (BCK) an FDS 410 step and a negative command decrease the spider angle to descend an FDS step.
(SPD_RO=+JLE*(BCK−ADV)*SPDR_OK)
A positive spider pitch control command value (SPD_PC) increases the spider angle (SD_ANG) and lowers the pitch (CHR_ATT) for a pitch higher than the target (PTC_TG).
(SPD_PC=+JEL*(CHR_ATT−PTC_TG)*SPDR_OK).
A positive spider position control command (SPD_PN) increases the spider angle (SD_ANG) for position target (SPD_PN_TG) higher than the position.
(SPD_PN=+JEL*(SPD_PN_TG−SD_ANG)*SPDR_OK)
A positive spider crowd engagement control value (SPD_EN_CAM) increases spider angle (SD_ANG) and increases spider cam 401 engagement for engagement on the below the spider and with support by the forward drive wheel 601 (PHS_6 and PHS_8) for a target (SPD_EN_TG) greater than cam engagement (CWD_MIN).
(SPD_EN_CAM=+JEL*(SPD_EN_TG−CWD_MIN)
A positive spider control skid system 200 engagement value command (SPD_EN_SKD) increases spider angle (SD_ANG) lowering the skid system 200 and increasing skid system engagement (SKD_EMT) for skid system 200 engage target (SKD_EN_TG) higher than skid system 200 engagement. In the up-slope mode, MP3, the spider angle (SD_ANG) is limited to the value for up slopes by the M3_SPD_LM_OK criteria. If the slope is too steep and the spider system 400 is unable to reduce the skid engagement (SKD_EMT) to the skid engage target (SKD_EN_TG) by increasing spider angle (SD_ANG) because it is prevented by the M3_SPD_LM_OK criteria, the spider system 400 holds the spider angle (SD_ANG) position 930. The position is held until the skid engagement (SKD_EMT) is reduced to less than the skid engage target (SKD_EMT<SKD_EN_TG) and the spider system 400 resumes skid engagement SPD_EN_SKD). Limiting SD_ANG avoids the possibility of overshooting with possible support by the rear drive wheels 602 and a potential tip back on an up-slope.
(SPD_EN_SKD=JEL*((SKD_EN_TG−SKD_EMT)*(M3_SPD_LM_OK or (SKD_EN_TG>SKD_EMT))*SPDR_OK)
Drive System 600.
The drive system 600 is enclosed in the gearbox 102 and spiders 403 and located on the left and right side of the wheelchair 100. The drive wheel motors are brushless direct drive motors 603 located inside the gearbox 102. See
The drive wheels 606 are braked when the wheelchair is not commanded to move. The prior invention incorporated motors with spring loaded and electrically released brakes. This invention uses direct drive motors that do not include brakes. This invention includes externally mounted drive wheel brakes 607 which are geared to the drive wheel motors 603. See
For advancing (ADV) or pivoting (PVT), the left turn command value (DR_JS_ST_LH) drives the right drive wheels 606 forward for a forward left turn with a positive JLA joystick axis value. Advancing (ADV) is a forward joystick deflection. Pivoting (PVT) is a lateral joystick deflection. Backing (BCK) is an aft joystick deflection. For backing (BCK), the left turn command value (DR_JS_ST_LH) drives the right drive wheels backward for a negative joystick axis value (JRA) for a backing left turn. Right turn command values (DR_JS_ST_RH) are a mirror copy of left turn values. JLA values are positive for joystick deflection forward and to the left and negative for aft and to the right. JRA values are positive for joystick deflection forward and to the right and negative for aft and to the left.
(DR_JS_ST_LH=+(JLA*(ADV+PVT)+JRA*BCK)*TRVL_OK)
(DR_JS_ST_RH=+(JRA*(ADV+PVT)+JLA*BCK)*TRVL_OK)
A positive left hand cam steering command value (DR_CAM_STR_LH) drives the right drive wheels forward to reduce cam engagement for a right spider crowd engagement (CWD_RHT) greater than the right spider crowd engagement target (DR_EN_TG_RH). DR_CAM_STR_RH is a mirror copy of DR_CAM_STR_LH.
(DR_CAM_STR_LH=+JLE*(CWD_RHT−DR_EN_TG_RH)*TRVL_OK)
(DR_CAM_STR_RH=+JLE*(CWD_LFT−DR_EN_TG_LH)*TRVL_OK)
A positive left hand caster steering command value (DR_CST_STR_LH) drives the right drive wheels forward to reduce the right hand caster runner engagement (CSRA_EMT) for a caster runner engagement greater than the caster engagement target (CST_EN_TG). The right hand caster steering command value (DR_CST_STR_RH) is a mirror copy of DR_CST_STR_LH.
(DR_CST_STR_LH=+JLE*(CSRA_EMT−CST_EN_TG)*TRVL_OK))
(DR_CST_STR_RH=+JLE*(CSLA_EMT−CST_EN_TG)*TRVL_OK))
A negative left hand skid engage command value (DR_SKD_EN_LH) with left drive wheels backing and negative JRA value drives the right drive wheels backwards to increase the right skid runner engagement (KGRA_EMT) to skid system engagement target (SKD_EN_TG). DR_SKD_EN_RH is a mirror copy of DR_SKD_EN_LH.
(DR_SKD_EN_LH=+JRA*(SKD_EN_TG−KGRA_EMT)*TRVL_OK)
(DR_SKD_EN_RH=+JLA*(SKD_EN_TG−KGLA_EMT)*TRVL_OK)
Command values are reduced by the factor TRVL_OK for safety reasons.
Legrest System 700.
Providing a low seat height requires the wheelchair occupant's feet to be raised to accommodate forward step (FUS) or UP-SLOPE mode (MP3) climbing. See
A positive extend legrest command (LR_OP with RT_LR) extends legrest actuator 713 increasing the legrest angle (LR_ANG) to retract the legrest and a negative value (LR_OP with EX_LR) extends the legrest.
(LR_OP=+RT_LR−EX_LR)
Seat Height Adjustment System 800.
Seat height adjustment enhances access to high cabinets by raising the seat height or permits table approach by lowering the seat. Seat height adjustment also facilitates lateral occupant transfers by matching transfer surface heights or adjusting to move from a higher to a lower surface. The seat height adjustment system 800 is the well-known scissors type. This invention accommodates lower seat heights than the prior invention by reduced gearbox height made possible with the cam angle gear system removed. Space for a central pole type seat height adjustment system is not available.
A positive raise the seat command value (ST_OP) increases the seat angle (SH_ANG) to raise the seat and a negative value lowers the seat.
(ST_OP=+RS_ST−LW_ST)
Control System and Operations
The control system consists of multiple sensors including rotary position sensors, ToF distance sensors, an inclinometer, an occupant operated joystick, toggle switches, lighted push button switches, electric motor drives, 36-volt DC batteries, electric control cables, electric power cables, relays, and a system controller 104. The system controller includes a computer with I/O devices for reading I2C and SPI and analog signals and outputting PWM or analog DC signals for motor controls and relay signals for other functions. The inclinometer provides the pitch angle 940 (CHR_ATT) of a notional frame horizontal plane 901 to horizontal 900. See
The control system provides semi-autonomous operation with three operating modes: LEVEL, STAIR, and SLOPE. The mode request and active variables are QLL, QPL, MLL, MSL, and MPL; where the first letter Q is requested, M is active, the middle letter L is LEVEL, S is STAIR, P is SLOPE, and the end letter L is logic. Each mode has phases of operation. Each operation axis has specific duties depending on the phase and sensor values related to criteria. The system is controlled by real time condition status. The control system follows the path in the
Mode and phase flow paths are shown in
Runner and wheel engagement values are assigned a value from 0 to 25, with 0 being fully disengaged and 25 being fully compressed and supporting. An undeflected runner or 0° deflection is assigned an engagement value of 0. A fully deflected runner or 25° is assigned a value of 25. Engagements of the skid wheels to a front step, the skid wheels to a horizontal surface, and the caster wheel to a horizontal surface are monitored using time of flight laser sensors. Engagement range is selected to be 0.5 inches below the wheel. The engagement distance is the engagement range minus the distance of a horizontal surface below the wheel (WF_HT, KWT_HT, FDW_HT, RDW_HT, CW_HT, and WR_HT). A ToF generated engagement distance value equal to the engagement range is assigned an engagement value of 0. A distance value of 0 inches below the wheel is assigned an engagement value of 25. Engagement of the drive wheels is like the skid and caster wheels except that the vertical position of the drive wheels includes a function of spider geometry and spider angle. See
The control values are evaluated to determine status for selecting modes and phases. A tolerance is needed to avoid reading errors. For example, a runner or engagement value of less than 3 would indicate that the device was disengaged. An engagement value of greater than 22 would indicate that the device was fully compressed or supporting. Tolerances are not included in equations in this application for simplicity. Logic criteria are assigned a value of 0 for false or 1 for true.
Limited wheelchair steering is provided on the steps by control variations from joystick inputs to the left and right drive wheel targets (DR_EN_TG_LH and DR_EN_TG_RH). When advancing (ADV) or descending stairs, a full speed left turn signal (JLA=10) decreases the left turn motor target (DR_EN_TG_LH) by 2°. A smaller left turn target results in less engagement of the spider cam 401 on the right side, which turns the wheelchair to the left by increasing the right drive wheel 606 distance to the step riser 410. Similarly, a full speed right turn signal (JRA=10) results in a right turn. If both JLA and JRA are at full speed, the left and right turns cancel, and the wheelchair descends straight. JLA value larger than JRA value results in a left turn. JRA larger than JLA value results in a right turn. In either case, the spider cams 401 always target step engagement. For ascending steps or backing (BCK), JLA and JRA are reversed to steer in the joystick pointed direction. (DR_EN_TG_LH=+5−0.2*(JLA*ADV+JRA*BCK))
(DR_EN_TG_RH=+5−0.2*(JRA*ADV+JLA*BCK))
Travel speed (DR_JS_ST, DR_CST_STR, DR_CAM_STR, DR_SKD_EN) is reduced or halted by a speed factor (TRVL_OK) as needed to provide other systems time to restore pitch errors or provide the occupant react time to avoid obstacle operational limits.
STAIR mode (MSL) travel requires the seat to be down (SH_DWN) and control logic not sensing approaching operational stair angle or step height limits (MSL_T_OK). The seat height factor (SH_FTR) is 0.0 for seat not down (not SH_DWN) for STAIR and SLOPE mode, 0.5 for seat not down (not SH_DWN) in LEVEL mode or 1.0 in LEVEL mode with seat down (SH_DWN).
SH_FTR=SH_DWN*((MSL+MPL+0.5*MLL)+0.5*MLL
MSL_T_OK includes:
The MSL_T_OK factor is 0.0 when traveling toward or approaching an operational angle or height limits and is 1.0 (MSL_T_OK=1) when departing or not approaching an operational obstacle limit. An MSL_T_OK=0 and reduces TRVL_OK by 90% when approaching an operational limit. It does not reduce the value when departing the operational limit, so that the wheelchair can reverse direction and abort the ascent or descent.
Stair angle OK for backing for ascending from a lower landing (STR_BCK_OK) criteria, see
(STR_BCK_OK=BCK & CST_RSD & SKD_CN_R_PTC or ADV or not MSL).
Stair angle OK for advancing for descending from an upper landing criteria, see
(STR_ADV_OK=ADV & not CST_RSD & SKD_CN_R_PTC or BCK or not MSL).
The step height OK for backing for ascending an FDS step (FDS_BCK_OK) criteria, see
(FDS_BCK_OK=BCK & CST_RSD & DN_STP_OK or ADV or not MSL.
The step height OK for advancing for descending and FDS step (FDS_ADV_OK) criteria, see
(FDS_ADV_OK=ADV & DN_STP_OK or BCK or not MSL)
The step height OK for advancing to ascend a step (FUS_ADV_OK) criteria, see
(FUS_ADV_OK=ADV & SPD_FUS_OK or BCK or not MSL)
Step height OK for backing to descend a forward up step (FUS_BCK_OK) criteria, see
FUS_BCK_OK=BCK & CST_ENGD & not PTC_HI or ADV or not MSL
The SLOPE mode (MPL) travel requires the seat to be down (SH_DWN) and control logic not sensing approaching operational slope angle limits (MPL_T_OK). MPL_T_OK includes:
The MPL_T_OK factor is 0.0 when traveling toward or approaching an operational slope angle limits and 1.0 (MPL_T_OK=1) when not approaching or departing an operational slope angle limits. An MPL_T_OK=0 and reduces TRVL_OK by 90% for approaching an operational limit. It does not reduce the value when departing the operational limit, so that the wheelchair can reverse direction and abort the ascent or descent.
The down-slope angle OK for backing (BCK) for ascending from a lower landing criteria, see
(SKD_DN_SL_OK=SKD_ANG<57°)
Beginning the slope ascent from a lower landing is indicated by the caster system 300 raised by engagement with the slope (CST_RSD=CST_ANG>13). The criteria is ignored when the wheelchair 100 is advancing (ADV) or is not in DOWN-SLOPE mode (not MP2) (DSLP_BCK_OK=BCK & CST_RSD & SKD_DN_SL_OK & SPDR_LV_SPT or ADV or not MP2).
The down-slope angle OK for advancing for descending from an upper landing (DSLP_ADV_OK) criteria, see
(DSLP_ADV_OK=ADV & not CST_RSD & SKD_DN_SL_OK & SPDR_LV_SPT or BCK or not MP2).
The up-slope OK for advancing (ADV) to ascend from a lower landing (USLP_ADV_OK) criteria is verified by advancing (ADV) from a lower landing to an up-slope, the caster can lower pitch (CST_CN_L_PTC) and on an up-slope less than a limiting up-slope angle. The up-slope angle OK (M3_SPD_LM_OK) is indicated by a spider angle (SD_ANG) 930 less than a spider angle for the front drive wheels 601 contacting a limiting up-slope 934 connecting the skid wheels 207 with the skid system 200 full up (SKD_UP) to the caster wheel 303 with said caster system 300 full down (CST_DWN) and the seat frame level (PTC_LVL). See
(CST_CN_L_PTC=not CST_DWN or not CWT_SUPT or not PTC_HI).
The USLP_ADV_OK criteria is ignored when the wheelchair is backing (BCK) or not in UP-SLOPE mode (not MP3);
(USLP_ADV_OK=ADV & SKD_RSD & CST_CN_L_PTC & M3_SPD_LM_OK or BCK or not MP3).
The up-slope OK for backing for descending from an upper landing (USLP_BCK_OK) criteria, see
(USLP_BCK_OK=BCK & not SKD_RSD & CST_CN_L_PTC & M3_SPD_LM_OK or ADV or not MP3).
The speed factor (TRVL_OK) is reduced to 10% by any of the following:
The speed factor (TRVL_OK) is reduced to zero by any of the following
The skid system 200 does not engage in the LEVEL mode because it is not needed for potential balance support. STAIR Mode with skid system 200 engagement (SKD_ENG) is invoked when an FDS or FUS is encountered.
The travel speed factor (TRVL_OK) also includes a pitch factor (PTC_FTR) and a roll factor (ROLL_FTR) for reducing speed when the pitch (CHR_ATT) deviates from the pitch target value (PTC_TG), see
The control system controls all axis based on algorithm and with minimal inputs from the occupant for semi-autonomous control.
1Zero values at components undeflected and in level mode positions shown in FIG.1C.
2120 added as required for positive value
3120 added as required for positive value
4See FIG. 5 for derivation
5CST_RN_EMT excluded to force caster wheel engagement
(FDW_HT=FDW_RD−1.7−6.0*sine(180°−SD_ANG)−4.0).
The front drive wheel 601 is considered engaged if the drive wheel is within a wheel engagement range (W_EN_RG) 954 of a lower surface. The front drive wheel engagement distance (FDW_ED) 955 is the wheel engagement range (W_EN_RG) 954 minus the surface height (FDW_HT) 953. The front drive wheel engagement value (FDW_EMT) is 25*(FDW_ED/W_EN_RG) for full engagement equal 25 and for no engagement equal to 0.
The rear drive wheel height 957 (RDW_HT) to a surface under the drive wheel is the rear drive wheel sensor 412 reading (RDW_RD) 956 minus the vertical height from the sensor 412 to the underside of the rear drive wheel 602. The vertical height from the sensor is 1.7 inches plus the spider spoke length (6.0 inches) times the sine of the rear spider spoke angle (SD_ANG) 951 plus the drive wheel radius (4.0 inches).
(RDW_HT=RDW_RD−1.7−6.0*sine(SD_ANG)−4.0).
The rear drive wheel 602 is considered engaged if the drive wheel is within a wheel engagement range (W_EN_RG) 954 of a lower surface. The rear drive wheel engagement distance (RDW_ED) 958 is the wheel engagement range (W_EN_RG) minus the surface height (RDW_HT) 957. The rear drive wheel engagement value (RDW_EMT) is 25*(RDW_ED/W_EN_RG) for full engagement equal 25 and for no engagement equal to 0.
(KLFT_HT=(KLFT_RD−4.05)*cosine(22°))
(KRFT_HT=(KRFT_RD−4.05)*cosine(22°)).
Forward step engagement value is 25 times the engagement range (W_EN_RG) minus the forward step height divided by the engagement range.
(KLFT_EMT=25*(W_EN_RG−KLFT_HT)/W_EN_RG)
(KRFT_EMT=25*(W_EN_RG−KRFT_HT)/W_EN_RG)
Forward step engagement (KLFT_EMT or KRFT_EMT) is a value from 0 to 25 with a value of 25 for the forward step height 228 equal to 0 (KLFT_HT=0 or KRFT_HT=0) and forward step engagement is 25 for the step height equal 0 (KLFT_HT=0 or KRFT_HT=0).
The skid wheel height sensing means includes the skid wheel-to-step height sensor 205 attached centrally to skid crossbar 210, located adjacent to the skid wheels 207 and aimed down with sensor reading 229 (KWT_RD). The skid wheel step height 230 (KWT_HT) is the vertical distance to a horizontal surface 101 from skid wheels 207 and is computed from installation geometry and sensor reading 229 (KWT_RD).
(KWT_HT=(KWT_RD−3.77)*cosine(8°)).
Skid wheel engagement value is 25 times the engagement range (W_EN_RG) minus the skid wheel step height divided by the engagement range.
(KWT_EMT=25*(W_EN_RG−KWT_HT)/W_EN_RG)
(KWT_EMT=25*(W_EN_RG−KWT_HT)/W_EN_RG)
Skid wheel engagement (KWT_EMT) is a value from 0 to 25 with a value of 0 for skid wheel step height 230 (KWT_HT) equal the wheel engagement range (W_EN_RG). Skid wheel engagement is equal to 25 for the skid wheel step height 230 (KWT_HT) equal 0. A 25 skid engagement value is considered compressed or supporting. A Skid wheel engagement value greater than 0 is considered engaged.
A wheelchair forward step height (WF_HT) 231 is the skid wheel-to-step height 230 (KWT_HT) minus the largest forward step height relative to the skid wheel (KLFT_HT or KRFT_HT) 228.
(WF_HT=KLFT_HT−KWT_HT) or
(WF_HT=KRFT_HT−KWT_HT).
A positive WT_HT indicates an FUS 201 and a negative WT_HT indicates an FDS 203. The skid system 200 advancing to a down step (SKD_APR_FDS) is indicated by a less than −1.0 inch forward down step (FDS 203) and advancing.
(SKD_APR_FDS=(WF_HT<−1) & ADV)
Skid system 200 approaching a forward up step indication (SKD_APR_FUS) comprises advancing to wheelchair forward up step 201 as indicated by a greater than 1.0 inch forward up step height (WF_HT) 231 and advancing (ADV).
(SKD_APR_FUS=(WF_HT>1) & ADV)
(For (−6°>CHR_ATT−PTC_TG<6°): PTC_FTR=1−0.0278*(CHR_ATT−PTC_TG){circumflex over ( )}2.
(For (−6°>ROLL_ATT<6°): ROLL_FTR=1−0.0278*ROLL_ATT{circumflex over ( )}2).
(CWT_HT=(CWT_RD−8.8)*cosine(5.0°))
The wheelchair rear step height 332 (WR_HT) is the height of a step behind the wheelchair and is computed from installation geometry and rear step reading 326 (RSTP_RD) plus caster wheel height (CWT_HT).
(WR_HT=(12.7−RSTP_RD)*cosine(31°)+CWT_HT)
Forward down step for an FDS 410 WR_HT 328 is a positive value. Rear step height for an FUS 301 WR_HT 327 is a negative value. See
(CST_APR_FUS=(WR_HT<−0.5) & BCK).
A rear low step 428 (RE_LO_STP) is indicated by an FDS height between 0.5 and 4 inches (RE_LO_STP=0.5<WR_HT<4). A rear high step 410 (RE_HI_STP) is indicated by an FDS 410 height equal or greater than 4 inches (RE_HI_STP=WR_HT≥4).
The spider cam tip 427 is truncated to permit the spider system 400 to back over a rear low height steps 428 without spider cam 401 engagement for PHS_3. To ensure spider cam 401 engagement for steps which are slightly higher than a rear low height step 428, the spider system 400 is rotated in the PHS_9A to the position shown in
SL_ANG=SL_ANG_RD/3+Ct
SR_ANG=SR_ANG_RD/3+Ct
The spider rotation angle 951 (SD_ANG) is measured clockwise from a frame aft horizontal line 457. See
LEVEL, STAIR, or SLOPE mode are selected based on occupant requests and status of current obstacles criteria from Table 2 and coded logic. For each mode, various operation phases are invoked as the wheelchair updates the criteria during obstacle negotiation including current component positions, the engagement to obstacle, occupant inputs and so on per the evaluation criteria and values. See Table 3 and
Each axis is commanded to seek a position, wheelchair pitch, or device engagement target or speed. See Table 4 for targets.
In each phase, each axis including skid, spider, caster, left drive wheels, and right drive wheels is assigned a unique duty to engage, pitch control, control position, rotate or travel. Legrest and seat height adjustment are adjusted by the occupant as needed. Some axis may move in relation to another axis, such as spider angle rotating to a position as a function of a drive wheel travel variable. Some duties control pitch such as by raising or lowering the skid system or to control position to a predetermine target or to target a given engagement value. See Table 5 for axis duties for each phase.
Each axis is commanded to operate at a speed and direction based on the assigned duty and its target. Command equations compute values. The equations include control values, evaluation criteria, speed reduction criteria or other factors. For example, travel motion may be reduced or halted, if the pitch is too far from the pitch target. See Table 6 for axis direction and speed command values for each duty. Gain value constants are required but omitted in Table 6 for simplicity.
Control values, mode, phase, and control value data is saved to a file for later use for refining the code or understanding the wheelchair operations.
The command values are written to external electric motor drives as analog +/−10 voltage signal or PWM signals, to relays to operate brake releases, relays to operate the legrest or seat height adjustment or LEDs to indicate mode or other status. The cycle repeats until the system is shut down.
PHS_1, LEVEL TRAVEL, is invoked in the LEVEL mode (MLL) and both remain active until the STAIR mode (MSL) or SLOPE mode (MPL) are invoked. LEVEL mode (MLL) travel is slowed with the seat raised (not SH_DWN).
If MLL is active, the criteria for STAIR mode (MSL) is evaluated and switched to STAIR mode if the criteria meets the STAIR mode (MSL) criteria. The criteria for invoking the STAIR mode is LEVEL mode active and any of the following
The SLOPE mode (MPL) is requested by pushing the QPL request switch from the LEVEL mode (MLL). SMALL ANGLE SLOPE mode (MP1), is initially invoked in the MPL mode and remains active until the slope decreases and down-slope mode (MP2) is invoked from MP1 either by:
MP1 also ends when the slope increases and the UP-SLOPE mode (MP3) is invoked by:
MP3 switches back to MP1 when the caster wheel 303 is not compressed (not CWT_SUPT) or pitch is low (PTC_LO). See
PHS_5, 4-WHEEL DRIVE, is the default phase in the STAIR mode (MSL) if no other phase is active and the front drive wheel 601 and rear drive wheels 602 are in a limited horizontal range (SPDR_4WD). PHS_5 ends when another phase is invoked, or lower drive wheels are at different levels as indicated by not SPDR_4WD.
PHS_9, SPIDER CLIMB, is invoked if no other phase is active and the spider angle criteria for selecting PHS_5 is not met, not SPDR_4WD. PHS_9 ends when PHS_5, PHS_7B, PHS_7D or PHS_9A are invoked.
PHS_2, FWD STEP APPROACH, is invoked with the legrest raised (LR_LFT) and forward up step indicated by a forward step sensed and advancing as indicated by (SKD_APR_FUS). PHS_2 ends when (SD_ANG>35°)
PHS_6, FDW & CSTR SUPT, is invoked from PHS_5 when backing (BCK) down an FUS 301 step as indicated by the rear drive wheels 602 not supporting (not RDW_SUPT) and the skid system 200 is not low (not SKD_LOW) and the spider cams 401 become engaged (SPDR_ENGD). Drive wheel travel (DR_TRVL) is reset when PHS_6 is invoked. PHS_6 ends when the wheelchair 100 has backed sufficient to disengage spider cams 401 as indicated by backing (BCK) 3 inches (DR_TRVL<−3), and then PHS_5 is re-invoked.
PHS_3, 4-WHEEL BACKING, is invoked from PHS_5 when backing (BCK) on a horizontal surface 101 against a FDS 428 step and the caster runners 319 are deflected (CST_RN_ENGD) and the rear step height ToF sensor 322 detects a rear low step 428 (RE_LO_STP). See
PHS_9A, SPIDER TIP ROTATION is invoked from PHS_5 if the ToF sensor 322 detects a high step (RE_HI_STP) 410, caster runners 319 are engaged (CST_RN_ENGD) and backing (BCK). PHS_9A ends when the spider system 400 reaches an upper angle limit (SD_ANG>SPD_HI_STP) and then PHS_9 is invoked.
PHS_7B, SPIDER ASCEND LANDING, is invoked from backing (BCK) in PHS_5 or PHS_9 when skid system 200 is supporting (SKD_SUPT), rear drive wheels 602 are on an FDS 410, 428 step and supporting (SPDR_ON_FDS) and caster runners 319 not engaged (not CST_RN_ENGD). PHS_7B ends when the front drive wheels 601 are on an FDS 410, 428 step, and engaged (FDW_ENGD) or caster runners 319 are engaged (CST_RN_ENGD). Then PHS_5 is invoked.
PHS_7D, SPIDER DESCEND LANDING, is invoked from PHS_5 when front drive wheel 601 departs an FDS step, spider near level (SPDR_ON_STP), and the caster runners 319 are not engaged (not CST_RN_ENGD). (FDS_ADV_P5=SPDR_ON_STP & ADV & (FDS_HT>4) & not CST_RN_ENGD). PHS_7D ends when spider 403 is rotated adequately for spider crowd engagement as indicated by spider angle less than 23° (SD_ANG<23°), and then PHS_9 is invoked.
PHS_8, SPIDER FUS ASCEND, is invoked from PHS_5 when advancing (ADV) up an FUS 301 step, the spider is engaged (SPDR_ENGD) and the front drive wheel 601 is rotated up onto a forward up step landing (SPDR_ON_FUS=(SD_ANG>33°) & FDW_SUPT). See
PHS_4, CASTER LIFT/ADV FOR FUS ASCEND, is invoked when PHS_8 ends. PHS_4 ends when the caster is lifted to the level equal to the step landing and the caster wheel is firmly on the FUS step landing 454 as indicated by the caster wheel 303 engaged and the caster system 300 at the level position (CWT_ENGD and CST_HORZ). PHS_5 is re-invoked when PHS_4 ends.
Note: for PHS_9 with the skid system 200 supporting, SKD_RN_EMT=25, the caster runner not supporting (not CST_RN_SUPT=1), skid runner supporting (not SKD_RN_SUPT=0) the pitch target is 6°)
PTC_TG=PHS_9*0.24*SKD_RN_EMT*not CST_RN_SUPT−PHS_9*0.24*CST_RN_EMT*not SKD_RN_SUPT=1*0.24*25*1−1*0.24*12*0=6).
For forward center of gravity, CG balanced by skid runner
(PTC_TG=+PHS_9*0.24*SKD_RN_EMT*not CST_RN_SUPT−PHS_9*0.24*CST_RN_EMT*not SKD_RN_SUPT).
The 6° pitch increase is provided by the target coded in PHS_9 when the skid runners 204 are supporting. The 6° pitch increase requires a 0.11 COF which is adequate for safe climbing of carpeted stairs with the 7° forward margin.
For 6 degree pitch target increase: for forward center of gravity, CG balanced by skid runner
For aft center of gravity, CG balanced by caster runner
For 6 degree pitch target decrease: for aft center of gravity, CG balanced by caster runner
Operation
Skid Step Engagement
One improvement of this invention is means to sense forward facing up step, FUS 201 as well as forward facing down steps, FDS 203 in front of the wheelchair. The skid system 200 shown in
In the LEVEL mode (MLL and PHS_1) the skid system 200 position controls (SKD_PN) to the full up position (SKD_PN_TG=0°). Referring to
(SKD_APR_FUS=(WF_HT>1) & ADV).
A forward step height less than 1 inch (WF_HT<−1) and advancing (ADV) indicates the skid system 200 is approaching an FDS step 203
(SKD_APR_FUS=(WF_HT<−1) & ADV).
When the skid system 200 is approaching an FUS 201 step (SKD_APR_FUS) or FDS 203 (SKD_APR_FDS) a step is indicated and the LEVEL mode (MLL) ends. The STAIR mode (MSL) begins with skid system 200 in engage duty (SKD_ENG) or pitch control duty (SKD_PC). Skid system 200 engage controls targeting the most critical value (SKD_EMT) from either the forward step engagement (KFT_EMT), skid wheel 207 engagement (KWT_EMT) or skid runner engagement (SKD_RN_EMT). If the skid system 200 is in the full up position with the pitch high (SKD_UP & PTC_HI) and reduced engagement is targeted, the spider system 400 is commanded to rotate the spider system 400 and the wheelchair 100 for spider controlling skid engagement (SPD_EN_SKD) to meet the engagement target (SKD_EN_TG). The ToF forward step sensor 202 enables the wheelchair 100 to monitor upcoming surfaces in the LEVEL mode (MLL) or lift the skid wheel 207 in the STAIR mode (MSL) to the level of an FUS step 201 without the need for physical surface contact.
Referring to
If the skid system 200 is not needed for balance, the indication of an FUS 201 step, FDS 203 step or horizontal surface 101 may be used to control engagement to surfaces comprising skid engagement control (SKD_ENG) or spider control skid engagement (SPD_EN_SKD), drive steering to align with step (DR_SKD_EN), or initiate other actions such as raising the skid wheel 207 above the FUS 201 step (SKD_ENG with KFT_EMT critical). Maintaining the skid system 200 engaged with the surfaces ensures that the skid system 200 is quickly available for balancing.
Caster Step Engagement
The caster system 300 shown in
The caster system 300 with caster wheel 303 provides support for lifting the rear drive wheels 602 for advancing up an FUS 301 step (ADV and PHS_8). Once the rear drive wheels 602 are raised and are securely over the FUS 301 step the caster system 300 is positioned controlled (CST_PN to CST_PN_TG) to lift the caster wheel 303 to the FUS 301 step level (CST_HORZ), the wheelchair 100 advances (ADV, PHS_4) until the caster wheel 303 is over the FUS 301 step.
The caster wheel 303 is used as needed for balance support. When not needed for balance, caster wheel 303 engagement is controlled by distance sensor 304 to be quickly available for support.
Referring to
The runner deflection sensing devices 305 are used as needed for balance, caster steering, and controlling the engagement to an FDS 302 step as the wheelchair 100 ascends or descends steps or stairs.
Spider Step Engagement
Spider crowd engagement angles (CWD_LFT and CWD_RHT) to an FDS step 302 edge are computed by subtracting the left spider angle (SL_ANG) from the spider rotation angle (SD_ANG) or by subtracting the right spider angle (SR_ANG) from the spider rotation angle (SD_ANG). Since SD_ANG, SL_ANG and SR_ANG are reset at 120°, it is necessary to add 120° for spider crowd engagement cases that would be negative for valid spider engagement values.
(CWD_LFT=SD_ANG−SL_ANG+120*(SL_ANG>SD_ANG)
(CWD_RHT=SD_ANG−SR_ANG+120*(SR_ANG>SD_ANG)
The minimum spider crowd angle (CWD_MIN) is the least of CWD_LFT and CWD_RHT. (CWD_MIN=the least of CWD_LFT and CWD_RHT).
Referring to
The shape of the spider internal cam 405 cut-out is defined by rotating the spider 403 with its three spider cam posts 404 about spider system 400 axis 461 and rotating the spider cam 401 about large diameter hub 437 axis 461 at the same rate. The shape of the internal cam 405 is expanded by deflecting the spider cam 401 by rotating the step engaging surface 459 a set limited angle toward drive wheel 606 and again rotating the spider cam 401 and spider 403 in unison.
The spider cam 401 is spring biased to the undeflected unison position by the spider cam preloading system 416. Referring to
The spider cam gear 413 is rotationally linked to the cam angle sensing gear 414 with one full gear 414 rotation per spider spoke 402 to avoid adjustment and the possibility of mis-adjustment due to slipping.
As shown in
For ascending to a landing with the spider system 400 from the position shown in
For descending from an FDS 302 step landing, the wheelchair 100 advances (ADV) with the spider front drive wheels 601 and rear drive wheels 602 controlling pitch. When the front drive wheels 601 begin to leave the landing (FDS_ADV_P5), the software code invokes PHS_7D. PHS_7D phase ensures continued spider 403 rotation as the wheelchair advances (ADV). The spider 403 rotates as a function of drive wheel travel in PHS_7D until the spider 403 reaches an angle (SD_ANG<23°) to ensure positive spider cam 401 engagement sensing (SPD_EN_CAM). The wheelchair 100 is supported by the rear drive wheel 602 and the skid system 200 as the wheelchair descends the FDA 410 step landing. The spider system 400 continues to descend while providing signals for engagement and steering until the position shown in
Wheel and Spider Motor Braking
One improvement in this invention is a manual means to release drive wheel brake system 444 to freewheel the wheelchair 100. Drive wheel 606 rotation is secured for the safety of the occupant and wheelchair when drive wheels 606 are not operating. The drive motor brake system 444, shown in
Drive wheel brake system 444 with manual release handles 608 are included for both the left and right drive wheels 606. The release handles 608 are located under the seat and are accessible to the occupant. The wheelchair 100 can be propelled by hand rotating the upper drive wheels 606. A similar brake 502 is provided for the spider system 400 except without the manual release components.
Legrest Operation
Referring to
Seat Height Adjustment Operation
Referring to
Travel Operation
For LEVEL mode (MLL), the caster wheel 303 and front drive wheels 601 support the wheelchair 100 with the spider system 400 rotated to lift the rear drive wheels 602 off the horizontal surface 101 (SPD_PN_TG=28°). See
For SLOPE mode (MPL), SMALL ANGLE SLOPE travel operation (MP1), the spider system 400 controls pitch, and the skid system 200 and caster system 300 engage, except when needed for out-of-range pitch adjustment. For DOWN-SLOPE mode travel (MP2), the skid system 200 and rear drive wheels 602 support. See
For STAIR mode (MSL) operations, PHS_5 is the default phase for horizontal travel. PHS_5, 4-WHEEL DRIVE, is a 4-wheel travel phase primarily with spider system 400 pitch control (SPD_PC), skid engage (SKD_ENG), caster engage (CST_ENG) and drive wheel 606 drive per joystick deflection and direction (DR_JS_ST). However, pitch control varies for different pitch ranges. The spider system 400 controls pitch (SPD_PC) in the pitch range for spider pitch control (PTC_S_RG) from 5° below the target (PTC_TG) to 5° above the target. The caster system 300 controls pitch (CST_PC) from 3° above the target (PTC_HI) and higher with the caster and spider sharing pitch control from 3° to 5° above the target. The skid system 200 controls pitch (SKD_PC) from 3° below the target (PTC_LO) and lower with the skid and spider sharing pitch control from below the target, −3° to −5° (PTC_TG). Sharing pitch control avoids rapid duty swapping. Travel is controlled by the joystick (DR_JS_ST) but at a reduced speed or halted for better control on obstacles (TRVL_OK) and fore and aft pitch (CHR_ATT) or lateral pitch (ROLL_ATT) which vary from the targets with speed reduction factors PTC_FTR and ROLL_FTR. See
PHS_9, SPIDER CLIMB, is the other STAIR mode (MSL) default phase for step and stair climbing with the spider system 400 rotating (SPD_RO) for climbing, with either the skid system 200 supporting for pitch control (SKD_PC) and the caster system 300 engaging (CST_ENG) or with the caster system 300 supporting for pitch control (CST_PC) and the skid system 200 engaging (SKD_ENG) and the drive wheels 606 driving (DR_CAM_STR) to maintain the engagement of spider cams 401 driving to maintain caster runner engagement (DR_CST_STR).
In PHS_9 with the supporting drive wheels 602 in a low central position, balancing support can be provided by either the skid system 200 or caster system 300 depending upon the location of the center of gravity relative to the fore and aft position of the supporting drive wheels 602. The center of gravity location is controlled in PHS_9 to limit traction surface friction required to balance skid runner 204 and caster runner 319 fore and aft force components. See
Special FDS phases are provided for ascending a landing or descending a landing. These include:
Special phases are also provided for ascending and descending an FUS 301 step landing:
Level Travel
The LEVEL mode (MLL) is invoked when requested (QLL) and the criteria (MLL) is met. PHS_1 is invoked from the LEVEL mode (MLL). In PHS_1, LEVEL TRAVEL, the wheelchair travels with the two front drive wheels 601 and the caster wheel 303 supporting. The skid system 200 position controls (SKD_PN) to a full up target (SKD_PN_TG=0). The spiders 403 are position controlled (SPD_PN) to the position for LEVEL TRAVEL, PHS_1 (SPD_PN_TG=28°). The caster controls pitch (CST_PC) to PTC_TG=0°. The drive wheels 606 joystick steer (DR_JS_ST) in the direction of joystick deflection for advancing (ADV) or backing (BCK). Joystick steering for pivoting control (PVT) is the same as advancing (ADV). See further discussion of joystick steering ((DR_JS_ST_LH) in DRIVE SYSTEM 600.
The forward step sensors 202 and skid wheel step sensor 205 are monitored to sense an FUS 201 up step approach (SKD_APR_FUS) or an FDS 203 down step approach (SKD_APR_FDS). The caster runner deflection sensing devices 305 are monitored to sense a rear FDS 410 step engagement (CST_RN_ENGD) or rear step height sensor 322 is monitored to sense an FUS 301 step (CST_APR_FUS) approach. The spider system 400 is monitored for spider cams 401 engaged (SPDR_ENGD) or rotated (not SPDR_4WD). If any these indications are positive the STAIR mode (MSL) is invoked, and the LEVEL mode (MLL) is ended. See DETAIL DESCRIPTION,
Advancing Up an FUS Step.
When the occupant anticipates ascending an FUS 201 step, the occupant raises (LR_OP with EX_LR) the legrest 700. The occupant advances (ADV) to an FUS 201 step in the LEVEL (MLL) or STAIR (MSL) mode. When advancing to a forward up step is sensed (SKD_APR_FUS=(WF_HT>1) & ADV)) the mode switches to STAIR mode (MSL) if not already in STAIR mode. PHS_2 is invoked with the legrest raised (LR_LFT) and forward up step indicated (SKD_APR_FUS).
As the skid system 200 advances up the FUS 201 step in PHS_2, FWD STEP APPROACH, the skid system 200 skid engages (SKD_ENG) targeting the most critical engagement forward step engagement (KFT_EMT) from the forward step ToF sensors 202. This holds the skid wheels 207 high to permit them to reach the FUS 201 step landing. If the skid is not full up (SKD_UP) the spider controls pitch (SPD_PC) to pitch target (PTC_TG=3°). If the skid system 200 is forced to the full up position with the pitch high (PTC_HI), the skid system 200 position controls (SKD_PN) to the full up position (SKD_PN to SKD_PN_TG=0) and the spider system 400 controls skid system engagement (SPD_EN_SKD) to skid engagement target (SKD_EN_TG=12). The wheelchair 100 then 4-wheel advances (DR_JS_ST) up the FUS 201 step with the rear drive wheel 602 forcing the front drive wheels 601 against the forward up step 201 edge, the front drive wheels 601 rotating to ascend and the spider controlling pitch (SPD_PC) and the caster engaging (CST_ENG). As the front drive wheels 601 begin to ascend the step, the wheelchair pitch (CHR_ATT) rises, and the spider angle (SD_ANG) increases to maintain skid system engagement (SKD_EMT). When the spider angle (SD_ANG) reaches greater than 35° PHS_2 ends and PHS_5 begins with spider pitch control, skid system 200 controlling skid system engagement (SKD_EMT) and caster system 300 controlling caster engagement (CST_EMT). PHS_8 begins when advancing (ADV), the front drive wheels 601 are fully on the FUS 201 step landing (SPDR_ON_FUS=(SD_ANG>33°) & FDW_SUPT) and the spiders are supporting (SPDR_SUPT). See FIG.
In PHS_8, SPIDER FUS ASCEND, the drive wheels 606 advance (ADV) with joystick steering (DR_JS_ST). The spider system 400 engages the spider cams 401 (SPD_EN_CAM) to the spider engage target (SPD_EN_TG) if they are engaged (SPDR_ENGD) or if not engaged they position control (SPD_PN), to the spider position target (SPD_PN_TG) for PHS_8 as a function of drive wheel travel (DR_TRVL) to raise the rear drive wheels 602 with the FDW 601 supporting to level the four lower drive wheels 601/602. The SPD_PN_TG target places the rear drive wheels (RDW) 602 above the FUS 201 step landing. The skid system 200 engage (SKD_ENG). The caster system 300 controls pitch (CST_PC) while the caster wheel 303 supports while on the lower level 314. In PHS_8, when the four lower drive wheels 601/602 reach the FUS 201 step landing as indicated by rear drive wheel 602 supporting (RDW_SUPT) and lower spider wheels level (SPDR_ON_STP), PHS_4 is invoked and PHS_8 ends.
In PHS_4, CASTER LIFT/ADV FOR FUS ASCEND, the skid system 200 engage (SKD_ENG), and the caster system 300 position controls (CST_PN) to lift the caster wheel 303 to the height of the step level landing 201 (CST_PN_TG=CST_HORZ=2). The spider pitch controls (SPD_PC). The drive wheels 606 hold their position until the caster system 300 is lifted (CST_ANG=CST_PN_TG) and then the drive wheels 606 advance the wheelchair (DR_JS_ST) until the caster wheel 303 is fully on the landing of the FUS 201 step as indicated by caster system 300 being engaged (CST_ENGD). Then PHS_5, 4-WHEEL DRIVE is again active and the LEVEL mode (MLL) is selectable.
Backing Down an FUS Step.
The occupant backs the wheelchair 100 to an FUS 301 step in the LEVEL (MLL) or STAIR (MSL) mode. When caster backing to approach an FUS step (CST_APR_FUS) is sensed, the mode switches to STAIR mode if not already in STAIR mode. See
In PHS_6, FDW & CSTR SUPT, the spider system 400 controls engagement (SPD_EN_CAM) to an engagement target (SPD_EN_TG) if engaged (SPDR_ENGD) or if not engaged the spider system 400 position controls (SPD_PN) to target a spider angle (SD_ANG) of 37° (SPD_PN_TG for PHS_6). This lowers the rear drive wheels 602 for supporting later in PHS_5. The caster wheel 303 pitch controls CST_PC and the skid system engages (SKD_ENG). The drive wheels 606 back the wheelchair (DR_JS_ST). PHS_6 continues until the drive wheels 606 travels backward (BCK) 3 inches (DR_TRVL=−3) and PHS_5 is re-invoked. The wheelchair 100 continues backing down in PHS_5 until the skid system 200 is on the same level as the drive wheels 606 and caster wheel 303. LEVEL mode (MLL) is again selectable.
Backing Up a Low FDS 428 Step
The wheelchair 100 backs up (BCK) to an FDS 410, 428 step, in the LEVEL mode (MLL) and PHS_1 or in the STAIR mode (MSL) and PHS_5. When the runner deflection sensing device 305 senses the caster runners 319 are engaged (CST_RN_ENGD), STAIR mode (MSL) is invoked if not in STAIR mode. The rear step sensor 322 and caster wheel sensor 304 monitor the rear step height (WR_HT) to determine if the FDS step is a rear low FDS 428 step (RE_LO_STP) or a rear high FDS 410 step (RE_HI_STP). See
Backing Up a High FDS 410 Step
If a high rear step (RE_HI_STP) is sensed rather than a rear low step (RE_LO_STP), PHS_9A will be invoked and the wheelchair 100 will step up a high FDS 410 step by spider system 400 rotation. In PHS_9A, SPIDER TIP ROTATION, the caster wheel 303 engages (CST_ENG) to caster engagement target (CST_EMT) to the lower surface 100 while the spider system 400 is rotating (SPD_RO). See
In PHS_9, SPIDER CLIMB, with skid system 200 supporting (SKD_SUPT) and caster runners 319 engaged (CST_RN_ENGD), the spider system 400 rotates (SPD_RO) increasing (SD_ANG) to ascend when backing (BCK). The caster system 300 engages (CST_ENG). The skid system 200 pitch controls (SKD_PC) to pitch target (PTC_TG for PHS_9). The drive wheels 602 spider cam steer (DR_CAM_STR) to engage the spider cams 401 if the spider is engaged (SPDR_ENGD) or the caster runners 319 are not engaged (not CST_RN_ENGD). See
In PHS_7B, SPIDER ASCEND LANDING. drive wheel travel (DR_TRVL) is reset when PHS_7B is invoked. The drive wheels 606 travel at a speed per joystick deflection (DR_JS_ST). The skid system 200 pitch controls (SKD_PC). The caster system 300 engages (CST_ENG). The spider system 400 controls to a position angle (SPD_PN) per a function of drive wheel travel for PHS_7B (SPD_PN_TG). PHS_7B ends when the forward drive wheels (FDW) 601 are on the landing as indicated by the forward drive wheels 601 engaged (FDW_ENGD), and PHS_5 is invoked or when caster runner becomes engaged (CST_RN_ENGD) and PHS_9 is invoked.
When backing (BCK) on to an FDS 203 upper landing from a step or stairs, travel is slowed or halted by a travel speed factor (TRVL_OK) to allow the skid system 200 to track the FDS 203 step edge without supporting (not SKD_SUPT). See
Ascending Stairs
Ascending the first stair step is identical to backing up an FDS 410, 428 step, as discussed previously in BACKING UP A HIGH FDS 410 STEP with LEVEL mode converting to STAIR mode and ascending with PHS_9A and PHS_9. Step ascending may continue in PHS_9 with pitch control cycling from one step to another between skid system pitch control (SKD_PC) and caster pitch control (CST_PC). Or with ascending to a landing phase (PHS_7B) as described above may be invoked for ascending to a landing as the lower spider drive wheels 601/602 become level (SPDR_ON_STP) and other PHS_7B criteria is met at any step. PHS_7B ends when caster runner 319 becomes engaged (CST_RN_ENGD) at an intermediate step or when the front drive wheels 601 are engaged (FDW_ENGD) on the landing. Ascending to the landing proceeds like described above for BACKING UP A HIGH FDS 410 STEP with PHS_5 with SKD_LFT_5_OK and PHS_5 with LEVEL mode (MLL) available for selection.
Descending Stairs or Advancing Down an FDS 410 Step.
The wheelchair advances (ADV) toward a step in the LEVEL (MLL) and PHS_1 or in the STAIR (MSL) mode and PHS_5. When the wheelchair 100 advances on a landing to an FDS 410 down step or descending stairs, skid approaching a down step is sensed (SKD_APR_FDS), and the STAIR mode (MSL) and PHS_5 are invoked if not already in STAIR mode (MSL). The wheelchair enters PHS_5 and the advancing (ADV) continues. The skid system 200 extends as it engages (SKD_ENG) the step edge. If the skid system 200 disengages as traveling continues, the wheelchair 100 travel halts with a zero-value drive speed factor (TRVL_OK=0 for not SKD_CST_NB_SUPT). The skid system 200 rapidly extends until the skid system 200 engages a lower step (SKD_ENGD) and advancing (ADV) restarts. Once the FDW 601 begins to depart the step as indicated by FDS_ADV_P5 and other PHS_7D criteria is met, the control is switched to PHS_7D and descending begins with spider rotation (SPD_RO).
In PHS_7D, SPIDER DESCEND LANDING, the drive wheel travel value (DR_TRVL) is reset to zero when invoked. The drive wheels 606 travel per joystick deflection (DR_JS_ST). The skid system 200 pitch controls (SKD_PC) to a pitch target (PTC_TG). The spider system 400 angle position is controlled (SPD_PN) to a target function (SPD_PN_TG) for PHS_7D of drive wheel travel (DR_TRVL). The caster system 300 engages (CST_ENG). PHS_7D ends when the spider system 400 is at an angle which provides substantial spider crowd engagement as indicated by SD_ANG<23° and then PHS_9 is invoked when no other mode is active.
PHS_9 for descending is the same as for ascending, with the drive wheels 606 caster steering (DR_CST_STR_LH and DR_CST_STR_RH) if caster runners are engaged (CST_RN_ENGD) and spider not engaged (not SPDR_ENGD), otherwise the drive wheels will spider cam steer (DR_CAM_STR_LH and DR_CAM_STR_RH). The spider system 400 rotates to descend (SPD_RO=+JLE*(BCK−ADV)*SPDR_OK) per forward joystick direction and deflection. The skid system 200 or caster system 300 pitch controls (SKD_PC or CST_PC) depending on which is supporting (SKD_SUPT or CST_SUPT and will engage (SKD_ENG or CST_ENG) if not supporting. The pitch target (PTC_TG) is raised if the skid runners 204 are supporting (SKD_RN_SUPT) or lowered if the caster runners 319 are supporting (CST_RN_SUPT) as discussed in DETAIL DESCRIPTION for
Step descending continues, cycling in PHS_9 with pitch control cycling between skid pitch control (SKD_PC) and caster pitch control (CST_PC). Once the wheelchair 100 is back on the lower landing with the two lower drive wheels 601/602, the skid system 200 and caster system 300 are all on the same level 101, the LEVEL mode (MLL) is again selectable.
Slope Travel
SLOPE mode (MPL) may be invoked from the LEVEL mode (MLL) by pressing the slope mode request switch (QPL). SMALL ANGLE SLOPE mode (MP1) is invoked by default if the criteria for DOWN-SLOPE mode (MP2) or UP-SLOPE mode (MP3) is not met. MP1 operation is similar to PHS_5 with the spider system 400 controlling pitch (SPD_PC) when the pitch (CHR_ATT) is within the spider pitch control range (PTC_S_RG), the skid system 200 assisting pitch control with pitch low (PTC_LO) and caster system 300 assisting pitch control (CST_PC) when the pitch is high (PTC_HI). The skid system 200 and caster system 300 engage (SKD_ENG and CST_ENG) when not controlling pitch. Drive wheel 606 travel is joystick controlled (DR_JS_ST). Travel speed is reduced by a speed factor (TRVL_OK) to allow balancing adjustment or slowly approaching operation limits and reversing before reaching them.
The mode switches to the DOWN-SLOPE mode (MP2) when the wheelchair 100 descends from a horizontal landing 456 to a steep down-slope 455 as indicated by the spider system 400 becoming engaged (SPDR_ENGD) on a sharp transition from a horizontal surface 456 to a sloped surface 455 and the caster wheel 303 is not supporting (not CWT_SUPT). See
In the DOWN-SLOPE mode (MP2), the skid system 200 pitch controls (SKD_PC). The spider system 400 position controls (SPD_PN) to target SD_ANG to 32° (SPD_PN_TG=32°) which assures the rear drive wheel (RDW) 602 supporting (RDW_SUPT) and not the front drive wheel (FDW) 601 supporting (not FDW_SUPT) when the wheelchair 100 ascends to a horizontal landing 456 with a level pitch (CHR_ATT=0). This avoids spider crowd engagement (SPDR_ENGD) and the need for further spider system 400 rotation when transitioning from a slope 455 to a horizontal surface 456. The caster system 300 engages (CST_ENG). The drive wheels 606 are joystick steered (DR_JS_ST). The slope mode (MPL) returns to SMALL ANGLE SLOPE mode (MP1) when the slope decreases to 5° as indicated by a skid angle less than 27° (SKD_ANG<) 27°.
The slope mode (MPL) switches from the MP1 mode, to the MP3, UP-SLOPE mode when the spider system 400 angle (SD_ANG) exceeds 39° (SD_ANG)>39° and the pitch is high (PTC_HI) or when the skid system 200 is full up (SKD_UP), skid wheels 207 supporting (KWT_SUPT) and the pitch is high (PTC_HI). See
Travel speed (DR_JS_ST) is limited in the slope mode (MPL) by the drive speed factor (TRVL_OK) which includes MPL_T_OK. The travel slowing allows time to correct the issue or the occupant to reverse direction to avoid an operational limit.
Although the description above contains many specificities, these should not be construed as limiting the scope of the invention but as merely providing illustrations of some of the presently preferred embodiments of this invention. For example, the spiders 403 could have four spider spokes 402 instead of three; the invention could be used to transport other cargo, mechanical arms, cameras etc.; other technologies could be used to sense distances to stair surfaces; criteria, duties, and phases could vary, linear actuators could be replaced by rotary actuators and so on. Values are provided to promote an understanding of functions, however the values could and will vary depending upon the particular embodiment of the invention. Gain factors for command and other functions are needed but are not included to simplify the equations.
Thus, the scope of the invention should be determined by the appended claims and their legal equivalents, rather than by the examples given.
| Number | Name | Date | Kind |
|---|---|---|---|
| 2742973 | Johannesen | Apr 1956 | A |
| 2931449 | King | Apr 1960 | A |
| 4512588 | Cox | Apr 1985 | A |
| 4794999 | Hester | Jan 1989 | A |
| 4993912 | King et al. | Feb 1991 | A |
| 5423563 | Wild | Jun 1995 | A |
| 5701965 | Kamen | Dec 1997 | A |
| 5791425 | Kaman et al. | Aug 1998 | A |
| 6311794 | Morrell | Nov 2001 | B1 |
| 6435538 | Ellis et al. | Aug 2002 | B2 |
| 6484829 | Cox | Nov 2002 | B1 |
| 6799649 | Kamen | Oct 2004 | B2 |
| 9527213 | Luo | Dec 2016 | B2 |
| 10597100 | Gerhardt | Mar 2020 | B2 |
| 20040149499 | Kim | Aug 2004 | A1 |
| 20150272793 | Lu | Oct 2015 | A1 |
