Flight simulation has been achieved using platform-based octahedral hexapods since the 1960s (see
Cable-suspended, or wire-driven, robots have been previously disclosed. Pioneers in this area include the NIST RoboCrane (see
In one aspect a vehicle simulation apparatus is provided. In one embodiment, the vehicle simulation apparatus includes: a platform positioned within a three-dimensional workspace, at least six upper support members positioned outside the three-dimensional workspace, at least six upper adjustable cables routed from corresponding upper support members and secured to the platform to apply at least a portion of upward tension to the platform, wherein the upper adjustable cables are adjustably extended and retracted in a coordinated fashion to maneuver the platform, and a vehicle secured to the platform to provide one or more occupants with a simulated experience within a three-dimensional virtual environment during the maneuvering.
These and other features, aspects, and advantages of the present invention will become better understood with regard to the accompanying drawings, following description, and appended claims.
The following paragraphs include definitions of exemplary terms used within this disclosure. Except where noted otherwise, variants of all terms, including singular forms, plural forms, and other affixed forms, fall within each exemplary term meaning. Except where noted otherwise, capitalized and non-capitalized forms of all terms fall within each meaning.
“Comprising,” “containing,” “having,” and “including,” as used herein, except where noted otherwise, are synonymous and open-ended. In other words, usage of any of these terms (or variants thereof) does not exclude one or more additional elements or method steps from being added in combination with one or more delineated elements or method steps.
“Or,” as used herein, except where noted otherwise, is inclusive, rather than exclusive. In other words, “or’ is used to describe a list of alternative things in which one may choose one option or any combination of alternative options. For example, “A or B” means “A or B or both” and “A, B, or C” means “A, B, or C, in any combination or permutation.” If “or” is used to indicate an exclusive choice of alternatives or if there is any limitation on combinations of alternatives, the list of alternatives specifically indicates that choices are exclusive or that certain combinations are not included. For example, “A or B, but not both” is used to indicate use of an exclusive “or” condition. Similarly, “A, B, or C, but no combinations” and “A, B, or C, but not the combination of A, B, and C” are examples where certain combinations of alternatives are not included in the choices associated with the list.
A virtual reality (VR)-based vehicle simulator system (VSS) with whole-body haptics capable of providing one or more human occupants with a simulated, VR experience during one or more simulation scenarios is described herein. Any of a variety of real-life experiences, theoretical life experiences, fictional experiences, and other experiences suitable for simulation may be provided in any combination by a given simulation scenario. The simulation scenarios may be for training purposes, entertainment purposes, therapy purposes, or any other suitable purpose. The scenarios may be interactive in response to actions taken by one or more human occupants, pre-planned regardless of occupant behavior, or a combination thereof. A given VR simulation may be in real-time, including interactive responses. The simulations may also be controlled in some other manner, such as ranging from faster to slower than would be experienced in the real world in order to suit the purpose of a particular scenario.
In one embodiment, the vehicle simulator system may include a visual system with three-dimensional (3D) graphics for simulating what the vehicle occupant would be seeing, haptic motion input devices that simulate vehicle controls, 3D surround-sound audio for simulating aural cues, articulating fans for simulating haptic cues, an olfactory generator for simulating smells, and a cable-controlled motion system for simulating whole-body haptic cues. The cable-controlled motion system may include a platform and a vehicle that accommodates one or more human occupant. The cable-controlled motion system may be used in lieu of existing octahedral hexapod motion systems (see
The vehicle simulator system, for example, may be used for a flight simulator or any other type of simulator. The system also may be used to provide an economical, realistic simulation with full-body motion for research and development, vehicle design, entertainment, rehabilitation, therapy, and other suitable applications.
From one perspective, the vehicle simulator system provided herein presents a lighter, more economical, stiff, high bandwidth, cable-suspended motion system to replace octahedral hexapod motion platforms in previous simulator systems. For example, the vehicle simulator system uses at least six stiff, lightweight cables in place of the six hydraulic actuators used in the octahedral hexapod motion platforms. From another perspective, the vehicle simulator system presents a cable-suspended motion system, such as that was used in the NIST RoboCrane (see
Many types of vehicles may be simulated using the vehicle simulator system. For example, flight simulators can provide a VR environment of a cockpit (or other duty stations) of an aircraft. Various levels of performance and sophistication can implemented in the vehicle simulator system to immerse the occupant in an appropriate VR environment based on a balance of performance and cost. The vehicle simulator system may be safer and more economical than, for example, simulators with Stewart platform-based motion systems (see
With reference to
The vehicle simulator system may provide a means for humans to ride and interact in various dynamic simulated vehicle situations. Actual cockpits, truck cabs, other types of operator compartments, and passenger compartments from real-world vehicles, including the vehicle input devices (steering wheels, flight sticks, etc.) may be used to increase realism. The real-world vehicle (or portion thereof) may be suspended using six active cables for vehicle simulation with motion. In various embodiments, the vehicle simulator system may use gravity, actuation redundancy, or opposing cables to fully constrain the vehicle platform.
For example, in one embodiment, the general cabling design of the NIST RoboCrane (
An exemplary feature of the vehicle simulator system is immersion of the occupant in a realistic VR environment with real or simulated controls, indicators, and displays in conjunction with the perspective of the occupant in the vehicle (e.g., cockpit) allowing interaction with the system. The vehicle simulator system allows for a large variety of real-world vehicles to be simulated. For example, various types of real-world vehicles may be mounted on the cable-suspended platform, including, but not limited to: i) aircraft, ii) gliders, iii) hang gliders, iv) dreamtime ‘Peter Pan’ flight, v) automobiles, vi) motorcycles, vii) mountain bikes, viii) skateboards, ix) tractors, x) four-wheelers, xi) snow-mobiles, xii) roller coasters and other thrill rides, xiii) sailboats, xiv) windsurfing boards, xv) kayaks, xvi) jet skis, xvii) downhill and cross-country skis, and xviii) horses for equestrian and other types of riding.
The vehicle simulator system could be modified to allow various real-world or simulated vehicles to be interchanged as desired in the same laboratory, clinic, or arcade. Thus, one cable-suspended vehicle platform and accompanying VR systems could handle many different needs. Even given a specific type of vehicle, such as automobiles, different options may be programmed and presented to the user for a choice to represent different automobiles with different physical characteristics and different motion profiles based on a combination of the physical characteristics of the vehicle and the terrain or environment being traversed.
With reference to
In conjunction with the plurality of vehicle applications for suspended vehicle simulation with motion, there are also various applications or missions that are common to many of the possible vehicles for which the vehicle simulator system may be implemented. For example, the system may be adapted for the following applications or missions: i) research and development, ii) engineering design and simulation of vehicles, iii) operator training, iv) safety research and training, v) rehabilitation, vi) therapy (e.g., emotional therapy for autistic or mentally-handicapped persons), vii) entertainment, viii) recreation for city dwellers, ix) virtual access to practice a task or experience in the real world prior to the actual real-world attempt, x) serious gaming, including military training or remote control, and xi) high-end arcades that are more interactive for the human player.
The vehicle simulator system may operate in one or more control modes for vehicle simulation. In one control mode, pre-programmed or ‘canned’ motion of the vehicle in which a human can ride passively to experience the simulated dynamics may be provided. Alternatively, in an active, real-time control mode, the human ‘pilot’ (i.e., occupant) may enter vehicle motion commands through realistic control inputs and may experience the dynamics of such commands in the resulting simulated motions.
In one embodiment, the vehicle simulator system may immerse a vehicle occupant in a realistic VR environment with a real cockpit and real input devices allowing interaction with the system. The system may include 3D stereo vision graphics with realistic vehicle environments. The graphics may be delivered, for example, via a projection screen or a wireless head-mounted display (HMD)). The system may also provide 3D surround sound audio, articulating fans for motion perception enhancement, and an olfactory generator for realistic smells to increase the sense of realism in our vehicle simulations.
With reference to
The lengths of the nine active cables are Li, i=1, 2, . . . , 9. As shown in
The inverse pose kinematics problem for the vehicle simulator system may be stated: given the desired moving vehicle platform pose [PB
Given [PBT], the moving cable connection points P1, P2, P3, and P4 referenced to the fixed base frame {B} can be calculated using:
{B
Each position vector in Equation (1) may be augmented with a ‘1 ’ in the fourth row to make the 4×4 matrix multiplication indices work. The constant relative vectors {P
The forward pose kinematics solution may be used for simulation and sensor-based control of the vehicle simulator system. The forward pose kinematics problem may be stated: given the nine active cable lengths Li, i=1, 2, . . . , 9, calculate the resulting moving vehicle platform pose [PB
The closed-form vehicle simulator system forward pose kinematics solution may be based on finding the intersection of three spheres (four times in succession). At each step, each sphere center and radius is known. The closed-form three-spheres' intersections algorithm is straight-forward and not computationally-intensive. For additional information on the closed-form three-spheres' intersections algorithm, see Williams II et al., 3D Cable-Based Cartesian Metrology System, Journal of Robotic Systems, 21(5), pages 237-257 (2004), the contents of which are fully incorporated herein by reference.
The first step in the forward pose kinematics solution may be to calculate lower platform cable-connection point P4 given the lower active cable lengths L7, L8, and L9 using the intersection of three spheres algorithm and knowing the floor-fixed base points. Then, vehicle platform cable-connection points P1, P2, and P3 can be similarly found, by intersecting three known spheres three different times, each time using this P4 as one of the sphere centers. Referring to a sphere as a vector center point c and scalar radius r, (c,r), the vehicle simulator system forward pose kinematics solution is summarized as follows: i) P4 is the intersection of: (
Returning to the forward pose kinematics solution, given B
where B
B
P=B
Given {B
There are two solutions to the intersection point of three given spheres. Therefore, the forward pose kinematics problem yields a total of 24=16 mathematical solutions after repeating the algorithm four times for the vehicle simulator system. It is generally straight-forward to determine the correct solution using logic in the forward pose kinematics solution implementation.
The down-pulling cables may simplify the forward pose kinematics solution in addition to improving upper cable tensioning.
Positive cable tensions are desired for safe and stable control during motion. First, gravity helps to ensure that the top six active cables remain in tension, as long as the rotations are not too far from the horizontal nominal orientation. Further, the cable-suspended platform of
Statics modeling may be utilized for the six- and nine-cable vehicle simulator systems. Six active cables may connect in parallel pairs from corresponding pairs of fixed upper bases or support members to the vehicle platform. In other embodiments, the pairs of cables need not be arranged in parallel. The vehicle simulator system may include three additional active cable connected from fixed lower bases or support members to the vehicle platform. The active drive cables may have variable tensions which may be maintained as positive. For static equilibrium the sum of all active and passive cable tensions plus gravitational loading acting on the vehicle platform equals the resultant wrench exerted on the environment by the vehicle platform. For free-space pseudostatic motions, this resultant wrench is zero; when the tool is in contact with the environment, there is no platform motion, but the resultant wrench is non-zero. When the vehicle simulator system is used for free-space motions there is zero contact wrench for motion. Therefore, external loading on the vehicle platform would be due to gravity. However, the environment wrench may be included in case it is required for a particular application of the vehicle simulator system.
The vector translational and rotational equations of static equilibrium may be expressed as follows:
where ti=ti
Substituting these details above into Equations (6) and (7) yields the following:
[
where {t}={t1 t2 . . . t9}T is the vector of active drive cable tension magnitudes, {
The active statics Jacobian matrix [
The statics equations can be used in to two ways. Given the active cable tensions {t} and each of the nine cable unit vectors {circumflex over (L)}i from kinematics analysis, forward statics analysis can calculate the external wrench {
For control and vehicle simulation, the more useful problem to solve is inverse statics analysis. The statics equations can be used to calculate the required active cable tensions {t} given the vehicle platform mass and the desired external wrench {
The vehicle simulator system dynamics may be a factor in cable tensioning, especially for simulated vehicle motions with high velocities and accelerations. That is, certain dynamic motions of the vehicle platform may cause higher tensions in some cables and lower tensions (even slack cables (negative tensions)) in other cables than that predicted by the pseudostatic model.
Even for relatively slow pseudostatic vehicle platform motions, not all desired configurations and wrenches may exist with only positive active cable tensions. Even for zero applied Cartesian wrench (i.e. only supporting the weight of the platform and vehicle), the cable tension optimization algorithms may need to consider slack cables (negative tensions), especially for large rotations of the vehicle platform away from the nominal horizontal orientation.
At least two approaches can be used to maintain positive cable tensions on active cables for vehicle platform motion. Both require actuation redundancy, i.e. more active cables than Cartesian dof. The first approach uses an algorithm for spatial motion and three degrees of actuation redundancy (e.g., nine cables for the six Cartesian dof configuration) employing active cable tension control with an optimization method for standard particular/homogeneous solutions. For additional detail on a similar algorithm for planar cable-suspended robots with one degree of actuation redundancy, see Williams II et al., Planar Translational Cable-Direct-Driven Robots, Journal of Robotic Systems, 20(3), pages 107-120 (2003), the contents of which are fully incorporated herein by reference. The second approach specifies and controls known cable tensions in the down-pulling cables and calculates the six unknown upper cable tensions via the standard non-redundant matrix inverse. To provide the known tensions in the down-pulling cables, actual linear springs may be included in line with active cables 7, 8, and 9, converting the tension control problem into an easier length control problem for each of these cables, or active tension control may be provided without physical springs.
Since exemplary nine-cable vehicle simulator system embodiment has actuation redundancy, Equation (9) is underconstrained (six equations in the nine unknown active cable tensions {t}) which means that there are three infinities of solutions. To invert Equation (9) (solving the required cable tensions {t} achieve wrench {
{t}=[
The first term of Equation (11), {t}p
MATLAB function lsqnormeg implements a version of Equation (11). It is the least squares solution (minimum norm solution for underconstrained systems of equations such as Equation (9)) subject to only non-negative values on solution components. This is a good function to use for cable-suspended vehicle platforms with the constraint that cables exert positive tensions.
In the solution discussed above, the lower three cable tensions may turn out to be negative, which would require a pushing up to help resist the weight of the platform and vehicle. The homogeneous solution may be used in an attempt to avoid negative cable tensions. However, a simpler approach may be to simply specify positive cable tensions for the three lower cables and determine the required upper six cable tensions for pseudostatic balance. These cable tensions may be time-varying and different from each other depending on motion requirements. They can be provided by physical springs in line with cables 7, 8, and 9, or they
The inverse pose kinematics solution (Equation (2)) yielded the following nine active cable lengths (m): L1=2.1224, L2=2.1153, L3=2.8805, L4=3.0514, L5=2.5667, L6=3.0092, L7=1.3142, L8=1.7152, and L9=1.6180. The resulting platform vertices may be expressed as follows:
To hold the vehicle simulator system in static equilibrium the required cable tensions from the particular solution (the first term of Equation (11)) are given on the left in Equation (17). Since the lower three cables require negative cable tensions from the particular solution, it is not used directly. Specifying a 50 N positive cable tension for each of cables 7, 8, and 9, positive cable tensions can be obtained using Equation (13) as given on the right in the equation below:
Given the nine active cable lengths (m): L1=2.1224, L2=2.1153, L3=2.8805, L4=3.0514, L5=2.5667, L6=3.0092, L7=1.3142, L8=1.7152, and L9=1.6180, the assignment is to calculate the resulting pose of the vehicle platform with respect to the base, [PB
First, Equation (9) may be partitioned as follows:
[
where [
{t16
Equation (13) can be combined with the specified values for {t79} to form a valid solution to Equation (9) with positive cable tensions, assuming {t79} were specified to be positive and the vehicle platform orientation does not rotate too far from nominal.
For the examples described herein, the following vehicle simulator system parameters were used. Of course, numerous combinations of adjustments to these parameters are possible. The upper ceiling-mounted fixed-base cable connection points may be on the vertices of an equilateral triangle with side 4 m. The vehicle platform cable-connection vertices may be on an equilateral triangle of side 1 m. The down-pulling cables may be secured to the vehicle platform at the triangle centroid, 0.2 m below the plane of the triangle. The lower floor-mounted fixed-based cable connection points may be on an equilateral triangle of side 1 m. The floor-to-ceiling height may be 3 in. The platform mass may be assumed to be 100 kg and the platform CG may be assumed to be the same as the platform control point P (i.e., the centroid of the platform equilateral triangle).
Given the desired pose of the vehicle platform with respect to the base in terms of position vector and Z-Y-X, Euler angles may be expressed as follows:
The assignment is to calculate the associated active cable lengths and cable tensions. The associated input homogeneous transformation may be calculated as follows:
The vehicle platform cable-connection points may be the same as those listed above. The pseudostatic cable tensions may also be the same as those listed above. The graphical vehicle simulator system poses for these snapshot examples are shown in
An inverse-pose-based trajectory example can be used to command general sine waves with independent amplitudes and frequencies on each of the six Cartesian motions (i.e., three translations and three rotations). More specifically, the simulated vehicle simulator system may be requested to move in a sine wave in the Z direction with 1 m amplitude and 1 rad/s frequency while simultaneously rotating about the Z axis with a sine wave of 30 deg amplitude and 2 rad/s frequency, from an initial pose. An exemplary representation of an initial pose is provided below:
This motion may be simulated for 10 sec;
For this simulated motion,
In summary, a concept for a cable-suspended vehicle simulator system (see
The vehicle simulator system (see
With reference to
Flight simulators have been in use since the 1960s, generally including a heavy, hydraulically-driven octahedral hexapod Stewart platform or a variant thereof (see
First-time experience with an aircraft or a helicopter can be stressful due to high inertial forces acting on pilots. Use of a simulator for pilots training is a regular practice. Such simulators already exist in the form of octahedral hexapod robot structures with hydraulic actuators. However, the cable-suspended vehicle platform in the vehicle simulator system (
The cable-suspended vehicle platform exhibits a higher external load/vehicle platform weight ratio with lower inertial forces acting on the vehicle platform structure and may obtain higher vehicle platform accelerations due to the relatively low mass of the vehicle platform structure than hydraulic octahedral hexapod motion systems. However, control of the cable-suspended vehicle platform may require certain considerations because a cable cannot transfer compression forces. Moreover, additional consideration may be required because the cable-suspended vehicle platform may be a highly non-linear object.
Previous cable robot research, which is related to use of the cable-suspended vehicle platform in the vehicle simulator system, is related to determination of a cable robot workspace for various static loads of end-effectors. For example, an analytical approach to define the workspace for a robot with six cables, loaded with an arbitrary wrench acting on the end-effector, is given in Bosscher et al., Wrench-Feasible Workspace Generation for Cable-Driven Robots, IEEE Transactions on Robotics, 22(5), pages 890-902, (2006). Other analyses of cable robot workspace are done by developing the governing equations analytically and then solving them numerically. For additional information on these analyses, see So-Ryeok et al., Generation of Feasible Set Points and Control of a Cable Robot, IEEE Transactions on Robotics, 22(3), pages 551-558 (2006), and Pusey et al., Design and Workspace Analysis of a 6-6 Cable-Suspended Parallel Robot, Elsevier: Mechanism and Machine Theory, 39, pages 761-778 (2004). The contents of each of the documents identified in this paragraph are fully incorporated herein by reference.
In general, the vehicle platform of the cable vehicle simulator system has six degrees of freedom for 3D motion or three degrees of freedom for planar (i.e., two-dimensional (2D)) motion. This means that it is possible to establish six differential equations (or algebraic equations, if a pseudo-static case is considered) in the 3D case or three equations in the 2D case. On the other hand, a cable-suspended vehicle platform can have an arbitrary number of cables and each cable introduces a new unknown variable that may be determined by a dynamics analysis. To obtain a solution in a case that there are more unknown cable tensions than dynamics equations, some kind of optimization method may be applied. For additional information on these methods, see Williams II et al., 3D Cable-Based Cartesian Metrology System, Journal of Robotic Systems, 21(5), pages 237-257 (2004); Park et al., Wire-Suspended Dynamical System Stability Analysis by Tension-Closure, IEEE Transactions on Robotics, 21(3), pages 298-308 (2005); and Williams II et al., Translational Planar Cable-Direct-Driven Robots, Journal of Intelligent and Robotic Systems, 37, pages 69-96 (2003). The contents of each of the documents identified in this paragraph are fully incorporated herein by reference.
A particular task of a cable-suspended vehicle platform may utilize a particular type of motion defined in Cartesian coordinates with specified position and orientation, velocity, or acceleration of the vehicle platform. However, the variables that can be directly controlled are cable tensions, via controlling torques of motors that retract (i.e., wind) or extend (i.e., unwind) corresponding cables from reels to which the cables are connected. For additional information on cable-suspended vehicle platform control using a classical feedback control approach, see Yingjie et al., Feedback Control of a Cable-Driven Gough-Stewart Platform, IEEE Transactions on Robotics, 22(1), pages 198-202 (2006) and So-Ryeok et al., A Reference Governor-Based Controller for a Cable Robot Under Input Constraints, IEEE Transactions on Control Systems Technology, 13(4), pages 639-645 (2006). The contents of each of the documents identified in this paragraph are fully incorporated herein by reference.
With reference to
The vehicle platform, for example, may have a 100 kg mass and may have an equilateral triangular shape. The platform may bear a vehicle (e.g., cockpit) together with a (i.e., one or more occupants (e.g., pilot, driver, passenger, etc.) and necessary equipment for manual and automatic control to simulate various vehicle motions. The system may include nine cables (e.g., steel cables) of a suitable size (e.g., 10 mm) that are secured to the vehicle platform and motor-controlled actuators (e.g., motor-driven cable reels). The vehicle simulator system may include nine motors (e.g., electrical DC motors) to move and position the platform by pulling and releasing the cables from corresponding cable reels. Six actuators may be positioned in pairs at corners of an equilateral triangle (e.g., four meter sides) with six corresponding cables extending downward defining upper limits of a workspace for the vehicle platform. Three additional actuators may be positioned at corners of an equilateral triangle (e.g., one meter sides) with cables generally extending upward defining lower limits of the workspace. The vehicle (e.g., cockpit) may provide seats for the one or more occupants with safety equipment and equipment (e.g., sensors, controls, indicators, displays, etc.) for measurement, manual control, and automatic control of the platform motion. Protection of occupants and equipment on the vehicle platform from cable interference may be taken into account when controlling movement the platform. A projection screen (e.g., 4×3 meters) may be positioned in relation to the vehicle to show a realistic video of scenes resulting from motion of the vehicle through a particular environment (e.g., terrain and objects seen while: i) driving a car along a road; ii) taking off, landing, or flying an airplane; iii) operating a helicopter; or iv) operating another type of vehicle).
Coordinated control of the motors can increase or decrease the cable lengths to simulate motion of the vehicle through the environment. In this way, the platform can be positioned to desired points and attitudes within the vehicle platform workspace to give the occupants the feeling as if they were actually moving through the environment in a simulated scenario. By controlling cable velocities, desired Cartesian vectors of linear and angular platform velocity can be provided at desired times in relation to the simulated scenario. Along with velocity control, desired angular and linear accelerations of the vehicle platform can be provided at desired times in relation to the simulated scenario.
In one embodiment, the vehicle simulator system provides a projection screen in front of the vehicle platform (
The inertial forces on the occupant (e.g., driver) resulting from proper movement of the vehicle platform make the simulation more realistic. For example, to simulate a jet aircraft scenario, the vehicle simulator system may produce very high acceleration perpendicular to the motion path. Due to the limited workspace of the system, acceleration in a particular direction is time limited. However, existing simulation methods can be used to provide realistic perceptions of continued advancement through the environment.
Exemplary forward and inverse kinematics equations for the vehicle simulator system are described above. A control system that provides adequate motion of the vehicle platform corresponding to the simulated video on the projection screen may be based at least in part on derived vehicle platform dynamics equations.
The vehicle simulator system may be used in at least two types of simulations: i) passive and ii) active (i.e., interactive). In passive simulations, the occupant (e.g., trainee or user) may enjoy realistic motion while watching a realistic corresponding graphical (e.g., video) presentation based on pre-planned or canned movement within an environment. This method may be useful, for example, during early training stages or for passive entertainment. In active simulations, the occupant (e.g., trainee or user) may use an input device (e.g., flight stick or steering wheel) to select desired movement through the environment and, in response, the system causes the vehicle platform to move in a manner that results in the occupant feeling the dynamics of the vehicle control actions for more meaningful real-world training in the VR environment.
In either mode, the view of the simulated environment on the projection screen changes in relation to the simulated vehicle motion. For example, under either passive or active simulations, the view provided on the projection screen may be automatically adjusted as if it were from the perspective of a virtual camera mounted to the simulated vehicle. Alternatively, the view may could be from a perspective within the vehicle (e.g., the occupant's eye-point) for increased realism. In another embodiment, the perspective within the vehicle for the view could also be adjusted in response to head movement by an occupant.
As described above, the vehicle platform of the cable vehicle simulator system may have six Cartesian degrees of freedom, so six differential equations may describe the dynamics of the platform. Newton's Second Law gives three differential equations and the angular momentum rate of change law gives an additional three differential equations. A more detailed derivation of these six equations is given below. The set of differential equations can be expressed in the following matrix form:
and
vector {dot over (x)}=[{dot over (x)}D {dot over (y)}D żD ωx2 ωy2 ωz2]T is the velocity vector, or in a symbolic form
m is the platform mass, 13×3 denotes a 3×3 identity matrix, 2ID(3×3) denotes the 3×3 platform inertia matrix, the symbol
denotes the matrix form of the cross product, 20
A suitable way to solve the set of the vehicle simulator system dynamics equations is to use the numerical solver of Matlab. A complex set of dynamics equations can be solved by the Matlab SimMechanics toolbox. Therefore, the set of the vehicle simulator system dynamics equations may also has be solved using SimMechanics combined with additional programming in m-files. An exemplary embodiment of an iterative procedure for solving the cable-suspended vehicle platform equations is shown in
The dynamics equations and the numerical approach for their solution have been used to analyze the vehicle platform workspace. The workspace of the vehicle simulator system is defined as a set of points in 3D space that the vehicle platform center of gravity can reach undergoing any positive cable tension combinations with maximum cable tension less than a certain predefined value. The maximum value may be expressed as follows:
where tallowed is the maximum allowed cable tension considering, for example, limitations associated with motor torque and cable strength. The cable tensions depend on static forces, such as weight, and inertial forces:
t
i
=t
i
static
+t
i
dynamic (21).
While cable tensions due to static forces depend on the vehicle simulator system position and orientation, cable tensions due to inertial forces depend on vehicle platform motion through the workspace as well as the vehicle simulator system position and orientation. If inertial forces are negligible with respect to static forces (e.g., tistatic>>tidynamic), the workspace of exemplary embodiments of hybrid fuzzy logic/classical controllers for side acceleration/roll angle control and also for longitudinal/pitch angle control.
Fuzzy logic control shows suitable performance for vehicle simulations. In one embodiment, the fuzzy logic controller can be combined in a cascade fashion with a classical control loop controller. The hybrid controller may alleviate certain discontinuities in the fuzzy logic controller output and may reduce the complexity of the controller, for example, by reducing the number of if-then rules or the number of input variables.
In another embodiment, neural network controllers may be implemented to increase processing speed. However, stability may be reduced for this embodiment.
A dynamics and kinematics analysis of the vehicle platform was provided above to demonstrate the validity of certain specifications for exemplary control systems. The results of the workspace analysis provided above show that the size of the cable-suspended vehicle platform workspace may be influenced by the platform angle change. For example, allowing angles to change within interval [−20°, 20°] may reduce the workspace by approximately 66%. The available size of the cable-suspended vehicle platform workspace may also be influenced by inertial forces acting on the vehicle platform.
Beside the constraints on angles change, limitations may also be established for rates of change of cable lengths. A modeling phase may be used to identify undesirable negative or high cable tensions before a simulation scenario is actually run on the vehicle simulation system.
Newton's second law expressed in the coordinate frame {0} gives:
where {circumflex over (L)}i is the unit vector with direction of the ith cable (from point Ai to point Bi), ti is the ith cable tension, {right arrow over (F)}ext is the external force. Acceleration of the center of gravity may be evaluated using the acceleration of point D:
0{right arrow over (α)}C=0{right arrow over (α)}D+0({right arrow over (α)}×{right arrow over (ρ)}C)+0{right arrow over (ω)}×0({right arrow over (ω)}×{right arrow over (ρ)}C) (27),
or in the following expression:
the vehicle platform can be uniquely determined in 3D space. Otherwise, the workspace depends on vehicle platform trajectories, i.e., a radius of curvature, velocity and acceleration, and may not be uniquely defined as a function of 3D coordinates. One approach to solving this problem of workspace determination is to analyze the workspace due to static forces and then, if the inertial forces contribution significance, analyze them separately.
As used herein, the term pseudostatic is refers to when cable tensions are analyzed for the vehicle platform in motion, from a point to a point perspective, for static forces, but not inertial forces. Using the right-hand side of Equation (19), and setting the left hand-side of the equation equal to zero, an equation for calculation of the cable tensions due to static load of the vehicle platform can be obtained:
In order to determine the vehicle simulator system pseudostatic workspace, Equation (22) may be solved numerically for the cable tensions at a number of finite workspace volume pieces. Based on Equation (22) and the optimization method that produces a minimum sum of positive cable tensions, the results are shown in
With reference to
The prismatic space that was considered is not filled completely in
The next case (
The workspace determination is important in order to limit planned vehicle platform trajectories onto the feasible pseudostatic workspace and to avoid high cable tensions that could be unsafe and damaging. If a planned vehicle platform trajectory is a subset of pseudostatic workspace and the inertial forces are not significant with respect to static forces, then cable tensions will be limited by a predefined maximum value.
Next, it is shown that platform orientation in the pseudo-static workspace can influence cable tensions. If even a relatively small angle range of rotation is allowed, there is a significant workspace reduction. It has been shown that for the range [−20°, 20°] the reduction of the workspace is about ⅔. The significance of inertial forces on the cable tensions and workspace distortion is discussed below.
The cable-suspended vehicle platform trajectory can contain a number of segments that have small radii of curvature. Passing through those segments, the platform may undergo high inertial forces. These inertial forces, in general, can reduce the effective cable-suspended vehicle platform workspace. The influence of the inertial forces is shown in
The analysis of the available cable-suspended vehicle platform workspace is necessary to make appropriate control design specifications and to constrain the control goals discussed below.
Cable-suspended vehicle platform control provides a specified position and orientation of the vehicle platform with respect to time in order to properly coordinate control with other subsystems (e.g., video) for the simulation scenario. Additionally, cable-suspended vehicle platform control provides control of the vehicle platform acceleration in two directions and two angular accelerations about those two directions. The cable-suspended vehicle platform control must accommodate the fact that a cable cannot push a body. Moreover, cable-suspended vehicle platform control must also accommodate non-linear kinematics and dynamics equations. The position, velocity and acceleration of the platform is specified in the Cartesian coordinate system, but the directly-controlled and directly-sensed variables are cable lengths. Indirectly controlled outputs are three positions of the platform center of gravity and three angles of the platform. This indirect control requires a non-linear transformation of coordinates.
When a classical control algorithm is applied, a local linearization is applied at each time step. This linearization process may cause control errors, depending on the amount of non-linearity of variables trajectories, the time step, and magnitudes of the velocity and acceleration. In one embodiment, classical control algorithms may be applied in combination with Fuzzy logic control algorithms for control of the cable-suspended vehicle platform. In another embodiment, a neural network controller may be implemented.
Fuzzy logic control concepts have been shown to be successful in the area of non-linear systems control. For additional information on such fuzzy logic control concepts, see Avdagic, Artificial Intelligence and Fuzzy-Neuro-Genetic Algorithms, Grafoart, Sarajevo (language: Bosnian) (2003), the contents of which are fully incorporated herein by reference. One disadvantage of this concept is high requirement for processing power that rapidly rises with the number of the fuzzy rules used by the control algorithm. In another embodiment, neural network control algorithms may be implemented in the vehicle platform control to reduce the processing power required by certain fuzzy rules. An exemplary controller architecture combining fuzzy logic control with classical control loops is discussed in more detail below.
In order to produce certain inertial forces that may be sensed by an occupant (e.g., user) of the vehicle in the vehicle simulator system, side acceleration of the vehicle platform may be controlled.
The side acceleration control loop is an exemplary foam of a cascade control and may include a fuzzy logic controller and a classical control loop. The main (outer) control loop may include the fuzzy logic controller. An exemplary embodiment of the internal structure of the controller for the main (outer) control loop is shown in
The radius of curvature of a path may become infinitely high for straight segments. In order to eliminate appearance of high values of this input variable, the inverse of the radius may be used. Membership functions associated with this input (i.e., “Rkinv”) may include: i) highly negative (trapezoidal form), ii) low negative (triangular form), iii) about zero (triangular form), iv) low positive (triangular form), and v) highly positive (trapezoidal form). The second variable (the Cartesian feedback from the output) may be associated with five membership functions in similar fashion as for the radius of the curvature. Results from simulation scenarios show suitable performance for this cascade control.
Once consideration of the side acceleration control is the limited space of the cable-suspended vehicle platform motion. A side acceleration of significant duration may be required for various vehicle simulation trajectories. The vehicle simulator system can produce this acceleration for the vehicle platform within its limited workspace. When a boundary is approached, the controller may slowly (e.g., below the human occupant's capacity for detection) return the vehicle platform to the neutral position while maintaining the required side acceleration.
To make the simulation more realistic to an occupant (e.g., user), an additional effect may be introduced, such as a roll angle change to complement the side acceleration of the vehicle platform.
In order to alleviate the influence of high inertial forces onto the occupant (e.g., driver) and to make the simulation more realistic, the roll angle (i.e., rotation about the longitudinal axis) may be changed in such a way that the resulting force, consisting of the gravity force and the inertial force vector, acts perpendicularly to the seat. Similarly, an aircraft may change its direction of motion with a change of the roll angle toward the center of the curvature. An exemplary control loop for the roll angle is shown in
The controller may change the roll angle depending on the side acceleration of the vehicle platform. Therefore, inputs into the control loop may include the radius of curvature and the velocity of the desired vehicle trajectory. The input signals may include noise, which may cause errors in the derivatives of such signals. The input signals may be filtered and the output signals after differentiation of the input signals may be limited to certain reasonable values to reduce errors due to noise.
Besides the side acceleration, the vehicle acceleration can also have a longitudinal component. The control concept of the longitudinal acceleration of the vehicle platform is discussed below.
The longitudinal acceleration control may produce longitudinal acceleration of the vehicle platform proportional to the acceleration of the simulated vehicle motion. The control loop for longitudinal acceleration is shown in
The control loop for pitch angle control described below shares the same input variable in order to provide adequate pitch angle of the platform.
The pitch angle control provides the occupant (e.g., user) with an additional effect that makes longitudinal acceleration realistic. The angle magnitude depends on the magnitude of the tangential acceleration and may be limited to a range of [−20°, 20°] due to limited workspace of the vehicle platform.
A method for maintaining positive cable tensions for all commanded motions is provided below. The dynamic equations can be used to calculate cable tensions ti (i=1, . . . , 9) necessary to produce a desired (known) acceleration of the platform. This under-constrained set of equations can be written in the following form:
ac
6×9
·t
9×1
=d
6×1 (23).
To close the set of equations, a new set of constraints that ensure a minimization of the norm may be expressed:
∥
in the following form:
Additional constraints, in the form of inequalities ti≧0, i=1, . . . , 9, may ensure that calculated values for the cable tensions are positive. Equation (25) can be solved numerically through an iterative procedure, without finding analytical expression for the derivatives. In a case where a vehicle platform crosses a boundary of the available vehicle platform workspace, two potential problem situations may appear: i) there may be no solution for Equation (25) without negative calculated cable tensions or ii) some calculated cable tensions may be higher than the specifications for available or practical cable materials or motors (e.g., maximum motor torque).
An exemplary embodiment of the vehicle simulator system control with side acceleration/roll angle control combined with longitudinal acceleration/pitch angle control for an exemplary simulated automotive vehicle motion scenario is provided below. Exemplary filtered acceleration commands the control system embodiment and simulation scenario being described are shown in
The fuzzy logic controller for longitudinal acceleration may provide a signal with relatively high magnitude at the beginning of a simulation interval (e.g., scenario) and after achieving a certain velocity of the simulated vehicle, the signal may attenuate. The fuzzy logic controller for side acceleration may change the output signal frequently in certain intervals. However, the output signal may be filtered before its application. A second level of filtering may be accomplished the controlled object (e.g., the vehicle platform may act as an integrator block).
During the simulation, the pitch angle may be limited to [−15°, 15°] and the roll angle may be limited to [−20°, 20°] in order to avoid reduction of the available vehicle platform workspace. The vehicle platform height may be fixed to 1200 mm. The yaw angle may be set to zero, for example, depending on the nature of motion for the vehicle being simulated.
In summary, various embodiments of a cable-suspended vehicle simulator system and a method for performing a simulation scenario are provided herein. Derivation of nonlinear dynamics equations associated with the system and method and a vehicle platform workspace associated with the system and method are described herein. Matlab/Simulink/SimMechanics/VR toolbox simulations were performed to demonstrate
where the superscript 0 denotes that a vector is expressed within coordinate frame {0} and the symbol
denotes the matrix form of the cross product. The angular momentum rate of change law expressed in coordinate frame {1} gives:
The left hand-side of Equation (29) can be expressed in the following form:
By inserting Equation (30) into Equation (29) the following can be obtained:
where the superscript 1 denotes that a vector or matrix is expressed within coordinate frame {1}. Each term in Equation (31) may be transformed to be expressed within coordinate frame {2}.
The angular momentum change law is valid for center of mass, not for the point D, but we can use D'Alembert's principle to transform those moments onto the point D. The inertial moment {right arrow over (M)}inert is:
and the inertial force {right arrow over (F)}inert is:
−m{right arrow over (a)}C={right arrow over (F)}inert (33).
A moment is a free vector, thus the inertial moment can be moved to the point D, but a force produces moment {right arrow over (ρ)}C×{right arrow over (F)}inert. The equation for rotational motion, expressed in coordinate frame {1}, according to D'Alembert's principle, is:
After substitution of the terms in Equation (34) the following expression can be obtained:
After substituting Equations (36)-(38) in Equation (35), the following expression for coordinate frame {2} can be obtained:
Equations (26) and Equation (39) can be written in the following form:
Equation (40) can also be expressed in the more compact form given in Equation (19). This is the coupled nonlinear set of dynamics equations for the vehicle simulator system.
While the invention is described herein in conjunction with one or more exemplary embodiments, it is evident that many alternatives, modifications, and variations will be apparent to those skilled in the art. Accordingly, exemplary embodiments in the preceding description are intended to be illustrative, rather than limiting, of the spirit and scope of the invention. More specifically, it is intended that the invention embrace all alternatives, modifications, and variations of the exemplary embodiments described herein that fall within the spirit and scope of the appended claims or the equivalents thereof. Any element in a claim that does not explicitly state “means for” performing a specified function, or “step for” performing a specific function, is not to be interpreted as a “means” or “step” clause as specified in 35 U.S.C. §112, ¶ 6. In particular, the use of “step of” in the claims herein is not intended to invoke the provisions of 35 U.S.C. §112, ¶6.
This application claims the benefit of U.S. Provisional Patent Application No. 60/890,423, filed Feb. 16, 2007, the contents of which are fully incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
60890423 | Feb 2007 | US |