Professional Documents
Culture Documents
Iceee 2017 8108873-Paper
Iceee 2017 8108873-Paper
lf
fi = kf ωi2 n̂i
τ i = kf P,i tB × n̂i + (−1)i kτ n̂i ωi2
ω4 XB lc τ1
◦
θs 60
Z Y where n̂i is the unitary vector coaxial with the ZP,i axis of
τ4 OB B BOS,1 OL,1
ω1
OK,1
∅db
lp the motor. Both, the force fi and torque τ i , can be grouped in
a wrench wi :
τ6 fi n̂i
kf ωi2
wi = = P,i i kτ
ω5 τ5 τi B tB × n̂i + (−1) kf n̂i
ω6
Tf
wi = k ω 2 = Ti fi
Tτ i f i
(a) The robot base of the Hexapodopter. with fi = kf ωi2 being the magnitude of the thrust force and
Swing Servo
Ti being the transfer colon vector for motor i. Therefore, the
θs Brushless motor total force and torque applied to the six thrust motors, with
ZS,i ωi
ZM,i
Lift Servo
YS,i YL,i
respect to B, can be obtained as follows:
M,i θl ZP,i
OB A Knee Servo
YB B
XS,i
Femur YP,i YK,i
Body frame
XB OM,i Y OL,i F
ZB
XM,i M,i
OP,i XP,i = TΩ
Coxa ZL,i XL,i
XK,i lm
τ B
lp ZK,i OK,i
lc
θk where:
lf
Tibia lt
Tf
T= = T1 T2 · · · T6
Tτ
ZSP,i
T
Ω = kf ω12 ω22 · · · ω62
OSP,i
XSP,i
YSP,i
Support point
Using the transfer matrix T, the dynamics of the
(b) The 3 DoF limb of the Hexapodopter. Hexapodopter can be rewritten as follows:
Fig. 3: Mechanical description of the hexapodopter. mr̈ = R (q) Tf Ω − mg − mq̇ × ṙ (3)
Iq̈ = Tτ Ω − q̇ × Iq̇ (4)
P,i
can compute the homogeneous transformations M,i A(θs , θl )
SP,i
and M,i A(θs , θl , θk ). Said that, the location of the i-th V. H OLONOMIC A NALYSIS
thrust motor, relative to B, is given by P,i M,i P,i
B A = B A M,i A
If the Hexapodopter is a 6 DoF vehicle, the rank of T
and the location of i-th support point can be computed by should be equal to 6, but this is not sufficient. To describe
SP,i M,i SP,i and validate that the Hexapodopter is a holonomic UAV we
B A = B A M,i A.
used the force-closure concept.
IV. M ATHEMATICAL MODEL FOR FLYING
In this section, we present the mathematical model for the A. Force-Closure in Grasp theory
Hexapodopter during flight, which is based on the Newton- Force-closure has been used to validate that a mechanical
Euler equations and determined by the physical parameters hand can grasp an object while maintaining translational and
shown in the past Section. The relative position and pose of B rotational equilibrium [3]. We used this idea to validate that the
with respect to W is given by the position vector r = [x, y, z]T six thrust forces grasping the body of the Hexapodopter while
and the three Euler angles q = [φ, θ, ψ]. flying, can counteract the forces and torques caused by any
The dynamics of a rigid body can be decomposed into external disturbance. In grasping theory, a force acting on an
two components: translational and rotational, as shown in object on a contact point Ci is modeled by a four-component
Equations 1 and 2, respectively. vector fi = [fn , fo , ft , fm ]Ti , where the component fn is the
normal component, fo and ft are the two perpendicular tangent
mr̈ = R(q)F − mg − q̇ × mṙ (1)
components and fm represents the spin moment about the
Iq̈ = τ − q̇ × Iq̇ (2) contact normal. The exerted wrench by a force fi on a rigid
with m the total mass of the rigid body, I its inertial matrix, g body is modeled with a grasp matrix Gi ∈ R6×4 and the
the gravity acceleration, R(q) the rotation matrix, F the total resultant wrench can be computed as wi = Gi fi , where Gi is
force and τ the total torque applied over the rigid body. defined by:
To relate the angular speed ωi of the motor with the thrust
n̂ ô t̂ 0
force it generates, we do f = kf ω 2 and the torque as τi = Gi =
r × n̂ r × ô r × t̂ t̂ i
2017 14th International Conference on Electrical Engineering, Computing Science and Automatic Control (CCE), Mexico City, Mexico. September 20-22, 2017
Parameter Value
12 Mass (m) 1.6 Kg
Inertia (IB ) diag(2.5e − 2, 2.5e − 2, 5.1e − 2)Kg · m2
0.25
10 θL 40o
Acceleration [m/s2 ]
8
d
Force [N]
Γ(d) 0.15
6
ẍmax Controllers Modelled
ÿmax dynamics r, ṙ
4 0.1
fd uF
rd , ṙd Position Translational
Control F Vehicle
2 0.05 ωB,d uτ allocation dynamics
qd , q̇d Attitude Rotational
q, ωB
0 0
0 10 20 30 40 50 60 70 80
Lift angle θL [Deg]
Fig. 5: Controller architecture. The position and attitude con-
Fig. 4: Maximum acceleration in the x and y axes, versus the trollers are decoupled, acting independently.
form closure metric d and Γ(d).
Figure 4, the shaded area spans the peak of performance
Since the LP1 test considers the weight of the vehicle, the function Γ(d) to the peak of maximal accelerations. We
term d represents the smallest thrust force required to coun- consider that any lift angle in the shaded area represents
teract its weight. Under the restriction that ωi ∈ [0, ωmax ], all a good compromise between grasp configuration of thrust
motors can exert a maximum thrust force Fmax ; if d . Fmax , motors (providing a better stability during flight to compensate
then the controller would have a small scope for action and external disturbances) and maneuverability of the UAV.
the vehicle would be consuming too much energy just to
compensate its own weight. Said that, we propose a quadratic VI. P OSITION CONTROL SYSTEM
function Γ(d) to define the compromise between grasp quality After analyzing and validating the holonomic characteristic
and maneuverability, given by: of the Hexapodopter, we aimed to design a closed loop
controller for it. The chosen architecture for the controller
Γ(d) = d(Fmax − d) is depicted on Fig. 5. This controller was numerically tested
to perform a challenging flight plan: take-off, describe a
The function Γ(d) serves as a performance metric for a lemniscate and land. The lemniscate, consisting of two turns
given configuration of the Hexapodopter, defining a compro- on opposite directions and two straight line segments, requires
mise between the grasp quality d and the scope for action from the vehicle to move in every direction. The parametric
Fmax − d of the UAV. equations for the lemniscate at a flight altitude h are:
Through simulation, we evaluated Γ(d) for the finite range
0 ≤ θL ≤ 90◦ , using the simulation parameters from Table IV
a sin( t )
and considering ωmax = 12500RP M . The results are shown φd (t) = 0
in Fig. 4, the function Γ(d) increases lightly from 0◦ to around rd (t) = b sin( 2t )
qd (t) = θd (t) = 0
4t
40◦ , where it reaches its maximum value, and then decreases c sin( ) + h ψd (t) = 0
rapidly until reaching 0 at around 68◦ . When Γ(d) is negative, The error between the desired and current position, orien-
the motors are turning at ωmax , but they cannot compensate tation and velocity of the vehicle at time instant k, defined by
the weight of the Hexapodopter. ek = rd − r(tk ) is fed to the control architecture, both for
Since classical multicopters cannot move sideways without position and attitude control, which are two PD controllers.
tilting, we also computed the maximal acceleration in x and y The translational and rotational dynamic equations 3 and 4
T
directions (on the XYW plane), that the Hexapodopter can are used to compute the required wrench [uf , uτ ] while
achieve for a given lift angle θL without tilting, in order the transfer matrix T (the Control Allocation block) is used
to analyze the maneuverability of our design [7]. These two to compute the desired angular speeds for the thrust motors
subproblems can be stated as follows: (see Fig6b). Additional simulation parameters are listed on
Table IV. The initial conditions used in the simulation were
r(0) = [0, 0, 0]T and all Euler angles equal to zero.
ACC1: max ẍ subject to: ÿ = z̈ = q̇ = 0 The executed flight plan is shown in Fig 6a. The graphic
F
ACC2: max ÿ subject to: ẍ = z̈ = q̇ = 0 shows how the vehicle takes off at ground level and per-
F
forms the desired trajectory given by rd (t), then it lands at
The results for ACC1 and ACC2 are also shown in Fig. 4. r = [0.5, 0, 0]T . Figure 6c displays the changes in altitude
As expected, the maximal accelerations increase from 0 at and the resultant angular velocities for all the motors can be
θL = 0◦ to their corresponding peaks at around 55◦ . observed on Fig. 6b, all velocities being positive and bounded
These two metrics, the performance function Γ(d) and the ∈ [0, ωmax ] during the whole trajectory. Figure 6d shows the
maximal accelerations (ẍ, ÿ), can be used to determine the evolution of the Euler angles; Roll and Pitch and Yaw angles
best configuration for the lift angle of the Hexapodopter. In stay close to zero, i.e. the UAV remains leveled at all times.
2017 14th International Conference on Electrical Engineering, Computing Science and Automatic Control (CCE), Mexico City, Mexico. September 20-22, 2017
Z axis [m]
R EFERENCES
1
[1] V.S. Akkinapalli, G.P. Falconi, and F. Holzapfel. Attitude control of
a multicopter using l1 augmented quaternion based backstepping. In
0.5 Aerospace Electronics and Remote Sensing Technology (ICARES), 2014
IEEE International Conference on, pages 170–178, Nov 2014.
0 [2] A. Alaimo, V. Artale, C. Milazzo, A. Ricciardello, and L. Trefiletti.
1 Mathematical modeling and control of a hexacopter. In Unmanned
0.5 1
0 0.5 Aircraft Systems (ICUAS), 2013 International Conference on, pages
0
−0.5 −0.5 1043–1050, May 2013.
−1 −1 [3] ZUO Bingran and QIAN Wenhan. A force-closure test for soft multi-
Y axis [m] X axis [m]
fingered grasps. SCIENCE CHINA Technological Sciences, 41(1):62,
(a) The desired and actual trajectories of the 1998.
vehicle, after executing the flight plan. [4] Peter Corke. A simple and systematic approach to assigning denavit-
hartenberg parameters. IEEE Transactions on Robotics, 23(3):590–594,
June 2007.
Angular velocity [Rad/s]
960 [5] Minh-Duc Hua, Tarek Hamel, Pascal Morin, and Claude Samson.
ω1 ω2 ω3 ω4 ω5 ω6
940 Control of vtol vehicles with thrust-tilting augmentation. Automatica,
920
52(C):1–7, February 2015.
[6] A. Kaba, A. Ermeydan, and E. Kiyak. Model derivation, attitude control
900
and kalman filter estimation of a quadcopter. In 2017 4th International
0 50 100 150 200 250 300 350 400 450
Conference on Electrical and Electronic Engineering (ICEEE), pages
Time [s]
210–214, April 2017.
(b) The angular speeds of the 6 motors. [7] H. Mehmood, T. Nakamura, and E. N. Johnson. A maneuverability
analysis of a novel hexarotor uav concept. In 2016 International
Conference on Unmanned Aircraft Systems (ICUAS), pages 437–446,
Roll angle φ [Rad]
4 2
Yaw angle φ [Rad]
Roll angle φ [Rad]