2.1. Design of an Earthquake Simulator
Figure 2 shows a structural scheme of an earthquake simulator for reproducing three-dimensional long-period ground motion during an earthquake. To reproduce the translational motion of the mobile platform along the X and Y axes, we use a CDPR with 4 cables that are controlled by 4 servomotors. The mobile platform makes planar motions on the floor (fixed base) using nine ball caster wheels. We install a vertical moving platform on the mobile platform to reproduce the vertical translational motion along the Z axis. The vertical moving platform moves along the Z axis on four linear screw guides with the help of four stepper motors. For testing, the object or person is placed on a vertical moving platform.
To reproduce a given seismogram, the earthquake simulator works as follows. The computer, using a specially designed program, issues signals for control to the servomotor controllers. Servo motors begin to stretch the cables by winding and unwinding winches on drums, motion the mobile platform horizontally along the X, Y axes, and thereby simulating the longitudinal and transverse waves of an earthquake. To carry out the vertical motion of the platform, four stepper motors are switched on synchronously.
The advantages of this constructive scheme of the earthquake simulator (see
Figure 2) consist in the simplicity of design, its assembly and disassembly and high transportability, and most importantly, in the possibility of realizing the vertical motion of the platform.
2.2. Kinematics of a CDPR
Let us consider the kinematics of a 4-cables CDPR, by which the mobile platform performs translational motions in the direction of the X and Y axes. The kinematic scheme of a CDPR with four cables is shown in
Figure 3. The fixed base is determined by the plane identified by four cable drive points
. The global coordinate system {
XYZ} is set to the center of the base. The local coordinate system {xyz} is located in the geometric center P of a rectangular platform with vertices at the connection points of the cables
.
In
Figure 3,
is the position vector of point
attached to the fixed frame relative to the main coordinate system {XYZ},
is the position vector of the point
,
is the length vector of the cables relative to the main coordinate system XYZ. The dimensions of the fixed rectangular frame CDPR are given by
width and
length. Dimensions of the square mobile platform CDPR: dp - side length. In the kinematic scheme of the CDPR, it is assumed that the cables are straight and stretched. In addition, it is assumed that the vectors
and
do not depend on the position of the mobile platform, i.e., the influence of possible guide pulleys or fasteners on the platform is not taken into account.
Applying the method of closed vector loops (see
Figure 3) we obtain the following system of equations
where the vector
is the Cartesian position of the P center of the mobile platform, relative to the global coordinate system {XYZ}. Here, the coordinate
is constant and equal to the height of the cables fastening relative to the base because the cables act on a plane.
Equations (1) can be written as
The unit vector
in Equation (1) along the cable can be expressed as
The unit vector
is directed from the mobile platform to the fixed base, which means that the positive forces are directed in the direction that shortens the cables and thereby reduces the value of the generalized coordinate
associated with it. The coordinates of the vector
, relative to the main XYZ coordinate system, are given in
Table 1 as referring to mechanical design of the scheme in
Figure 2.
The coordinates of the vector
, relative to the local coordinate system xyz, are given in
Table 2
To solve the direct task of the kinematics of a CDPR, from Equation (1) we obtain 4 nonlinear equations of direct kinematics, which form a system with redundant constraints [
23].
Here we consider cables as linear springs. In general, we cannot expect the above equations to be solved exactly, but we can minimize the error, which can be interpreted as minimizing the potential energy in the pretensioned cables. Let
be the potential energy of the system
where
is the stiffness of the
i-th cable. We assume that all cables have the same stiffness
. Then the minimum potential energy
U of the system does not depend on the specific stiffness value
and the direct kinematics function can be determined from the optimization problem [
23]
where the vector
is the given cable lengths. The function
gives the values
providing the minimum of Equation (6). As a result of solving problem (6), we obtain the coordinates of the platform, with given lengths of the cables.
2.3. Statics of a CDPR
For the balance of forces and moments of the movable platform of a CDPR that performs only translational motion, it is necessary to take into account all the forces acting on the mobile platform.
Figure 4 is a scheme for considering all these actions.
From
Figure 4 the equilibrium condition for the mobile platform can be expressed
The force
of the
i -th cable applied to the movable platform at point
can be expressed as
. Here
is an external force.
– the reaction from the force of gravity of a moving platform of mass
Can write Equation (7) in matrix form
where
is the CDPR structural matrix,
is the cable force vector,
Determining the cable force can be considered as a solution to the matrix problem in Equation (8), which consists in finding the vector
T in a given range and satisfying Equation (8). For the normal operation of the CDPR, the following conditional must be met
where
and
_max are the minimum and maximum cable forces, respectively.
For CDPR with redundant constraints, it is difficult to directly determine the forces of cables, the optimal task of minimizing the Euclidean norm of forces in cables is formulated [
24].
The optimization task is in the form
under the constraints defined by Equations (8) and (9).
The optimization task Equation (10) with constraints defined by Equations (8) and (9) is a quadratic programming task that can be solved using iterative algorithms for solving quadratic programs in general MATLAB optimization packages. The external force in the earthquake simulator is the friction force between the ball caster wheels and the fixed base. The Equation (10) give the solution for the tension force in the cables for a static equilibrium.
2.4. Dynamic Model of a CDPR
The dynamic equations of the mobile platform of a CDPR can be derived, considering the scheme in
Figure 5.
From
Figure 5 as the force equilibrium can be expected
where,
is the mass of the mobile platform concentrated in the center of mass,
is the velosity of the center of mass of the mobile platform. Substitute in Equation (11) the expression
, then in matrix form the dynamic equation looks like
where
is the CDPR structural matrix,
is the cables force vector,
– dynamic force acting on the platform.
Let us consider the dynamics of the CDPR drive, which consists of a servomotor shaft with lumped parameters and a winch drum for winding a cable. The dynamic model for the servomotor shaft and the cable winding drum is shown in
Figure 6.
In
Figure 6:
is the angle of rotation of the
i -th drive motor,
is the radii of the
i-th winch drums,
is the moment of inertia of the
i-th servomotor and the winch drum
is the torque of the
i-th servomotor,
is the dissipation coefficient
i -th drive (i=1,..,4).
The dynamic equation for the servomotor shaft and the cable winch drum is
where
,
,
,
,
,
,
Assuming that the torque of the CDPR drive servomotors keeps the cables in tension, from Equation (13) we determine the tension of the cables as a function of the torques of the drive motors:
The general model of the dynamics of the CDPR system is obtained by combining the equations of motion of the platform and the drive. To obtain an equation relating the i-th angles of rotation of the drive motor with the position of the end effector , we assume that all are equal to zero when the geometric center of the platform is located at the origin of the frame base .
The change in the length of the
i-th cable is equal to
, where
is the length of the cable obtained from the solution of the inverse kinematics problem, and
is the initial length of the
i-th cable.
For convenience, let’s rename the position vector of the final effector to , i.e., .
The successive time derivatives of Equation (16) have the form:
Substituting Equations (17) and (18) into Equation (14) gives:
Substitute Equation (19) into Equation (12), then we get
Let us write the Equation (20) of motion of the CDPR in the standard Cartesian form [
25].
Where
is the equivalent inertia matrix and
non-linear terms:
(
Here is the identity matrix.
They, the formulation with Equations (14)-(23) can be used to solve the servomotor torque that generate the proper cable tension for the platform motion.
2.5. Linear Drive of Vertical Moving Platform
For the earthquake simulator to reproduce the given earthquake seismogram (
Figure 1) along the Z axis, it is necessary to ensure the translational motion of the vertical moving platform. To ensure the motion of the vertical moving platform, four linear drives with ball screw transmission are used, which are installed at the tops of the rectangular platform.
Figure 7 shows a ball screw linear actuator that is designed to lift a vertical moving platform. The drive consists of a stepper motor connected through a coupling with a lead screw with a nut mounted on a linear guide, a slide is fixed on the nut, which is connected to a vertical moving platform.
The dependence of the slide stroke
on the angle of rotation of the screw
is determined by the formula
where
is the pitch of the screw.
The linear velocity of the slider
is determined by the formula
where
.
The gear ratio of the screw gear is
. The torque
of the stepper motor is determined by the formula
The value of the slide acceleration is taken from the earthquake seismogram acceleration graph, is ¼ of the mass of the vertical moving platform with a load.
2.6. Control System of a CDPR
The control system of a CDPR can be developed on the basis of the equation of motion of the CDPR in the standard Cartesian form Equation (23). The input parameters of the CDPR are the torque vector of the actuator . Each component of the vector must be positive or at least equal to zero (usually a small positive value).
Let’s introduce a virtual generalized input Cartesian force
[
25]
Since the structure matrix has a dimension of 3x4, because is 1x4 this virtual generalized input Cartesian force has a translational Cartesian space dimension of 3. Components of are not limited to positive values.
If you develop a control for the input virtual Cartesian force
, you can always find the real control input torque
with all positive components that satisfies Equation (27) if the position of the CDPR is within the static workspace. Consider a dynamics equation:
We use a Cartesian PD controller to monitor the positioning error
where
is the given Cartesian position. The calculated torque control law for the input virtual Cartesian force
can be expressed as
are 2x2 diagonal matrix gains. The inertial terms
consist of a common Cartesian matrix of inertia depending on the position of
and the Cartesian acceleration components
; non-linear terms are
.
In Equation (30), the influence of the terms of the nonlinear dynamics
is excluded and the inertial terms are taken into account using the calculated torque method [
26]. Equation (30) uses the desired Cartesian values of
. Using the actual
values from the feedback from the actuator encoder sensors and the forward kinematics solution causes problems with sensor noise and double digital differentiation
errors.
The control scheme of the CDPR is shown in
Figure 8, and consists of: a PD controller, a block for determining the virtual generalized input Cartesian force
, a block for calculating the real torque of the drive (Virtual to Real Calculation) with dynamic estimation of the minimum torque (Minimum Torque Estimation
) to ensure constant maintenance of the cable tension, despite the dynamics of the CDPR.
The position of the X is determined using the feedback of the encoder, which gives the rotation angles of the
i -th drive motor
to determine the lengths of the cables
. Further, by solving the direct kinematics of the CDPR (6), we determine the Cartesian position
. This feedback scheme will work well only if sufficient tension is constantly maintained on all cables [
25].
For control, we need to calculate the real torques of the actuator τ, taking into account the virtual forces . The solution of the insufficiently bounded system is similar to the solution of the optimization task Equation (10).
For normal operation of the CDPR, the cable tension vectors
must always be positive during its operation.
The calculation of the minimum torque for each drive to maintain the tension of the cables is determined from Equation (31)
Equation (32) makes it possible to dynamically estimate the minimum tension of each CDPR cable and prevents sagging during its motion when the condition is met.