Development of A Compliant Legged Quadruped Robot
Development of A Compliant Legged Quadruped Robot
Development of A Compliant Legged Quadruped Robot
https://doi.org/10.1007/s12046-018-0918-7 Sadhana(0123456789().,-volV)FT3
](0123456789().,-volV)
MS received 19 May 2016; revised 11 November 2017; accepted 1 June 2018; published online 18 June 2018
Abstract. This paper presents the detailed steps for design and development of a compliant legged fault
tolerant quadruped robot where each leg has two links and two motorized revolute joints for locomotion. The
body and upper links of legs are rigid whereas the lower link of each leg is compliant. Amble gait is demon-
strated on the developed robot. Safety and reliability are the most critical issues for the quadruped robot. During
the failure of any joint, performance of quadruped robot is affected. In this paper, locked joint failure is also
discussed. Strategies for fault tolerant control of the quadruped are developed and experimentally validated. The
developed robot can be used for various hardware-in-the-loop controller prototyping such as reconfiguration,
fault tolerant control, and posture control, etc. pertaining to quadruped robots.
1
102 Page 2 of 18 Sådhanå (2018) 43:102
Figure 3. Leg configuration: (a) forwardforward, (b) backward-backward, (c) forward-backward, (d) backward-forward.
Table 1. Major specifications of Maxon motor unit [23]. [20] in which each leg made up of four bar link which is
actuated by three single acting pneumatic cylinders and a
Parameter Value wheel attached at the leg tip is actuated by electric actua-
Brushless EC-4 pole motor (Maxon) tion. Pneumatic actuation system does not have the problem
Nominal voltage 48 V of oil leakage and oil flammability, and there is no need of
No load speed 16,500 rpm return lines for the fluid. However pneumatic actuation is
No load current 422 mA not the best choice for lower power-to-weight ratio,
Nominal speed 15,800 rpm dynamic locomotion and quick response (due to com-
Nominal torque (max. continuous torque) 118 m Nm pressibility of air).
Stall torque 3430 m Nm Electric actuation system is most commonlyused in
Max. efficiency 89% robots. Now-a-days, electric motors are available in big
Encoder with Line Driver (Maxon)
range of sizes and performance; they are more compact and
Counts per turn 1000
economical. More and more quadrupeds are using electric
Number of channel 3
Planetary gearhead GP42C (Maxon) actuation system. Some of them are Scout-II [21], Tekken
Reduction 230:1 II [7], KOLT [16] and Cheetah-cub [2]. In case of electric
Number of stages 4 actuation system, compliance in the legs is realized with
Maximum continuous torque 15 Nm springs for energy efficient locomotion. Compliance in the
legs also helps to protect the gear unit of electric actuator
from excessive impact force.
In the present work, electric actuation system is used.
Several kinds of electric motors are available and they are
distinguished by current profile (AC/DC), number of coils,
their configuration and type of synchronization. There are
AC motors and brushed and brushless DC motors. It is
found that brushless DC motors are most suitable for
robotics application as they offer high speed, torque and
efficiency, and low maintenance in comparison to other
motors. Brushless DC motors have electronically con-
trolled commutation systems. Due to absence of brushes,
they are faster and more efficient because brushes create
friction. Also, maintenance is less as there is no need to
periodically replace brushes as in a brushed motor.
However, brushless DC motors are costlier and their
controllers are more complicated [22]. Looking at the
Figure 6. Electric actuation system for quadruped robot [23].
positive side of brushless DC motors, brushless DC
motors made by Maxon are used in this research. Motor
unit comprising motor, gear head and encoder are chosen
in such a way so that the entire unit can supply torque as
2.4 Actuation system estimated in previous section. Table 1 shows the major
specifications of the Maxon motor and controller unit.
Hydraulic, pneumatic and electric actuations are usually
Figure 6 shows Maxon motor, gear head and encoder
used in the robots. Each actuation system has its own merits
parts separately and also as a combined unit.
and demerits.
Quadruped robot developed by Raibert [18], Titan XI
[19] and Baby Elephant [1] are actuated by hydraulic
actuation system. HyQ [3] is also partially actuated by
2.5 Controllers
hydraulic system. Hydraulic actuation system generally Controllers are the brain of the entire quadruped system. To
offers high force. Due to low compressibility of fluid, maintain better compatibility with the actuation system,
hydraulic actuators also give a quick response. However, Maxon controller has been used. For the position control, a
there are drawbacks of hydraulic actuation system such as discrete PID controller with anti-windup, acceleration feed
oil leakages, change of oil viscosity with temperature, and forward and velocity feed forward is implemented using a
non-linear characteristics of the hydraulic system leading to digital signal processor (DSP) where the sample time (TS)
difficulty in control system development. is taken as 1 ms, which is much smaller than the mechan-
Pneumatic actuation is also a choice for quadruped ical time constant of a typical drive system. As per Maxon
robots. Hirose laboratory of the Tokyo Institute of Tech- documentation, compatible controller for selected drive is
nology has developed a hybrid quadruped robot Airhopper EPOS2 P 24/5, which is a freely programmable positioning
Sådhanå (2018) 43:102 Page 5 of 18 102
Table 3. Specifications of quadruped robot developed at IIT quadruped robot was started. Patterns were prepared for
Roorkee, India. hub and upper link and they were casted from aluminum by
sand casting process and then they were machined for final
Parameter Value sizing. Robot chassis was prepared from aluminum chan-
Length of upper link 0.225 m nels. Lower link is ready made purchased and then it is
Length of lower (compliant) link 0.190 m modified by introducing the spring for leg compliance. The
Body length 0.500 m cabinet is fabricated from Galvanized Iron Sheet. Two
Body width 0.420 m stands are prepared from mild steel to hold robot while it is
Body thickness 0.065 m not moving. The final shape of the developed robot is
Quadruped robot weight (approx.) 15 kg shown in figure 11.
Main power source 24VDC, 63
center of body, top body and upper links are rigid, joint
rotation allows rotation of link about one axis only, robot is
walking on hard surface and on even terrain and external
force and moments effects are negligible. However, real
situation differs.
The operation of the developed quadruped was tested for ð xP1 Þ ¼ PB1 RB ðA xB Þ þ P1 ðB xP1 Þ
P1 A
ð3Þ
various gait patterns. Amble gait, which is statically
stable gait in which legs operate one by one in 1–4–2–3 ð xP2 Þ ¼ PP21 RP1 ðA xP1 Þ þ P2 ðP1 xP2 Þ
P2 A
ð4Þ
sequence, is considered in this paper as a test case. Here,
experimental results are shown for amble gait. Figure 12 Frame {P3} has same angular velocity as frame {P2},
shows a few snaps of quadruped robot walking with amble because both these frames are attached on the same link.
gait. It takes 3.3 s to complete one cycle. Experiment data Thus,
for joint rotations for five cycles are shown in figure 13. P3 A
ð xP3 Þ ¼ P2 ðA xP2 Þ ð5Þ
Figure 12 shows robot forward motion. In five cycles, it
is found to move by around 0.39 m. Surface condition plays Here, ð xP1 Þ ¼ ½ 0 0 h_ P1 T
P1 B
and
major role in the locomotion of robot. Also, there are T _
P2 P1 _
ð xP2 Þ ¼ ½ 0 0 hP2 , where hP1 represents the
always assumptions considered for preparation of mathe-
matical model like mass center of link is located at the mid angular velocity of the frame {P1} and similarly h_ P2 rep-
of its length, center of gravity of top body is located at the resents angular velocity of the frame {P2}.
102 Page 8 of 18 Sådhanå (2018) 43:102
For translational velocity propagation (TVP), the gov- joint in that leg. Assuming that robot is walking with trot
erning equations for the link tip velocity and the link CG gait. In the first phase of trot gait, diagonally opposite
velocity of planar robot can be given as [26], legs move forward while in the second phase, the same
leg tips touch the ground and body propagation takes
A A
ð Viþ1 Þ ¼ A ðA Vi Þ þ Ai R½i ðA xi Þ i ði Piþ1 Þ ð6Þ place. In the case of joint failure, there is no guarantee of
proper leg tip contact on the ground for body propagation
where, A ðA Viþ1 Þ represent the translational velocity of
and thus the locomotion is severely affected. In the
frame {i?1} with respect to inertial frame and expressed in
proposed control strategy, the two-DOF robot payload
the inertial frame; A ðA Vi Þ represent the translational
position is controlled in such a way that it moves towards
velocity of frame {i} with respect to inertial frame and
the hip joint of failed leg during body propagation to
expressed in the inertial frame;i ði Piþ1 Þ refers to the position ensure proper contact of failed leg tip on the ground and
vector of link frames {i?1} with respect to its previous towards center of the body during the forward movement
frames {i} and expressed in frame {i}. Equation (6) can be phase of the failed leg.
written in for two-DOF planar robot as,
For example, if joint 1 of leg 1 has failed then the desired
A A X and Y coordinates of payload mass during the first phase,
ð VP2 Þ ¼ A ðA VP1 Þ þ AP1 R½P1 ðA xP1 Þ P1 ðP1 PP2 Þ ð7Þ
i.e., during leg 1 forward movement, are Xdes = - 0.098 m
A A and Ydes = - 0.013 m in X and Y directions, respectively.
ð VP3 Þ ¼ A ðA VP2 Þ þ AP2 R½P2 ðA xP2 Þ P2 P2
ð PP3 Þ ð8Þ
These limits are decided from constrain of physical model.
If link lengths lP1 and lP2 are taken along the principal X- The main purpose is to keep the mass near the center during
axis of the links then they can be represented in vector form first phase while during the second phase, i.e., contact of leg
as, P1 PP2 ¼ ½ lP1 0 0 T , P2 PP3 ¼ ½ lP2 0 0 T . The tip with the ground,
moving appendage device is activated only when fault
R1x
occurs. If one of the legs joint is locked then the leg can still Xdes ¼ ðlP1 þ lP2 0:005Þ sin tan1 ð9Þ
R1y
move in a restricted way with the help of the other working
Sådhanå (2018) 43:102 Page 9 of 18 102
Figure 13. Joints rotation: (a) Leg 1 joint 1; (b) Leg 1 joint 2; (c) Leg 2 joint 1; (d) Leg 2 joint 2; (e) Leg 3 joint 1; (f) Leg 3 joint 2; (g)
Leg 4 joint 1; (h) Leg 4 joint 2.
1 R1x
Ydes ¼ ðlP1 þ lP2 0:005Þ cos tan ð10Þ
R1y
where, R1x and R1y are the distance of hip joint from body
center. To avoid singularity problems, an offset of 0.005 m
is introduced in Eqs. (9) and (10). Similar control laws are
expressed for joint failure in other legs. The above dis-
cussed control law is activated only after a joint failure is
detected in a particular leg. There is a bank of control laws
implemented in the form of if-then blocks and the appro-
priate control law is executed by the decision support sys-
tem based on the results of the fault diagnosis tools in the
system supervision module.
For the above desired coordinates of a planar robot tip,
necessary joint rotations can be derived using the Jacobian.
The Jacobian is the mapping between velocities in the joint Figure 14. Schematic diagram of a quadruped robot with moving
space to the Cartesian space. Equation (8) is utilized to appendage device.
102 Page 10 of 18 Sådhanå (2018) 43:102
Figure 15. Multi-bond graph of quadruped robot with two-DOF planar robot.
derive the Jacobian matrix. For position control of two- the Jacobian which then evaluates the required efforts at the
DOF planar robot tip with reference to time, desired posi- joints for appendage movement. The required efforts for the
tion of the tip discussed above are used as the reference. first and second joints can be evaluated as
Here, the reference velocity is compared with the actual
planar robot tip velocity and error values are sent to a PID
controller. The PID controller sends corrective signals to V1 ¼ CX b12 þ CY b11 þ CZ b10 ð11Þ
Sådhanå (2018) 43:102 Page 11 of 18 102
Parameters Value
Leg parameters
First link length of leg (l1) 0.225 m
Mass of first link (Ml1) 1.11 kg
Mass of cylinder part of the prismatic link (Mc) 0.3 kg
Mass of piston part of the prismatic link (Mp) 0.2 kg
Inertia of Link 1
Ixx1 0.013346 kg m2
Iyy1 0.007396 kg m2
Izz1 0.011563 kg m2
Inertia of cylinder part of the prismatic link
Ixxc=Izzc 0.005144 kg m2
Iyyc 0.000487 kg2
Inertia of piston and piston rod of the prismatic link
Ixxp=Izzp 0.00168 kg m2
Iyyp 0.000025 kg m2
Stiffness of the prismatic link (kf) 5000 N/m
Damping of the prismatic link (Rf) 274 Ns/m
Contact point stiffness at the piston cylinder of the prismatic link (kb) 108 N/m
Contact point resistance at the piston and cylinder of the prismatic link (Rb) 103 Ns/m
Length of piston and piston rod of the prismatic link (lp) 0.1 m
Distance of cylinder CG from the end frame of prismatic link (lcg) 0.05 m
Distance of piston CG from the end frame of the prismatic link (lpg) 0.07 m
Mass of piston & piston rod of the prismatic link (mp) 0.2 kg
Mass of cylinder part of the prismatic link (mc) 0.3 kg
Position of the cylinder end point with respect to the body fixed frame at the mass center in meter, (x2, y2, z2) (0.0, - 0.05, 0.0)
Position of the piston end point with respect to the body fixed frame at the mass center in meter, (x3, y3, z3) (0.0, 0.07, 0.0)
Common parameters
Mass of body (Mb) 6.94 kg
Inertia of body
Ixb 0.1470 kg m2
Iyb 0.1045 kg m2
Izb 0.2466 kg m2
Ground damping in x, y, z direction (Rgx, Rgy, Rgz) 1000 Ns/m
Ground stiffness in z direction (Kgz) 106 N/m
Controller parameters
Proportional gain of controller(Kp) 150
Derivative gain of controller (Kd) 90
Integral gain of controller (Ki) 40
Joint actuator parameters of quadruped
Motor constant (Kt) 0.0276 Nm/A
Motor armature resistance(Rm) 0.386 X
Motor inductance(Im) 0.001 H
Gear ratio (n) 230
Two-DOF planar robot parameters
Link 1 and Link 2 length of planar robot (lP1, lP2) 0.055 m, 0.140 m
Mass of link of planar robot (MPl1, MPl2) 0.05 kg, 0.06 kg
Payload mass (Mp) 0.5 kg
Inertia of both link of planar robot (Ix, Iy, Iz) 0.0001 kg m2
Motor constant (Kt) 0.02 Nm/A
Motor armature resistance (Ra) 0.1 Ohms
Gear ratio 100
Bearing resistance (Rb) 0.01 Ns/m
Proportional and integral gain values(Kpp), (Kip) 250, 6700
102 Page 12 of 18 Sådhanå (2018) 43:102
Figure 18. Two-DOF Planar robot joints rotation: (a) Joint 1; (b) Joint 2.
Sådhanå (2018) 43:102 Page 13 of 18 102
Figure 19. Two-DOF Planar robot tip movement in (a) X and (b) Y direction.
Figure 21. Joints rotation of physical model of quadruped robot during experiment: (a) joint 1 of leg 1 and 2; (b) joint 1 of leg 3 and 4;
(c) joint 2 of leg 1 and 2; (d) joint 2 of leg 3 and 4.
Figure 22. Joint rotation of physical model of two-DOF planar robot during experiment: (a) joint 1; (b) joint 2.
3.3 Simulation results of locked joint fault Simulation is carried out for six cycles. Each cycle is of
accommodation through reconfiguration 1.7 s duration. Initially, it is assumed that there is no fault.
Figure 16 shows the quadruped body CG motion in the
The control law discussed in section 3.1 for fault accom- Y and Z directions. Figures 17(a) and (b) show the joint 1
modation through reconfiguration is implemented in the and 2 rotations, respectively, of all leg joints of the quad-
model developed in section 3.2. Parameter used for the ruped. Initially, all the joints are working properly and the
simulations are listed in table 4. moving appendage device is switched off. Immediately
A fault is intentionally introduced during the locomotion after the joint failure (joint locked), the moving appendage
of the quadruped robot and the locomotion performance is device starts working. For demonstration of the control
observed with and without the moving appendage.
Sådhanå (2018) 43:102 Page 15 of 18 102
Figure 23. Tip movement of physical model of two-DOF planar robot during experiment in (a) X and (b) Y.
Figure 24. Snaps taken during experiment of reconfiguration using two-DOF planar robot.
strategy, the locked joint failure is introduced at joint 2 of contribution of the moving appendage device then it can
leg 1. Figure 18 shows two-DOF planar robot joint rotation traverse 0.362 m distance, whereas it can travel up to
for joint 1 and 2, while figure 19 shows the planar robot tip 0.441 m in 10.2 s with the controlled motion of the moving
position in the X and Y local frames with respect to time, appendage. Thus, it shows overall improvement in loco-
respectively, in which the moving appendage starts working motion because of the control strategies implemented with
immediately after the failure is detected at 2.4 s (automatic the moving appendage device.
failure detection is not implemented here, so the switching
condition is hard-coded). As per the control strategy, the
appendage device remains near the center during leg 1 3.4 Experimental validation of locked joint fault
forward motion, while it tries to move towards the hip joint accommodation through reconfiguration
of leg 1 during body propagation. Because of the weight of
the payload mass, the controller ensures proper contact of Above discussed simulation results are also verified
leg tip with the ground and effective body propagation. If through experimental results. A Quadruped robot as dis-
the quadruped robot continues locomotion without cussed in section 2 is used. A two-DOF planar robot with a
102 Page 16 of 18 Sådhanå (2018) 43:102
ure 24(a) shows planar robot payload position near the l1 l2 ðmb þ m1 þ m2 Þ cosðh2 Þh€2
center, Figures 24(b) and (c) payload moves away from the 2ðmb þ 2m1 þ m2 Þl2 l_2 h_ þ h_ 2 h_ 1
center and figure 24(d) shows payload moves near the
center. þ ðmb þ 2m1 þ 2m2 Þ
h i
Ll1 h_ 2 cosðh1 Þ Ll2 h_ 2 cosðh1 h2 Þ
h
4. Conclusions þ ðmb þ m1 þ m2 Þl1 l_2 2h_ 2 2h_ 1 þ 2h_ cosðh2 Þ
i
þl2 h_ 2 h_ 2 2h_ 1 þ 2h_ sinðh2 Þ
This paper presents the entire process of development of a h
quadruped robot. This work may serve as a guideline for þ ðm1 þ m2 Þ l21 h_ 2 sinðh1 þ h3 Þ
those who are interested to develop quadruped robot for i
their research purpose. Here, experimental results of robot l1 l2 h_ 2 sinðh1 h2 þ h3 Þ
h
walking with amble gait are demonstrated. There are cer- þ m2 l1 l0 h_ 2 sinðh1 þ h3 h4 Þ
tain issues like body disturbance during dynamic walk and i
different types of joint failures. A strategy for locked joint þl0 l2 h_ 2 sinðh2 h1 þ h4 h3 Þ
failure through reconfiguration by using hardware redun-
þ g ðmb þ m1 þ m2 Þl1 sin h1 h þ hp
dancy is demonstrated. Simulation and experimental results
þðmb þ 2m1 þ m2 Þl2 sinðh2 h1 þ h þ hp Þ
show the success of developed fault tolerant control strat-
egy. This quadruped robot with the added two-DOF robot s2 ¼ ½ðmb þ 2m1 þ m2 Þl22 þ ðmb þ 2m1 þ 2m2 ÞLl2
on its platform or elsewhere may be used to explore various
sinðh1 h2 Þ þ ðmb þ m1 þ m2 Þl1 l2 cosðh2 Þ
other control strategies such as posture control, fault tol-
ðm1 þ m2 Þl1 l2 cosðh1 h2 þ h3 Þ
erant and reconfiguration strategies for other types of joint
failures and/or multiple joint failures. m2 l0 l2 cosðh2 h1 þ h4 h3 Þh€
þ ½l22 ðmb þ 2m1 þ m2 Þ l1 l2 ðmb þ m1 þ m2 Þ
cosðh2 Þh€1 þ ½l2 ðmb þ 2m1 þ m2 Þ þ m2 r 2 h€2
2 2
Acknowledgements
þ ðmb þ 2m1 þ 2m2 ÞLl2 h_ 2 cosðh1 h2 Þ
2
The research work presented here was funded by the þ ðmb þ m1 þ m2 Þl1 l2 h_ h_ 1 sinðh2 Þ
Department of Science and Technology (DST), India under h i
Indo–Korea Joint Research in Science and Technology vide þ ðm1 þ m2 Þ l1 l2 h_ 2 sinðh1 h2 þ h4 Þ
Grant No. INT/Korea/P–13. Mr M M Gor is thankful to G. h i
þ m2 l0 l2 h_ 2 sinðh2 h1 þ h4 h3 Þ
H. Patel College of Engineering and Technology, Gujarat,
India for allowing him to carry out research work at IIT g ðmb þ 2m1 þ m2 Þl2 sinðh2 h1 þ h þ hp Þ
Roorkee. The work of Mr J M Yang and Mr S W Kwak was þ 2ðmb þ 2m1 þ m2 Þl2 l_2 h_ þ h_ 2 h_ 1
supported by the Korea government (MEST) vide the
National Research Foundation of Korea Grant No. NRF–
2011–0027705.
Sådhanå (2018) 43:102 Page 17 of 18 102
s3 ¼ ½l1 ðmb þ m1 þ m2 Þ sinðh2 Þ€l2 þ ½l21 ðmb þ m1 þ m2 Þ s4 ¼ ½ðmb þ 2m1 þ m2 Þl22 þ ðmb þ 2m1 þ m2 Þ
l22 ðmb þ 2m1 þ m2 Þ Ll1 ðmb þ 2m1 þ 2m2 Þ sinðh3 Þ Ll2 sinðh3 h4 Þ
þ 2l1 l2 ðmb þ m1 þ m2 Þ cosðh4 Þ þ ðmb þ m1 þ m2 Þl1 l2 cosðh4 Þ ðm1 þ m2 Þl1 l2
þ ðm1 þ m2 Þl21 cosðh3 þ h1 Þ
cosðh4 h3 h1 Þ þ m2 l0 l2 cosðh4 h3 þ h2 h1 Þh€
þ ðm1 þ m2 Þl1 l2 cosðh4 h3 h1 Þ m2 l1 l0
þ l22 ðmb þ 2m1 þ m2 Þ l1 l2 ðmb þ m1 þ m2 Þ
cosðh3 þ h3 h4 Þ m2 l2 l0 cosðh4 h3 þ h2 h1 Þ
Ll2 ðmb þ 2m1 þ 2m2 Þ sinðh3 h4 Þh€ cosðh4 Þh€1 þ l22 ðmb þ 2m1 þ m2 Þ h€4
þ l21 ðmb þ m1 þ m2 Þ þ m1 r12 þ l22 ðmb þ 2m1 þ m2 Þ þ 2ðmb þ 2m1 þ m2 Þl2 l_2 h_ þ h_ 4 h_ 3
þl1 l2 ðmb þ m1 þ m2 Þh€3 þ l2 ðmb þ 2m1 þ m2 Þ
2 þ ðmb þ 2m1 þ m2 ÞLl_2 h_ sinðh3 h4 Þ
l1 l2 ðmb þ m1 þ m2 Þh€4 þ ½2ðmb þ 2m1 þ m2 Þl2 l_2
h þ ðmb þ 2m1 þ 2m2 ÞLl2 h_ cosðh3 h4 Þ
h_ þ h_ 4 h_ 3 þ ðmb þ 2m1 þ 2m2 Þ Ll1 h_ 2 cosðh3 Þ 2
i þ ðmb þ m1 þ m2 Þl1 l2 h_ 3 h_ sinðh4 Þ
Ll2 h_ 2 cosðh3 h4 Þ þ ðmb þ m1 þ m2 Þl1
h þ ðmb þ 2m1 þ 2m2 ÞL l2 h_ h_ þ h_ 4 h_ 3
l_2 2h_ 4 h_ 3 þ h_ cosðh4 Þ
i
cosðh3 h4 Þ l_2 h_ sinðh3 h4 Þ
þl2 h_ 4 h_ 4 h_ 3 þ h_ sinðh4 Þ
h h i
þ ðm1 þ m2 Þ l21 h_ 2 sinðh3 þ h1 Þ þ ðm1 þ m2 Þ l1 l2 h_ 2 sinðh4 h3 h1 Þ
i h
þl1 l2 h_ 2 sinðh4 h3 h1 Þ þ m2 l0 l_2 h_ cosðh4 h3 þ h2 h1 Þ
h
þ m2 l1 l0 h_ 2 sinðh3 þ h1 h2 Þ l_2 h_ cos h4 h3 h2 þ h1 þ 2 h hp
i
þl0 l_2 h_ cos h4 h3 h2 þ h1 þ 2 h hp þl2 h_ 2 sinðh4 h3 þ h2 h1 Þ
i
l0 l2 h_ 2 sinðh4 h3 þ h2 h1 Þ g ðmb þ 2m1 þ m2 Þl2 sinðh4 h3 þ h hp Þ
þ g ðmb þ m1 þ m2 Þl1 sin h3 h þ hp
þðmb þ 2m1 þ m2 Þl2 sinðh4 h3 þ h hp Þ
Appendix B
Coefficient Equation
b10 ðsinðhÞ sinðhP1 Þ þ sinðwÞ cosðhÞ cosðhP1 ÞÞlP1
þ ½ð sinðhÞ cosðhP1 Þ þ sinðwÞ cosðhÞ sinðhP1 ÞÞ sinðhP2 Þ
þðsinðhÞ sinðhP1 Þ þ sinðwÞ cosðhÞ cosðhP1 ÞÞ cosðhP2 ÞlP2
b11 ½ cosðhÞ sinð/Þ sinðhP1 Þ þ ðsinðwÞ sinðhÞ sinð/Þ þ cosðwÞ cosð/ÞÞ cosðhP1 ÞlP1
þ ½ðcosðhÞ sinð/Þ cosðhP1 Þ þ ðsinðwÞ sinðhÞ sinð/Þ þ cosðwÞ cosð/ÞÞ sinðhP1 ÞÞ sinðhP2 Þ
þð cosðhÞ sinð/Þ sinðhP1 Þ þ ðsinðwÞ sinðhÞ sinð/Þ þ cosðwÞ cosð/ÞÞ cosðhP1 ÞÞ cosðhP2 ÞlP2
b12 ½ð cosðhÞ cosð/Þ sinðhP1 Þ þ sinðwÞ sinðhÞ cosð/Þ cosðhP1 Þ cosðwÞ sinð/Þ cosðhP1 ÞÞlP1
þ ððcosðhÞ cosð/Þ cosðhP1 Þ þ ðsinðwÞ sinðhÞ cosð/Þ cosðwÞ sinð/ÞÞ sinðhP1 ÞÞ sinðhP2 Þ
þð cosðhÞ cosð/Þ sinðhP1 Þ þ ðsinðwÞ sinðhÞ cosð/Þ cosðwÞ sinð/ÞÞ cosðhP1 ÞÞ cosðhP1 ÞlP2
b13 ½ð sinðhÞ cosðhP1 Þ þ sinðwÞ cosðhÞ sinðhP1 ÞÞ sinðhP2 Þþ
ðsinðhÞ sinðhP1 Þ þ sinðwÞ cosðhÞ cosðhP1 ÞÞ cosðhP2 ÞlP2
b14 ½ðcosðhÞ sinð/Þ cosðhP1 Þ þ ðsinðwÞ sinðhÞ sinð/Þ þ cosðwÞ cosð/ÞÞ sinðhP1 ÞÞ sinðhP2 Þ
þð cosðhÞ sinð/Þ sinðhP1 Þ þ ðsinðwÞ sinðhÞ sinð/Þ þ cosðwÞ cosð/ÞÞ cosðhP1 ÞÞ cosðhP2 ÞlP2
b15 ½ðcosðhÞ cosð/Þ cosðhP1 Þ þ ðsinðwÞ sinðhÞ cosð/Þ cosðwÞ sinð/ÞÞ sinðhP1 ÞÞ sinðhP2 Þ
þð cosðhÞ cosð/Þ sinðhP1 Þ þ ðsinðwÞ sinðhÞ cosð/Þ cosðwÞ sinð/ÞÞ cosðhP1 ÞÞ cosðhP2 ÞlP2
102 Page 18 of 18 Sådhanå (2018) 43:102