Location via proxy:   [ UP ]  
[Report a bug]   [Manage cookies]                

ATDM:An Anthropomorphic Aerial Tendon-driven Manipulator with Low-Inertia and High-Stiffness

Quman XU Zhan Li Hai Li Xinghu Yu Yipeng Yang
Abstract

Aerial Manipulator Systems (AMS) have garnered significant interest for their utility in aerial operations. Nonetheless, challenges related to the manipulator’s limited stiffness and the coupling disturbance with manipulator movement persist. This paper introduces the Aerial Tendon-Driven Manipulator (ATDM), an innovative AMS that integrates a hexrotor Unmanned Aerial Vehicle (UAV) with a 4-degree-of-freedom (4-DOF) anthropomorphic tendon-driven manipulator. The design of the manipulator is anatomically inspired, emulating the human arm anatomy from the shoulder joint downward. To enhance the structural integrity and performance, finite element topology optimization and lattice optimization are employed on the links to replicate the radially graded structure characteristic of bone, this approach effectively reduces weight and inertia while simultaneously maximizing stiffness. A novel tensioning mechanism with adjustable tension is introduced to address cable relaxation, and a Tension-amplification tendon mechanism is implemented to increase the manipulator’s overall stiffness and output. The paper presents a kinematic model based on virtual coupled joints, a comprehensive workspace analysis, and detailed calculations of output torques and stiffness for individual arm joints.

The prototype arm has a total weight of 2.7 kg, with the end effector contributing only 0.818 kg. By positioning all actuators at the base, coupling disturbance are minimized. The paper includes a detailed mechanical design and validates the system’s performance through semi-physical multi-body dynamics simulations, confirming the efficacy of the proposed design.

keywords:
Structural design , Aerial manipulator system , Tendon-driven , Anthropomorphic manipulator , Topology optimization , Coupling disturbance
journal: Robotics and Autonomous Systems
\affiliation

[label1]organization=Research Institute of Intelligent Control and Systems, Harbin Institute of Technology, addressline=, city=Harbin, postcode=150001, state=Heilongjiang, country=China

\affiliation

[label2]organization=Peng Cheng Laboratory, addressline=, city=Shenzhen, postcode=518000, state=Guangdong, country=China

\affiliation

[label3]organization=Ningbo Institute of Intelligent Equipment Technology Co., Ltd., addressline=, city=Ningbo, postcode=315201, state=Zhejiang, country=China

1 Introduction

UAVs, with their immense research value, are forecasted to reach a global market size of US$ 17,520 million by 2028111GlobeNewswire. URL: https://www.globenewswire.com. Accessed on: [2023/10/31].. Known for their ease of operation and high agility and maneuverability in three-dimensional space, UAVs have applications in areas such as aerial photography, mapping, and agriculture[1, 2, 3]. Historically, their use was primarily restricted to passive monitoring tasks. Inspired by avian flight, researchers have integrated multi-DOF mechanical manipulators or enhancement mechanisms to flying platforms, leading to the development of AMS. This allows UAVs to actively interact with their environment[4], attracting significant interest from both the academic and industrial sectors.

Currently, AMS are used for tasks that pose inconveniences or hazards to humans, such as aerial grasping [5], aerial manipulation [6, 7, 8, 9], contact inspection [10, 11], bridge maintenance [12], and environmental monitoring [13]. Aside from underactuated compliant mechanisms like SNAG [13] and single-link or grippers [14, 15], the majority of AMS prototypes feature a serial manipulator configuration comprising an upper arm and a forearm. The choice in the number of joints and the kinematic arrangement is primarily influenced by the operation’s needed dexterity, aiming to reduce the number of actuators and consequently the overall weight [16].

The control of AMS is challenging due to their intrinsic coupling, non-linear dynamics, and uncertainties [17, 18]. Addressing these challenges, Cao et al. [19] employ a radial basis function neural network (RBFNN) for real-time dynamic coupling compensation between UAVs and manipulators; Emami et al. [20] propose a multi-stage disturbance observer-based model predictive control(MPC) for aerial grasping and trajectory tracking; and Chen et al.[21] explore an adaptive sliding-mode disturbance observer(ASMDO)-based controller for enhanced robustness and tracking accuracy. Overall, to ensure accurate and robust operation of AMS, it is crucial to compensate for the large aggregate perturbations caused by the manipulator, which is typically achieved through observers [20, 21, 22], feed-forwards [23, 24], and methods adept at handling strong nonlinearities, such as neural networks [19].

The coupling disturbance caused by pose changes in manipulators are the primary source of aggregated disturbances in AMS,as pointed out by Li et al. [23].This is mainly attributed to three factors: shifts in the system’s COM, coupling disturbance forces, and coupling disturbance torques.Manipulators with motors and reducers in their joints, intensify this issue by adding substantial weight, thereby amplifying inertial forces and torques during motion [25]. Even with desktop-level manipulator platforms, balancing load capacity with coupling disturbance remains a challenge due to AMS’s payload constraints.

This paper considers adopting a structural design method to alleviate coupling disturbances in AMS. The essence of this approach involves physically placing the actuators at the proximal end of the manipulator and driving the distal joints through a transmission medium. This design aims to minimize inertia and centralize the overall mass distribution, effectively reducing the shift in the system’s center of gravity and the coupling disturbances during the arm’s movement. It is expected to enhance the dynamic motion performance of the system.

Contrary to traditional serial manipulators that position heavy actuators at the joints, cable-driven serial manipulators((alternatively referred to as tendon-driven)) utilize flexible cables and centralize the mechatronic servo system at the base [26, 27, 28]. This design not only reduces joint weight and dimensions but also enhances waterproofing and dustproofing [29]. Such a configuration is advantageous for creating lightweight and compact end effectors, especially when intricate multi-DoF motions are required in confined spaces [30, 31, 32]. A notable example of this approach is the Da Vinci surgical robot [33, 34, 35].

Cable-pulley systems are prevalent in the field of cable-driven serial manipulators[36]. Force amplification with tendons is straightforward due to the adjustable speed reduction ratio. These tendons, often made of stainless steel or polymer cables, transfer forces from motors to joints, enhancing the safety of robot-human interactions [37, 30]. Their inherent compliance and dynamics make them suitable for mimicking musculoskeletal characteristics, leading to their popularity in anthropomorphic robots.However, a notable challenge with the single winding of steel cables is their reduced stiffness and torque output, especially when compared to traditional industrial manipulators. To ameliorate this deficiency,Kim introduced a tension-amplification mechanism [28, 38] for a 7-DOF manipulator. This innovation not only achieves industrial-level joint stiffness and torque output but also ensures safer human-robot interactions due to the reduced mass and inertia of the designed robotic arm.

Based on the analysis above, equipping the AMS with a cable-driven serial manipulator, integrated with a tension amplification mechanism, strikes an optimal balance between load capacity and minimization of coupling disturbances. The cable-driven approach in AMS brings distinct advantages, primarily attributed to its inherent compliance and reduced inertia, a result of distributed actuator placement. This configuration effectively minimizes coupling disturbances. Furthermore, numerical optimization tools such as topology optimization and internal lattice structures can be employed to significantly reduce structural weight of the manipulator. With the advancements in additive manufacturing technologies, it is now feasible to realize complex lightweight structures derived from topology and lattice optimizations [39, 40].

Refer to caption
Figure 1: The proposed aerial tendon-driven manipulator(ATDM)

Note:JPG format, 1-column fitting image

This paper presents the novel ATDM, illustrated in Fig.(1). This design combines a hexrotor with a 4-DOF tendon-driven manipulator. By positioning all actuators at the base of the arm, we achieve a dual benefit: a significant reduction in coupling disturbance and a more efficient integration of mechatronics, particularly beneficial in adverse environments. Leveraging topology optimization and finite element methods, we optimized the design of the moving joints and links, striking a balance between stiffness and weight reduction. The system’s total weight is approximately 2.7 kg, with the dynamic portion of the arm contributing only 0.818 kg, exemplifying an optimized weight distribution.

The primary contributions of this paper are outlined as follows:

  1. 1.

    The anthropomorphic tendon-driven manipulator was first applied in AMS, with all electromechanical servo systems were located at the base,which effectively mitigating the issue of excessive coupling disturbance within AMS. The design process of the manipulator is guided by the dynamics of AMS and an accurate model of coupling disturbance. Semi-physical simulation has demonstrated that the tendon-driven approach presents a notable reduction in disturbance, outperforming traditional serial manipulator setups.

  2. 2.

    The detailed manipulator structural design and its optimization process are demonstrated. Including tension-amplification tendon(TAT) that can increase joint stiffness and thus increase load capacity; 1-DOF and 2-DOF joints based on TAT; lightweight tensioning mechanisms with adjustable tension; and finite element topology optimization, lattice optimization in the process of weight reduction of the manipulator.

  3. 3.

    A kinematic model of the arm is formulated, supplemented by workspace analysis of the ATDM system. In addition, the output torque and stiffness of each joint of the arm based on the TAT mechanism are also derived.

The remainder of this paper is structured as follows: Section 2 deduces the coupling disturbance model of AMS.Section 3 shows the mechanical design and provides an analysis. Section 4 details the kinematics, analyzes the output torque and stiffness of joints. Section 5 presents the semi-physical simulation results. Finally, Section 6 offers conclusions drawn from the research.

2 Modeling

This section presents the mathematical model of AMS, derives the coupling disturbance model and compare the impact of various actuator distributions,and further outlines the design objectives of the ATDM.

2.1 Dynamics

The AMS studied in this article includes a hexrotor UAV and a multi-DOF manipulator. The manipulator is composed of multiple rigid links connected by joints. The end effector is mounted on the last link of the manipulator (refer to Fig.(1)).

Refer to caption
Figure 2: The coordinate frame of AMS

Note:PDF format, 1-column fitting image

The AMS coordinate system has been established and demonstrated in Fig.2,where the North, East, Down (NED) coordinate system ΣIsubscriptΣ𝐼{\Sigma_{I}}roman_Σ start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT and ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT represent the inertial coordinate system and the body coordinate system built at the center of mass of the UAV, respectively. 𝒑BI𝑹3superscriptsubscript𝒑𝐵𝐼superscript𝑹3{}^{I}\bm{\mathit{p}}_{B}\in\bm{\mathit{R}}^{3}start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT denote the COM of UAV in ΣIsubscriptΣ𝐼{\Sigma_{I}}roman_Σ start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT, and let 𝒑EB𝑹3superscriptsubscript𝒑𝐸𝐵superscript𝑹3{}^{B}\bm{\mathit{p}}_{E}\in\bm{\mathit{R}}^{3}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT represent the end-effector in ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT. The position, velocity, and angular velocity of the end-effector in the ΣIsubscriptΣ𝐼{\Sigma_{I}}roman_Σ start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT can be derived as

𝒑EI=𝒑BI+𝑹BI𝒑EB𝒑˙EI=𝒑˙BISkew(𝑹BI𝒑EB)𝝎BI+𝑹BI𝒑˙EB𝝎EI=𝝎BI+𝑹BI𝑱wqEB𝒒˙m𝒑˙EB=𝑱vqEB𝒒˙msuperscriptsubscript𝒑𝐸𝐼superscriptsubscript𝒑𝐵𝐼superscriptsubscript𝑹𝐵𝐼superscriptsubscript𝒑𝐸𝐵superscriptsubscriptbold-˙𝒑𝐸𝐼superscriptsubscriptbold-˙𝒑𝐵𝐼Skewsuperscriptsubscript𝑹𝐵𝐼superscriptsubscript𝒑𝐸𝐵superscriptsubscript𝝎𝐵𝐼superscriptsubscript𝑹𝐵𝐼superscriptsubscriptbold-˙𝒑𝐸𝐵superscriptsubscript𝝎𝐸𝐼superscriptsubscript𝝎𝐵𝐼superscriptsubscript𝑹𝐵𝐼subscriptsuperscriptsubscript𝑱𝑤𝑞𝐵𝐸subscriptbold-˙𝒒𝑚superscriptsubscriptbold-˙𝒑𝐸𝐵subscriptsuperscriptsubscript𝑱𝑣𝑞𝐵𝐸subscriptbold-˙𝒒𝑚\begin{array}[]{l}{}^{I}\bm{p}_{E}={}^{I}\bm{p}_{B}+{}^{I}\bm{R}_{B}{}^{B}\bm{% p}_{E}\\ {}^{I}\bm{\dot{p}}_{E}={}^{I}\bm{\dot{p}}_{B}-\text{Skew}\left({}^{I}\bm{R}_{B% }{}^{B}\bm{p}_{E}\right){}^{I}\bm{\omega}_{B}+{}^{I}\bm{R}_{B}{}^{B}\bm{\dot{p% }}_{E}\\ {}^{I}\bm{\omega}_{E}={}^{I}\bm{\omega}_{B}+{}^{I}\bm{R}_{B}{}_{E}^{B}\bm{J}_{% wq}\bm{\dot{q}}_{m}\\ {}^{B}\bm{\dot{p}}_{E}={}_{E}^{B}\bm{J}_{vq}\bm{\dot{q}}_{m}\end{array}start_ARRAY start_ROW start_CELL start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT = start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT + start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_p end_ARG start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT = start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_p end_ARG start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT - Skew ( start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT ) start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT + start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_p end_ARG start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT = start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT + start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT start_FLOATSUBSCRIPT italic_E end_FLOATSUBSCRIPT start_POSTSUPERSCRIPT italic_B end_POSTSUPERSCRIPT bold_italic_J start_POSTSUBSCRIPT italic_w italic_q end_POSTSUBSCRIPT overbold_˙ start_ARG bold_italic_q end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_p end_ARG start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT = start_FLOATSUBSCRIPT italic_E end_FLOATSUBSCRIPT start_POSTSUPERSCRIPT italic_B end_POSTSUPERSCRIPT bold_italic_J start_POSTSUBSCRIPT italic_v italic_q end_POSTSUBSCRIPT overbold_˙ start_ARG bold_italic_q end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL end_ROW end_ARRAY (1)

where Skew()Skew\text{Skew}(\cdot)Skew ( ⋅ ) is the anti-symmetric matrix, 𝒒˙msubscript˙𝒒𝑚{\dot{\bm{\mathit{q}}}_{m}}over˙ start_ARG bold_italic_q end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT represents the joint angular velocities of the manipulator, 𝑱wqEBsubscriptsuperscriptsubscript𝑱𝑤𝑞𝐵𝐸{}_{E}^{B}{\bm{\mathit{J}}_{wq}}start_FLOATSUBSCRIPT italic_E end_FLOATSUBSCRIPT start_POSTSUPERSCRIPT italic_B end_POSTSUPERSCRIPT bold_italic_J start_POSTSUBSCRIPT italic_w italic_q end_POSTSUBSCRIPT maps the joint angular velocities of the manipulator to the angular velocity of ΣEsubscriptΣ𝐸{\Sigma_{E}}roman_Σ start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT with respect to ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT, 𝑱vqEBsubscriptsuperscriptsubscript𝑱𝑣𝑞𝐵𝐸{}_{E}^{B}{\bm{\mathit{J}}_{vq}}start_FLOATSUBSCRIPT italic_E end_FLOATSUBSCRIPT start_POSTSUPERSCRIPT italic_B end_POSTSUPERSCRIPT bold_italic_J start_POSTSUBSCRIPT italic_v italic_q end_POSTSUBSCRIPT is the Jacobian matrix relating the linear velocity of ΣEsubscriptΣ𝐸{\Sigma_{E}}roman_Σ start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT with respect to ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT to the manipulator’s joint angular velocities, and 𝑹BISO(3)superscriptsubscript𝑹𝐵𝐼𝑆𝑂3{}^{I}\bm{\mathit{R}}_{B}\in SO(3)start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ∈ italic_S italic_O ( 3 ) is the representation of attitude transformation matrix of ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT in the ΣIsubscriptΣ𝐼{\Sigma_{I}}roman_Σ start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT. When 𝜱=[ϕ,θ,ψ]T𝑹3𝜱superscriptitalic-ϕ𝜃𝜓𝑇superscript𝑹3\bm{\mathit{\Phi}}={[\phi,\theta,\psi]^{T}}\in\bm{\mathit{R}}^{3}bold_italic_Φ = [ italic_ϕ , italic_θ , italic_ψ ] start_POSTSUPERSCRIPT italic_T end_POSTSUPERSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT correspond to the UAV’s pitch, roll, and yaw angles, respectively,it can be derived as

𝑹BI=[CθCψSϕSθCψCϕSψCϕSθCψ+SϕSψCθSψSϕSθSψ+CϕCψCϕSθSψSϕCψSθSϕCθCϕCθ]superscriptsubscript𝑹𝐵𝐼delimited-[]𝐶𝜃𝐶𝜓𝑆italic-ϕ𝑆𝜃𝐶𝜓𝐶italic-ϕ𝑆𝜓𝐶italic-ϕ𝑆𝜃𝐶𝜓𝑆italic-ϕ𝑆𝜓missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpression𝐶𝜃𝑆𝜓𝑆italic-ϕ𝑆𝜃𝑆𝜓𝐶italic-ϕ𝐶𝜓𝐶italic-ϕ𝑆𝜃𝑆𝜓𝑆italic-ϕ𝐶𝜓missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpression𝑆𝜃𝑆italic-ϕ𝐶𝜃𝐶italic-ϕ𝐶𝜃missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpression{}^{I}{\bm{R}_{B}}=\left[{\begin{array}[]{*{20}{c}}{C\theta C\psi}&{S\phi S% \theta C\psi-C\phi S\psi}&{C\phi S\theta C\psi+S\phi S\psi}\\ {C\theta S\psi}&{S\phi S\theta S\psi+C\phi C\psi}&{C\phi S\theta S\psi-S\phi C% \psi}\\ {-S\theta}&{S\phi C\theta}&{C\phi C\theta}\end{array}}\right]start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT = [ start_ARRAY start_ROW start_CELL italic_C italic_θ italic_C italic_ψ end_CELL start_CELL italic_S italic_ϕ italic_S italic_θ italic_C italic_ψ - italic_C italic_ϕ italic_S italic_ψ end_CELL start_CELL italic_C italic_ϕ italic_S italic_θ italic_C italic_ψ + italic_S italic_ϕ italic_S italic_ψ end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW start_ROW start_CELL italic_C italic_θ italic_S italic_ψ end_CELL start_CELL italic_S italic_ϕ italic_S italic_θ italic_S italic_ψ + italic_C italic_ϕ italic_C italic_ψ end_CELL start_CELL italic_C italic_ϕ italic_S italic_θ italic_S italic_ψ - italic_S italic_ϕ italic_C italic_ψ end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW start_ROW start_CELL - italic_S italic_θ end_CELL start_CELL italic_S italic_ϕ italic_C italic_θ end_CELL start_CELL italic_C italic_ϕ italic_C italic_θ end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY ] (2)

where, C()𝐶C(\cdot)italic_C ( ⋅ ) denotes cos()\cos(\cdot)roman_cos ( ⋅ ), and S()𝑆S(\cdot)italic_S ( ⋅ ) denotes sin()\sin(\cdot)roman_sin ( ⋅ ).

Based on Newton’s Second Law and Euler’s equations of motion, the dynamic equation of the AMS can be formulated as

𝑷˙BI=superscriptsubscriptbold-˙𝑷𝐵𝐼absent\displaystyle{}^{I}\bm{\dot{P}}_{B}=start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_P end_ARG start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT = 𝒗BI,superscriptsubscript𝒗𝐵𝐼\displaystyle{}^{I}\bm{v}_{B},start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_v start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ,
𝒗˙BI=superscriptsubscriptbold-˙𝒗𝐵𝐼absent\displaystyle{}^{I}\bm{\dot{v}}_{B}=start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT = 𝒈𝒇I𝒇disImUAV+mMAN,𝒈superscript𝒇𝐼superscriptsubscript𝒇𝑑𝑖𝑠𝐼subscript𝑚𝑈𝐴𝑉subscript𝑚𝑀𝐴𝑁\displaystyle\bm{g}-\frac{{{}^{I}\bm{f}-{}^{I}\bm{f}_{dis}}}{{m_{UAV}+m_{MAN}}},bold_italic_g - divide start_ARG start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_f - start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_f start_POSTSUBSCRIPT italic_d italic_i italic_s end_POSTSUBSCRIPT end_ARG start_ARG italic_m start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT + italic_m start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT end_ARG ,
𝑹˙BI=superscriptsubscriptbold-˙𝑹𝐵𝐼absent\displaystyle{}^{I}\bm{\dot{R}}_{B}=start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_R end_ARG start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT = 𝑹BISkew(𝝎bB)=Skew(𝝎bI)𝑹BI,superscriptsubscript𝑹𝐵𝐼Skewsuperscriptsubscript𝝎𝑏𝐵Skewsuperscriptsubscript𝝎𝑏𝐼superscriptsubscript𝑹𝐵𝐼\displaystyle{}^{I}\bm{R}_{B}\cdot\text{Skew}({}^{B}\bm{\omega}_{b})=\text{% Skew}({}^{I}\bm{\omega}_{b})\cdot{}^{I}\bm{R}_{B},start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ⋅ Skew ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT ) = Skew ( start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT ) ⋅ start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ,
𝝎˙bB=superscriptsubscriptbold-˙𝝎𝑏𝐵absent\displaystyle{}^{B}\bm{\dot{\omega}}_{b}=start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_ω end_ARG start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT = 𝝉B𝝎bB×((𝑰UAVB+𝑰MANB)𝝎bB)+𝝉disB(𝑰UAVB+𝑰MANB)superscript𝝉𝐵superscriptsubscript𝝎𝑏𝐵superscriptsubscript𝑰𝑈𝐴𝑉𝐵superscriptsubscript𝑰𝑀𝐴𝑁𝐵superscriptsubscript𝝎𝑏𝐵superscriptsubscript𝝉𝑑𝑖𝑠𝐵superscriptsubscript𝑰𝑈𝐴𝑉𝐵superscriptsubscript𝑰𝑀𝐴𝑁𝐵\displaystyle\frac{{}^{B}\bm{\tau}-{}^{B}\bm{\omega}_{b}\times(({}^{B}\bm{I}_{% UAV}+{}^{B}\bm{I}_{MAN}){}^{B}\bm{\omega}_{b})+{}^{B}\bm{\tau}_{dis}}{({}^{B}% \bm{I}_{UAV}+{}^{B}\bm{I}_{MAN})}divide start_ARG start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_τ - start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × ( ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT + start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT ) start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT ) + start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_τ start_POSTSUBSCRIPT italic_d italic_i italic_s end_POSTSUBSCRIPT end_ARG start_ARG ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT + start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT ) end_ARG (3)

where, 𝒗BI𝑹3superscriptsubscript𝒗𝐵𝐼superscript𝑹3{}^{I}{\bm{\mathit{v}}_{B}}\in{\bm{\mathit{R}}}^{3}start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_v start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT represents the velocity vector of the AMS in ΣIsubscriptΣ𝐼{\Sigma_{I}}roman_Σ start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT, 𝒈𝒈\bm{\mathit{g}}bold_italic_g is the gravity vector, 𝒇I=𝑹BI(0,0,f)Tsuperscript𝒇𝐼superscriptsubscript𝑹𝐵𝐼superscript00𝑓𝑇{}^{I}\bm{\mathit{f}}={}^{I}\bm{\mathit{R}}_{B}(0,0,f)^{T}start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_f = start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ( 0 , 0 , italic_f ) start_POSTSUPERSCRIPT italic_T end_POSTSUPERSCRIPT signifies the lift generated by the UAV’s propellers, mUAVsubscript𝑚𝑈𝐴𝑉m_{UAV}italic_m start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT and mMANsubscript𝑚𝑀𝐴𝑁m_{MAN}italic_m start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT represent the masses of the UAV and the manipulator respectively, 𝑰UAVBsuperscriptsubscript𝑰𝑈𝐴𝑉𝐵{}^{B}{\bm{\mathit{I}}_{UAV}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT and 𝑰MANBsuperscriptsubscript𝑰𝑀𝐴𝑁𝐵{}^{B}{\bm{\mathit{I}}_{MAN}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT are the inertia tensor matrices of the UAV and the manipulator arm in ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT respectively, 𝝎bBsuperscriptsubscript𝝎𝑏𝐵{}^{B}{\bm{\mathit{\omega}}_{b}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT denotes the UAV’s angular velocity in ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT , 𝝉Bsuperscript𝝉𝐵{}^{B}\bm{\mathit{\tau}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_τ describes the expression of the torque generated by the UAV’s propellers in ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT, 𝒇disI𝑹3superscriptsubscript𝒇𝑑𝑖𝑠𝐼superscript𝑹3{}^{I}{\bm{\mathit{f}}_{dis}}\in{\bm{\mathit{R}}}^{3}start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_f start_POSTSUBSCRIPT italic_d italic_i italic_s end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT and 𝝉disB𝑹3superscriptsubscript𝝉𝑑𝑖𝑠𝐵superscript𝑹3{}^{B}{\bm{\mathit{\tau}}_{dis}}\in{\bm{\mathit{R}}}^{3}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_τ start_POSTSUBSCRIPT italic_d italic_i italic_s end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT represent the coupling disturbance force and torque exerted on the UAV by the motion of the manipulator.

2.2 Coupling Disturbance

The coupling disturbance model has been precisely modeled by Li et al. [23]. Considering that understanding the aforementioned variables is crucial for a complete representation of the system’s dynamics, this paper extends that model to analyze the effect of actuator mass distribution on the coupling disturbance. The details are as follows:

𝑭dissubscript𝑭dis\displaystyle\bm{F}_{\text{dis}}bold_italic_F start_POSTSUBSCRIPT dis end_POSTSUBSCRIPT =(mUAV+mMAN)𝑹BI(𝝎bB×(𝝎bB×𝒓ocB)\displaystyle=-(m_{UAV}+m_{MAN}){}^{I}\bm{R}_{B}\Bigl{(}{}^{B}\bm{\omega}_{b}% \times\left({}^{B}\bm{\omega}_{b}\times{}^{B}\bm{r}_{oc}\right)= - ( italic_m start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT + italic_m start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT ) start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT )
+𝝎˙bB×𝒓ocB+2𝝎bB×𝒓˙ocB),\displaystyle\quad+{}^{B}\bm{\dot{\omega}}_{b}\times{}^{B}\bm{r}_{oc}+2{}^{B}% \bm{\omega}_{b}\times{}^{B}\bm{\dot{r}}_{oc}\Bigl{)},+ start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_ω end_ARG start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT + 2 start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT ) ,
𝝉disBsuperscriptsubscript𝝉𝑑𝑖𝑠𝐵\displaystyle{}^{B}\bm{\tau}_{dis}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_τ start_POSTSUBSCRIPT italic_d italic_i italic_s end_POSTSUBSCRIPT =(mUAV+mMAN)(𝒓ocB×𝑹IB(𝒈𝒆3𝒗˙b)+𝒓¨ocB×𝑹BI𝒑˙BI)\displaystyle=(m_{UAV}+m_{MAN})\Bigl{(}{}^{B}\bm{r}_{oc}\times{}^{B}\bm{R}_{I}% (\bm{g}\bm{e}_{3}-\bm{\dot{v}}_{b})+{}^{B}\bm{\ddot{r}}_{oc}\times{}^{I}\bm{R}% _{B}{}^{I}\bm{\dot{p}}_{B}\Bigl{)}= ( italic_m start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT + italic_m start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT ) ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT ( bold_italic_g bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT - overbold_˙ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT ) + start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_¨ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_p end_ARG start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT )
𝑰UAVB𝝎˙bB𝝎bB×(𝑰MANB𝝎bB)𝑰˙MANB𝝎bBsuperscriptsubscript𝑰𝑈𝐴𝑉𝐵superscriptsubscriptbold-˙𝝎𝑏𝐵superscriptsubscript𝝎𝑏𝐵superscriptsubscript𝑰𝑀𝐴𝑁𝐵superscriptsubscript𝝎𝑏𝐵superscriptsubscriptbold-˙𝑰𝑀𝐴𝑁𝐵superscriptsubscript𝝎𝑏𝐵\displaystyle\quad-{}^{B}\bm{I}_{UAV}{}^{B}\bm{\dot{\omega}}_{b}-{}^{B}\bm{% \omega}_{b}\times\left({}^{B}\bm{I}_{MAN}{}^{B}\bm{\omega}_{b}\right)-{}^{B}% \bm{\dot{I}}_{MAN}{}^{B}\bm{\omega}_{b}- start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_ω end_ARG start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT - start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT ) - start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_I end_ARG start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT
(mUAV+mMAN)2mMAN(𝒓ocB×𝒓¨ocB+𝝎bB×(𝒓ocB×𝒓˙ocB)\displaystyle\quad-\frac{(m_{UAV}+m_{MAN})^{2}}{m_{MAN}}\Bigl{(}{}^{B}\bm{r}_{% oc}\times{}^{B}\bm{\ddot{r}}_{oc}+{}^{B}\bm{\omega}_{b}\times\left({}^{B}\bm{r% }_{oc}\times{}^{B}\bm{\dot{r}}_{oc}\right)- divide start_ARG ( italic_m start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT + italic_m start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_m start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT end_ARG ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_¨ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT + start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT )
+𝑹BI𝒑˙BI×𝒓˙ocB+𝑹BI𝒑˙BI×(𝝎bB×𝒓˙ocB))\displaystyle\quad+{}^{I}\bm{R}_{B}{}^{I}\bm{\dot{p}}_{B}\times{}^{B}\bm{\dot{% r}}_{oc}+{}^{I}\bm{R}_{B}{}^{I}\bm{\dot{p}}_{B}\times({}^{B}\bm{\omega}_{b}% \times{}^{B}\bm{\dot{r}}_{oc})\Bigl{)}+ start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_p end_ARG start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT + start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_I end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_p end_ARG start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT × ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_ω start_POSTSUBSCRIPT italic_b end_POSTSUBSCRIPT × start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT overbold_˙ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT ) ) (4)

where

𝒓ocB=1mUAV+mMANi=1n(mLi𝒑cLiB+mMi𝒑cMiB)superscriptsubscript𝒓𝑜𝑐𝐵1subscript𝑚𝑈𝐴𝑉subscript𝑚𝑀𝐴𝑁superscriptsubscript𝑖1𝑛subscript𝑚𝐿𝑖superscriptsubscript𝒑𝑐𝐿𝑖𝐵subscript𝑚𝑀𝑖superscriptsubscript𝒑𝑐𝑀𝑖𝐵{}^{B}\bm{r}_{oc}=\frac{1}{{m_{UAV}+m_{MAN}}}\sum\limits_{i=1}^{n}{(m_{Li}{}^{% B}\bm{p}_{cLi}+m_{Mi}{}^{B}\bm{p}_{cMi})}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT = divide start_ARG 1 end_ARG start_ARG italic_m start_POSTSUBSCRIPT italic_U italic_A italic_V end_POSTSUBSCRIPT + italic_m start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT end_ARG ∑ start_POSTSUBSCRIPT italic_i = 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_n end_POSTSUPERSCRIPT ( italic_m start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_L italic_i end_POSTSUBSCRIPT + italic_m start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_M italic_i end_POSTSUBSCRIPT ) (5a)
𝑰MANBsuperscriptsubscript𝑰𝑀𝐴𝑁𝐵\displaystyle{}^{B}\bm{I}_{MAN}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT =i=1n(𝑹LiB𝑰LiΣLi𝑹Li1B+𝑹MiB𝑰MiΣMi𝑹Mi1B\displaystyle=\sum_{i=1}^{n}\bigg{(}{}^{B}\bm{R}_{Li}\bm{I}_{Li}^{\Sigma_{Li}}% {}^{B}\bm{R}_{Li}^{-1}+{}^{B}\bm{R}_{Mi}\bm{I}_{Mi}^{\Sigma_{Mi}}{}^{B}\bm{R}_% {Mi}^{-1}= ∑ start_POSTSUBSCRIPT italic_i = 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_n end_POSTSUPERSCRIPT ( start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT roman_Σ start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT end_POSTSUPERSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT + start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT roman_Σ start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT end_POSTSUPERSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT
+mLi(𝒑cLiB2𝑰3×3𝒑cLiB𝒑cLiTB)subscript𝑚𝐿𝑖superscriptnormsuperscriptsubscript𝒑𝑐𝐿𝑖𝐵2subscript𝑰33superscriptsubscript𝒑𝑐𝐿𝑖𝐵superscriptsuperscriptsubscript𝒑𝑐𝐿𝑖𝑇𝐵\displaystyle\quad+m_{Li}\left(\left\|{}^{B}\bm{p}_{cLi}\right\|^{2}\bm{I}_{3% \times 3}-{}^{B}\bm{p}_{cLi}{}^{B}\bm{p}_{cLi}^{T}\right)+ italic_m start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT ( ∥ start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_L italic_i end_POSTSUBSCRIPT ∥ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT 3 × 3 end_POSTSUBSCRIPT - start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_L italic_i end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_L italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_T end_POSTSUPERSCRIPT )
+mMi(𝒑cMiB2𝑰3×3𝒑cMiB𝒑cMiTB))\displaystyle\quad+m_{Mi}\left(\left\|{}^{B}\bm{p}_{cMi}\right\|^{2}\bm{I}_{3% \times 3}-{}^{B}\bm{p}_{cMi}{}^{B}\bm{p}_{cMi}^{T}\right)\bigg{)}+ italic_m start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT ( ∥ start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_M italic_i end_POSTSUBSCRIPT ∥ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT 3 × 3 end_POSTSUBSCRIPT - start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_M italic_i end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_M italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_T end_POSTSUPERSCRIPT ) ) (5b)

The symbol 𝒓ocB𝑹3superscriptsubscript𝒓𝑜𝑐𝐵superscript𝑹3{}^{B}{\bm{\mathit{r}}_{oc}}\in{\bm{\mathit{R}}}^{3}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT represents the COM of the AMS in the ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT coordinate system. mLisubscript𝑚𝐿𝑖m_{Li}italic_m start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT,mMisubscript𝑚𝑀𝑖m_{Mi}italic_m start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT,𝒑cLiB𝑹3superscriptsubscript𝒑𝑐𝐿𝑖𝐵superscript𝑹3{}^{B}\bm{\mathit{p}}_{cLi}\in{\bm{\mathit{R}}}^{3}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_L italic_i end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT, and 𝒑cMiB𝑹3superscriptsubscript𝒑𝑐𝑀𝑖𝐵superscript𝑹3{}^{B}\bm{\mathit{p}}_{cMi}\in{\bm{\mathit{R}}}^{3}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_M italic_i end_POSTSUBSCRIPT ∈ bold_italic_R start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT represent the mass and the respective center-of-mass locations of the i-th𝑖-thi{\text{-th}}italic_i -th link structure (excluding the actuator) and the i-th𝑖-thi{\text{-th}}italic_i -th joint actuator in the ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT coordinate system. 𝒓˙ocBsuperscriptsubscript˙𝒓𝑜𝑐𝐵{}^{B}{\dot{\bm{\mathit{r}}}_{oc}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT over˙ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT and 𝒓¨ocBsuperscriptsubscript¨𝒓𝑜𝑐𝐵{}^{B}{\ddot{\bm{\mathit{r}}}_{oc}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT over¨ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT are its first and second derivatives, respectively. In the expression of 𝑰MANBsuperscriptsubscript𝑰𝑀𝐴𝑁𝐵{}^{B}{\bm{\mathit{I}}_{MAN}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT, 𝑹LiBsuperscriptsubscript𝑹𝐿𝑖𝐵{}^{B}{\bm{\mathit{R}}_{Li}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT, 𝑹MiBsuperscriptsubscript𝑹𝑀𝑖𝐵{}^{B}{\bm{\mathit{R}}_{Mi}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_R start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT, 𝒑cLiBsuperscriptsubscript𝒑𝑐𝐿𝑖𝐵{}^{B}{\bm{\mathit{p}}_{cLi}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_L italic_i end_POSTSUBSCRIPT, and 𝒑cMiBsuperscriptsubscript𝒑𝑐𝑀𝑖𝐵{}^{B}{\bm{\mathit{p}}_{cMi}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_M italic_i end_POSTSUBSCRIPT represent the configurations and coordinate system origins of the i-th𝑖-thi{\text{-th}}italic_i -th link structure (excluding the actuator) and the i-th𝑖-thi{\text{-th}}italic_i -th joint actuator in ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT, established at their respective centers of mass. 𝑰LiΣLisuperscriptsubscript𝑰𝐿𝑖subscriptΣ𝐿𝑖\bm{\mathit{I}}_{Li}^{{\Sigma_{Li}}}bold_italic_I start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT roman_Σ start_POSTSUBSCRIPT italic_L italic_i end_POSTSUBSCRIPT end_POSTSUPERSCRIPT and 𝑰MiΣMisuperscriptsubscript𝑰𝑀𝑖subscriptΣ𝑀𝑖\bm{\mathit{I}}_{Mi}^{{\Sigma_{Mi}}}bold_italic_I start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT start_POSTSUPERSCRIPT roman_Σ start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT end_POSTSUPERSCRIPT represent the inertia tensor matrices of the i-th𝑖-thi{\text{-th}}italic_i -th link structure and the i-th𝑖-thi{\text{-th}}italic_i -th joint actuator in their respective center-of-mass coordinate systems. 𝑰˙MANBsuperscriptsubscript˙𝑰𝑀𝐴𝑁𝐵{}^{B}{\dot{\bm{\mathit{I}}}_{MAN}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT over˙ start_ARG bold_italic_I end_ARG start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT is the derivative of 𝑰MANBsuperscriptsubscript𝑰𝑀𝐴𝑁𝐵{}^{B}{\bm{\mathit{I}}_{MAN}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT.

The aforementioned elements model each link and actuator in the manipulator separately, allowing for better calculations of the impact of actuator weight distribution on coupling disturbance.

Movement of the manipulator leads to changes 𝒓ocBsuperscriptsubscript𝒓𝑜𝑐𝐵{}^{B}{\bm{\mathit{r}}_{oc}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT and 𝑰MANBsuperscriptsubscript𝑰𝑀𝐴𝑁𝐵{}^{B}{\bm{\mathit{I}}_{MAN}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT of the AMS, along with associated variables. The faster the movement of the arm, the larger these variables become, thereby increasing the resultant coupling disturbance.

To places the actuators of the manipulator on a base that is fixed to the UAV. In this case, terms related to the actuators in the derivatives of 𝒓ocBsuperscriptsubscript𝒓𝑜𝑐𝐵{}^{B}{\bm{\mathit{r}}_{oc}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_r start_POSTSUBSCRIPT italic_o italic_c end_POSTSUBSCRIPT and 𝑰MANBsuperscriptsubscript𝑰𝑀𝐴𝑁𝐵{}^{B}{\bm{\mathit{I}}_{MAN}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT become zero, significantly reducing the coupling disturbance when the manipulator is in motion. Conversely, traditional manipulator mounted on flying platforms have heavier actuators that are typically distributed around the joints. This makes mMisubscript𝑚𝑀𝑖m_{Mi}italic_m start_POSTSUBSCRIPT italic_M italic_i end_POSTSUBSCRIPT, 𝒑cMiBsuperscriptsubscript𝒑𝑐𝑀𝑖𝐵{}^{B}\bm{\mathit{p}}_{cMi}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_p start_POSTSUBSCRIPT italic_c italic_M italic_i end_POSTSUBSCRIPT, and 𝑰MANBsuperscriptsubscript𝑰𝑀𝐴𝑁𝐵{}^{B}{\bm{\mathit{I}}_{MAN}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_I start_POSTSUBSCRIPT italic_M italic_A italic_N end_POSTSUBSCRIPT not only nonzero but also dominant terms in the Equ.(5a)and (5b), significantly increasing their coupling disturbance.

2.3 Design Objectives

The ATDM(refer to Fig.(1)) designed in this paper aims to address several challenges in existing manipulators of AMS, specifically when it comes to tasks involving aerial manipulation. We focus on two primary issues commonly encountered in existing AMS:

  • 1.

    Coupling Disturbance: Traditional AMS with serial manipulators often encounter large unwanted coupling disturbance to the UAV, due to the placement of actuators and the overall COM. As an under-actuated platform, the lift provided by each blade of the UAV is relatively limited, and the control authority is easily saturated.

    This problem is mitigated by introducing a novel tendon-driven manipulator, which remotely drives joint rotation via actuators mounted at the UAV’s base. This design significantly reduces coupling disturbance and is further optimized through finite element analysis to achieve a lightweight construction.

  • 2.

    Payload Capacity: The payload capacity of AMS equipped with conventional manipulator systems is limited due to the load capacity of multi-rotor UAVs, resulting in restricted joint stiffness and payload capabilities. These limitations make it difficult for the arms to be applied in scenarios requiring the handling of large loads. While industrial manipulators address payload issues, they compromise energy efficiency due to their higher weight-to-payload ratio.

    We address this issue by employing a TAT mechanism to increase the overall stiffness and output of the manipulator.

3 Mechanical Design of the Manipulator

The COM of the serial manipulator often equiped by AMS is often far away from the COM of the drone. This setup will result in increased coupling disturbance forces and torques during arm movement. ATDM positions the electromechanical servo system of the manipulator on the base, effectively reducing the coupling disturbance during movement. The structure was further optimized through finite element analysis to achieve a lightweight, low-inertia manipulator that is both compatible and strong, thereby enhancing the operational capabilities of the AMS.

This section presents the structural design of the ATDM system’s manipulator, accompanied by the configuration of the tendons, the motion analysis,and the distribution of actuators. In addition, finite element analysis was conducted to achieve weight reduction.

3.1 Tension amplification tendon mechanism

Traditional ”cable-pulley” based cable-driven manipulators, exemplified by the Da Vinci surgical robots [33, 34, 35], utilize a single steel cable as the tendon. While these designs offer benefits like vibration damping and lightweight construction, they suffer from low stiffness and limited torque output, making them unsuitable for heavy loads. Sava 222Sava. URL: https://www.savacable.com. Accessed on: [2023/10/31]. suggests that the winding diameter of the steel cable (i.e., the radius of the capstan or pulley) should be more than 18 times the cable’s outer diameter.Our practical tests revealed that using thicker steel cables, coupled with larger pulleys, significantly increases the manipulator’s volume and the pulley’s weight, although the system gains greater stiffness and breaking strength. For cable-driven manipulators that employ numerous pulleys, a trade-off between these factors is evidently needed.

ATDM leverages a TAT mechanism at each joint of the manipulator, as shown in Fig.3. ATDM uses steel cables with diameter of 0.6mm, with a 7197197\cdot 197 ⋅ 19 structure and an external nylon coating, at every joint. Because of the small cross-sectional area of the selected cable and its high flexibility, the cable is guided through multiple grooved pulleys at both the driving and passive ends of each joint of the arm, winding repeatedly,this makes up the TAT structure. TAT structure increases the arm’s stiffness and load-bearing capability. The flexible cables, winding back and forth, form a TAT system that acts as a reducer at the joints, enhancing joint stiffness, improving the precision and dynamic performance of the manipulator.

Refer to caption
Figure 3: Tension-amplification tendon

Note:PDF format, 1-column fitting image

Based on the TAT mechanism, when the motor at the fixed end inputs a torque of τmotorsubscript𝜏𝑚𝑜𝑡𝑜𝑟\tau_{motor}italic_τ start_POSTSUBSCRIPT italic_m italic_o italic_t italic_o italic_r end_POSTSUBSCRIPT, the total output pulling force of the tendon is

Ttendon=Nτmotor/Rcapstansubscript𝑇𝑡𝑒𝑛𝑑𝑜𝑛𝑁subscript𝜏𝑚𝑜𝑡𝑜𝑟subscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛T_{tendon}=N\cdot\tau_{motor}/R_{capstan}italic_T start_POSTSUBSCRIPT italic_t italic_e italic_n italic_d italic_o italic_n end_POSTSUBSCRIPT = italic_N ⋅ italic_τ start_POSTSUBSCRIPT italic_m italic_o italic_t italic_o italic_r end_POSTSUBSCRIPT / italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT (6)

where,Rcapstansubscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛R_{capstan}italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT is the radius of the cablecapstan, and N is the number of times the cableis wound around the TAT mechanism, which is twice the number of pulley groups at the moving end.

Based on the virtual works principle, the reduction ratio is N𝑁Nitalic_N, and the tendon stiffness Etendonsubscript𝐸𝑡𝑒𝑛𝑑𝑜𝑛E_{tendon}italic_E start_POSTSUBSCRIPT italic_t italic_e italic_n italic_d italic_o italic_n end_POSTSUBSCRIPT can be derived as

Etendonsubscript𝐸𝑡𝑒𝑛𝑑𝑜𝑛\displaystyle E_{tendon}italic_E start_POSTSUBSCRIPT italic_t italic_e italic_n italic_d italic_o italic_n end_POSTSUBSCRIPT =Ttendon/δxtendonabsentsubscript𝑇𝑡𝑒𝑛𝑑𝑜𝑛𝛿subscript𝑥𝑡𝑒𝑛𝑑𝑜𝑛\displaystyle=T_{tendon}/\delta x_{tendon}= italic_T start_POSTSUBSCRIPT italic_t italic_e italic_n italic_d italic_o italic_n end_POSTSUBSCRIPT / italic_δ italic_x start_POSTSUBSCRIPT italic_t italic_e italic_n italic_d italic_o italic_n end_POSTSUBSCRIPT
=NTcable/(δxcable/N)absent𝑁subscript𝑇𝑐𝑎𝑏𝑙𝑒𝛿subscript𝑥𝑐𝑎𝑏𝑙𝑒𝑁\displaystyle=N\cdot T_{cable}/(\delta x_{cable}/N)= italic_N ⋅ italic_T start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT / ( italic_δ italic_x start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT / italic_N )
=N2Ecableabsentsuperscript𝑁2subscript𝐸𝑐𝑎𝑏𝑙𝑒\displaystyle=N^{2}E_{cable}= italic_N start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_E start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT (7)

where δxtendon𝛿subscript𝑥𝑡𝑒𝑛𝑑𝑜𝑛\delta x_{tendon}italic_δ italic_x start_POSTSUBSCRIPT italic_t italic_e italic_n italic_d italic_o italic_n end_POSTSUBSCRIPT is the deformation of the tendon when the output force is Ttendonsubscript𝑇𝑡𝑒𝑛𝑑𝑜𝑛T_{tendon}italic_T start_POSTSUBSCRIPT italic_t italic_e italic_n italic_d italic_o italic_n end_POSTSUBSCRIPT, Tcablesubscript𝑇𝑐𝑎𝑏𝑙𝑒T_{cable}italic_T start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT is the tension of the steel cable at this time, and xcablesubscript𝑥𝑐𝑎𝑏𝑙𝑒x_{cable}italic_x start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT is the deformation of the entire cable. Based on Eq.(7) , the stiffness of the tendon is N2superscript𝑁2N^{2}italic_N start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT times that of a single cable.

3.2 Design of Anthropomorphic Elbow Joint

3.2.1 Mechanical Design

Drawing inspiration from human anatomy [41], the human elbow is a 1-DOF rotational joint primarily controlled by the antagonistic action of the biceps brachii and triceps brachii. The contraction of one muscle group results in the elongation of the other, facilitating precise elbow movement.

Building on the TAT concept from section 3.1, we emulate this antagonistic mechanism for the robotic elbow joint using a pair of opposing TATs. As illustrated in Fig.(4), when the joint rotates counterclockwise, the upper tendon acts as the agonist, with the lower tendon as the antagonist, and vice versa for clockwise movement. For smooth, dead-zone-free motion, these tendons must synchronize in real-time and remain taut. While separate actuators could drive them, it might add to the manipulator’s weight and inertia.

To address this issue, we adopted an innovative cable drive scheme, as sourced from the literature [28]. In our mechanical design, particular attention was given to the mechanism of motion translation between the forearm and upper arm. Specifically, we engineered a unique set of circular contact surfaces that directly translate the movements of the forearm and upper arm into pure rolling motion between these circular surfaces.

The key to this design lies in its specialized geometric structure. We meticulously designed the radii and curvatures of the contact surfaces to ensure that as the forearm and upper arm rotate or bend, the interaction between these surfaces results in a slip-free pure rolling motion. The advantage of this pure rolling mechanism is that it significantly reduces energy loss due to friction and sliding, thereby enhancing the mechanical efficiency of the entire system.

Furthermore, this design also takes into account the length variation of the agonist and antagonist tendons. In traditional tendon-driven systems, tendons undergo elongation and shortening during movement, leading to energy loss and reduced efficiency. However, in our design, as the motion of the forearm and upper arm is translated into pure rolling between circular surfaces, this ensures that the total length of the agonist and antagonist tendons (the tendons driving and controlling limb movement) remains constant throughout the range of motion. This constancy in length not only reduces tendon wear but also enhances the system’s response speed and energy transmission efficiency.

Refer to caption
Figure 4: Elbow Joint Utilizing TAT.(a)Initial state.(b)Bending state

Note:PDF format, 1-column fitting image

To achieve a pure rolling motion in the elbow joint, a mechanism akin to the joint capsule is essential for stability and to prevent slippage. While various mechanisms like antiparallelograms and gear meshing-based transmissions exist, this study opts for cables, mimicking ligaments’ role in the joint capsule, especially considering its aerial application and the need for impact resistance.

Our design employs two intersecting steel cables to ensure pure rolling, prevent slippage, and bolster the elbow joint’s torsional rigidity. The fixed pulleys from the antagonistic TAT structures are symmetrically placed relative to the rolling surface’s curvature center of the proximal link. Similarly, the moving pulleys are symmetrically positioned concerning the distal link’s rolling surface. This symmetrical arrangement facilitates uniform tendon motion, allowing both cable sections to wind on a single capstan driven by one actuator, as shown in Fig. (4). Such a design effectively reduces the AMS’s coupling disturbance.

3.2.2 Kinematic Analysis of Elbow Joint

This section analyzes the movement of the elbow joint. Without loss of generality, we consider the situation where the tendon on the top acts as the agonist .

Refer to caption
Figure 5: Elbow joint design detail and analysis. (a)Detail(initial state).
(b)Detail(Bending state).(c)Schematic diagram(initial state).(d)Schematic diagram(Bending state)

Note:PDF format, 1-column fitting image

The design details and simplified model of the elbow joint is shown in Fig.(5). As it is a pure rolling joint, it can be decomposed into two motion-coupled serial rotational pairs for analysis.

Coordinate systems are established at the center of the fixed end and the center of the moving end of the elbow joint, respectively, labeled as Σep{OepXepYepZep}subscriptΣ𝑒𝑝subscript𝑂𝑒𝑝subscript𝑋𝑒𝑝subscript𝑌𝑒𝑝subscript𝑍𝑒𝑝{\Sigma_{ep}}\{{O_{ep}}-{X_{ep}}{Y_{ep}}{Z_{ep}}\}roman_Σ start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT { italic_O start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT - italic_X start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT italic_Y start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT italic_Z start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT } and Σed{OedXedYedZed}subscriptΣ𝑒𝑑subscript𝑂𝑒𝑑subscript𝑋𝑒𝑑subscript𝑌𝑒𝑑subscript𝑍𝑒𝑑{\Sigma_{ed}}\{{O_{ed}}-{X_{ed}}{Y_{ed}}{Z_{ed}}\}roman_Σ start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT { italic_O start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT - italic_X start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT italic_Y start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT italic_Z start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT }. Due to the coupling effects inherent in the joint mechanism, intermediate coordinate systems ΣeppsuperscriptsubscriptΣ𝑒𝑝𝑝\Sigma_{ep}^{p}roman_Σ start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_p end_POSTSUPERSCRIPT and ΣedpsuperscriptsubscriptΣ𝑒𝑑𝑝\Sigma_{ed}^{p}roman_Σ start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_p end_POSTSUPERSCRIPT are introduced to facilitate the description of the homogeneous transformations between ΣepsubscriptΣ𝑒𝑝{\Sigma_{ep}}roman_Σ start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT and ΣedsubscriptΣ𝑒𝑑{\Sigma_{ed}}roman_Σ start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT,where the relationship of transformations is epeppedpepsubscript𝑒𝑝superscriptsubscript𝑒𝑝𝑝superscriptsubscript𝑒𝑑𝑝subscript𝑒𝑝{\sum_{ep}}\to\sum_{ep}^{p}\to\sum_{ed}^{p}\to{\sum_{ep}}∑ start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT → ∑ start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_p end_POSTSUPERSCRIPT → ∑ start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_p end_POSTSUPERSCRIPT → ∑ start_POSTSUBSCRIPT italic_e italic_p end_POSTSUBSCRIPT. For easier identification and readability, colored bounding boxes have been added around the frames of these intermediate coordinate systems in Fig.5(d). The colors correspond to the axes of their respective coordinate systems.

Considering that the agonist contracts (colored blue, label antagonistic as purple in parallel), and the angle of the elbow joint rotation is θ𝜃\thetaitalic_θ, with a curvature radius of R𝑅Ritalic_R and the distance between the agonist and antagonist muscles as desubscript𝑑𝑒d_{e}italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT. Refer to geometric relationships in in Fig.5(c) and Fig.5(d) can derive the lengths of the active tendon and the antagonist tendon at this time as

Lago=Ne(2Rdesin(θ/2));Lant=Ne(2R+desin(θ/2))formulae-sequencesubscript𝐿𝑎𝑔𝑜subscript𝑁𝑒2𝑅subscript𝑑𝑒𝜃2subscript𝐿𝑎𝑛𝑡subscript𝑁𝑒2𝑅subscript𝑑𝑒𝜃2L_{ago}=N_{e}(2R-d_{e}\sin(\theta/2));L_{ant}=N_{e}(2R+d_{e}\sin(\theta/2))italic_L start_POSTSUBSCRIPT italic_a italic_g italic_o end_POSTSUBSCRIPT = italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT ( 2 italic_R - italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT roman_sin ( italic_θ / 2 ) ) ; italic_L start_POSTSUBSCRIPT italic_a italic_n italic_t end_POSTSUBSCRIPT = italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT ( 2 italic_R + italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT roman_sin ( italic_θ / 2 ) ) (8)

where Nesubscript𝑁𝑒N_{e}italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT is the number of windings of the tendon of the elbow joint tension magnifier, the changes in length of the active tendon and the antagonist tendon are respectively

ΔLago=Nedesin(θ/2);ΔLant=Nedesin(θ/2)formulae-sequenceΔsubscript𝐿𝑎𝑔𝑜subscript𝑁𝑒subscript𝑑𝑒𝜃2Δsubscript𝐿𝑎𝑛𝑡subscript𝑁𝑒subscript𝑑𝑒𝜃2\Delta L_{ago}=-N_{e}d_{e}\sin(\theta/2);\Delta L_{ant}=N_{e}d_{e}\sin(\theta/2)roman_Δ italic_L start_POSTSUBSCRIPT italic_a italic_g italic_o end_POSTSUBSCRIPT = - italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT roman_sin ( italic_θ / 2 ) ; roman_Δ italic_L start_POSTSUBSCRIPT italic_a italic_n italic_t end_POSTSUBSCRIPT = italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT roman_sin ( italic_θ / 2 ) (9)

It can be observed that as the angle θ𝜃\thetaitalic_θ changes, the changes in length of the active tendon and the antagonist tendon can just compensate for each other. Meanwhile, the homogeneous transformation relationship from the fixed end center of the elbow joint to the moving end of the elbow joint is

𝑻edep=Rot(Z,θ/2)Trans(X,2R)Rot(Z,θ/2)=[C(θ)S(θ)02RC(θ/2)S(θ)C(θ)02RS(θ/2)00100001]superscriptsubscript𝑻𝑒𝑑𝑒𝑝𝑅𝑜𝑡𝑍𝜃2𝑇𝑟𝑎𝑛𝑠𝑋2𝑅𝑅𝑜𝑡𝑍𝜃2absentdelimited-[]𝐶𝜃𝑆𝜃02𝑅𝐶𝜃2𝑆𝜃𝐶𝜃02𝑅𝑆𝜃200100001\begin{array}[]{l}{}^{ep}\bm{T}_{ed}=Rot(Z,\theta/2)Trans(X,2R)Rot(Z,\theta/2)% \\ \quad=\left[\begin{array}[]{cccc}C(\theta)&-S(\theta)&0&2R\cdot C(\theta/2)\\ S(\theta)&C(\theta)&0&2R\cdot S(\theta/2)\\ 0&0&1&0\\ 0&0&0&1\end{array}\right]\end{array}start_ARRAY start_ROW start_CELL start_FLOATSUPERSCRIPT italic_e italic_p end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_e italic_d end_POSTSUBSCRIPT = italic_R italic_o italic_t ( italic_Z , italic_θ / 2 ) italic_T italic_r italic_a italic_n italic_s ( italic_X , 2 italic_R ) italic_R italic_o italic_t ( italic_Z , italic_θ / 2 ) end_CELL end_ROW start_ROW start_CELL = [ start_ARRAY start_ROW start_CELL italic_C ( italic_θ ) end_CELL start_CELL - italic_S ( italic_θ ) end_CELL start_CELL 0 end_CELL start_CELL 2 italic_R ⋅ italic_C ( italic_θ / 2 ) end_CELL end_ROW start_ROW start_CELL italic_S ( italic_θ ) end_CELL start_CELL italic_C ( italic_θ ) end_CELL start_CELL 0 end_CELL start_CELL 2 italic_R ⋅ italic_S ( italic_θ / 2 ) end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 end_CELL start_CELL 0 end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 end_CELL end_ROW end_ARRAY ] end_CELL end_ROW end_ARRAY (10)

3.3 Design of Anthropomorphic Wrist Joint

3.3.1 Wrist Joint Design Analysis

According to systematic anatomy [41], the human wrist joint movements can be categorized as follows:

  • 1.

    Forearm pronation and supination are mainly led by the pronator teres and supinator muscles, respectively.

  • 2.

    Wrist flexion and extension are principally driven by the flexor carpi radialis for flexion and extensor carpi radialis for extension.

  • 3.

    Radial and ulnar deviations are primarily propelled by the flexor carpi radialis for radial deviation and flexor carpi ulnaris for ulnar deviation.

The anthropomorphic manipulator wrist joint design comprises a 2-DOF parallel joint for wrist flexion-extension and ulnar-radial deviation, with a serial joint for forearm pronation and supination. Adopting a design approach akin to the elbow joint, six tendons drive the wrist motion. Through kinematics design, each antagonistic tendon pair maintains consistent length changes, allowing for three actuator-driven tendon sets. The parallel joint’s design draws inspiration from the quaternion joint [38], a 2-DOF parallel mechanism using an antiparallelogram linkage, achieving a pure rolling motion on a spherical surface.

3.3.2 Wrist Joint Design

A single parallelogram mechanism can only approximate an arc of a circle in its plane(refer to A). By positioning two sets of parallelogram mechanisms perpendicularly intersecting at their centers, and substituting the rotation pairs at the connections of each direct link with the moving and static platforms with Hooke’s joints, the intersection points of the parallelogram linkages lies on an ellipsoidal surface during movement as

x2(l/2)2+(yh)2(l/2)2w2+z2(l/2)2=1superscript𝑥2superscript𝑙22superscript𝑦2superscript𝑙22superscript𝑤2superscript𝑧2superscript𝑙221\frac{x^{2}}{(l/2)^{2}}+\frac{(y-h)^{2}}{(l/2)^{2}-w^{2}}+\frac{z^{2}}{(l/2)^{% 2}}=1divide start_ARG italic_x start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG ( italic_l / 2 ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + divide start_ARG ( italic_y - italic_h ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG ( italic_l / 2 ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + divide start_ARG italic_z start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG ( italic_l / 2 ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG = 1 (11)

The assembled mechanism contains redundant parallel constraints. By removing one of the support chains and positioning the remaining three at equal angular intervals, it can be simplified. Analyzing its degrees of freedom through screw theory reveals that it has 2 degrees of freedom in the initial configuration and none in the bent state. Although the moving platform’s constraint wrench system is full rank, it is approximately linearly dependent. Theoretically, this configuration is fully constrained; however, due to minor deformations of the linkage under slight stress, it can tilt in two directions[42]. Analysis of the mechanism’s movement using the atlas method suggests that, although the moving platform constraint force line has six, three of them nearly intersect [38]. In the presence of minor errors, a phenomenon of dimensionality reduction occurs. To verify its movement capabilities, this study performed an explicit dynamics analysis in Abaqus (refer to B).

Minor errors during machining and slight deformation of the mechanism under bending forces reduce the dimension of this mechanism’s constraint wrench system and constraint force line. The quaternion joint can deflect and is a two-degree-of-freedom spherical pure rolling joint. It has a smooth working space, with no singular points within the workspace and continuous boundaries.

Refer to caption
Figure 6: Detail design of the wrist joint.(a) Wrist joint(3-DOF).(b) Rotation Joint(1-DOF).(c)Wrist flexion and extension deflection joints(2-DOF)

Note:PDF format, 1-column fitting image

The design details of the wrist joint are depicted in Fig(6), where the quaternion joint serves as the primary structure of the 2-degree-of-freedom parallel joint in the ATDM wrist, as shown in Fig.(6(c)). Like the antagonistic tendon movement idea in the elbow joint, when the link sizes of each straight link of the quaternion joint meet certain relationships, the pure rolling between the ellipsoids representing the relative movement of its dynamic and static platforms can approximate the pure rolling of two spherical surfaces. In such a configuration, a balanced change in length occurs in a pair of antagonistic tendons, symmetrically driving the joint along its central axis. Consequently, only two motors are required to actuate the four tendons responsible for wrist rotation.

As demonstrated in Fig.(6(b)), for the joint of forearm internal and external rotation, to prevent its movement from coupling with the wrist tendon’s flexion and deflection movements, we set this joint last, connected to the end-effector. To prevent wrist movement from affecting the joint tendon movement, the driving tendon of this joint is set inside the forearm before the quaternion joint. The capstan set inside the forearm rotates under the traction of the actuator distributed in the base of the manipulator, and the capstan’s rotation is transmitted to the end through the transmission shaft. The transmission shaft passes through two Hooke’s joints in series, allowing the shaft to transmit the winch’s rotation to the end-effector while complying with the wrist’s rolling movement. The issue of unequal speeds at both ends of the universal joint during rotation is also resolved in the process of using paired Hooke’s joints in the transmission shaft. The Peek planetary gearbox set at the end can elevate the output torque and stiffness this direction.

3.3.3 Kinematic Analysis of the Wrist Joint

Refer to caption
Refer to caption
Figure 7: Schematic diagram of wrist joint motion.(a) Initial state.(b)Bending state

Note:PDF format, 1-column fitting image

Fig.(7) illustrates the relationship between the motion of the driving steel cable and the 2-DOF wrist joint. The end of the forearm is relatively fixed, and a base coordinate system ΣwpsubscriptΣ𝑤𝑝{\Sigma_{wp}}roman_Σ start_POSTSUBSCRIPT italic_w italic_p end_POSTSUBSCRIPT is established at the proximal end. The wrist joint’s distal end acts as the moving end ΣwdsubscriptΣ𝑤𝑑{\Sigma_{wd}}roman_Σ start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT. The x-axis of both coordinate systems runs along the wrist tendons in the yaw direction, and the y-axis runs along the pitch direction tendons.Similar to section 3.2.2,for easier identification and readability,intermediate coordinate systems (wpwprwprpwdrpwdrwpsubscript𝑤𝑝superscriptsubscript𝑤𝑝𝑟superscriptsubscript𝑤𝑝𝑟𝑝superscriptsubscript𝑤𝑑𝑟𝑝superscriptsubscript𝑤𝑑𝑟subscript𝑤𝑝{\sum_{wp}}\to\sum_{wp}^{r}\to\sum_{wp}^{rp}\to\sum_{wd}^{rp}\to\sum_{wd}^{r}% \to{\sum_{wp}}∑ start_POSTSUBSCRIPT italic_w italic_p end_POSTSUBSCRIPT → ∑ start_POSTSUBSCRIPT italic_w italic_p end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT → ∑ start_POSTSUBSCRIPT italic_w italic_p end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r italic_p end_POSTSUPERSCRIPT → ∑ start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r italic_p end_POSTSUPERSCRIPT → ∑ start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT → ∑ start_POSTSUBSCRIPT italic_w italic_p end_POSTSUBSCRIPT) are introduced to facilitate the description of the homogeneous transformations between ΣwpsubscriptΣ𝑤𝑝{\Sigma_{wp}}roman_Σ start_POSTSUBSCRIPT italic_w italic_p end_POSTSUBSCRIPT and ΣwdsubscriptΣ𝑤𝑑{\Sigma_{wd}}roman_Σ start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT,colored bounding boxes have been added around the frames of these intermediate coordinate systems which is correspond to the axes of their respective coordinate systems.

Assuming the tendon is a distance w𝑤witalic_w from the center of the wrist, and considering the direction of bending ϕitalic-ϕ\phiitalic_ϕ and the angle of bending θ𝜃\thetaitalic_θ , the movement of the 2-DOF part of the wrist joint can be simplified as pure rolling on a plane at an angle ϕitalic-ϕ\phiitalic_ϕ to the XOZ𝑋𝑂𝑍XOZitalic_X italic_O italic_Z plane of the proximal coordinate system of the wrist joint. The homogeneous transformation matrix from the distal end to the extreme end of the 2-DOF section, denoted 𝑻wdwpSE(3)superscriptsubscript𝑻𝑤𝑑𝑤𝑝𝑆𝐸3{}^{wp}\bm{T}_{wd}\in SE(3)start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT ∈ italic_S italic_E ( 3 ), is

𝑻wdwp=Rot(Z,ϕ)Rot(Y,θ/2)Trans(Z,h)Rot(Y,θ/2)Rot(Z,ϕ)superscriptsubscript𝑻𝑤𝑑𝑤𝑝𝑅𝑜𝑡𝑍italic-ϕ𝑅𝑜𝑡𝑌𝜃2𝑇𝑟𝑎𝑛𝑠𝑍𝑅𝑜𝑡𝑌𝜃2𝑅𝑜𝑡𝑍italic-ϕ{}^{wp}\bm{T}_{wd}=Rot(Z,\phi)Rot(Y,\theta/2)Trans(Z,h)Rot(Y,\theta/2)Rot(Z,-\phi)start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT = italic_R italic_o italic_t ( italic_Z , italic_ϕ ) italic_R italic_o italic_t ( italic_Y , italic_θ / 2 ) italic_T italic_r italic_a italic_n italic_s ( italic_Z , italic_h ) italic_R italic_o italic_t ( italic_Y , italic_θ / 2 ) italic_R italic_o italic_t ( italic_Z , - italic_ϕ ) (12)
=[12C2(ϕ)S2(θ/2)S(2ϕ)S2(θ/2)C(ϕ)S(θ)hC(ϕ)S(θ/2)S(2ϕ)S2(θ/2)12S2(ϕ)S2(θ/2)S(ϕ)S(θ)hS(ϕ)S(θ/2)C(ϕ)S(θ)S(ϕ)S(θ)C(θ)hC(θ/2)0001]absentdelimited-[]12superscript𝐶2italic-ϕsuperscript𝑆2𝜃2𝑆2italic-ϕsuperscript𝑆2𝜃2𝐶italic-ϕ𝑆𝜃𝐶italic-ϕ𝑆𝜃2𝑆2italic-ϕsuperscript𝑆2𝜃212superscript𝑆2italic-ϕsuperscript𝑆2𝜃2𝑆italic-ϕ𝑆𝜃𝑆italic-ϕ𝑆𝜃2𝐶italic-ϕ𝑆𝜃𝑆italic-ϕ𝑆𝜃𝐶𝜃𝐶𝜃20001\displaystyle=\left[\begin{array}[]{cccc}1-2C^{2}(\phi)S^{2}(\theta/2)&-S(2% \phi)S^{2}(\theta/2)&C(\phi)S(\theta)&hC(\phi)S(\theta/2)\\ -S(2\phi)S^{2}(\theta/2)&1-2S^{2}(\phi)S^{2}(\theta/2)&S(\phi)S(\theta)&hS(% \phi)S(\theta/2)\\ -C(\phi)S(\theta)&-S(\phi)S(\theta)&C(\theta)&hC(\theta/2)\\ 0&0&0&1\end{array}\right]= [ start_ARRAY start_ROW start_CELL 1 - 2 italic_C start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_ϕ ) italic_S start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) end_CELL start_CELL - italic_S ( 2 italic_ϕ ) italic_S start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) end_CELL start_CELL italic_C ( italic_ϕ ) italic_S ( italic_θ ) end_CELL start_CELL italic_h italic_C ( italic_ϕ ) italic_S ( italic_θ / 2 ) end_CELL end_ROW start_ROW start_CELL - italic_S ( 2 italic_ϕ ) italic_S start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) end_CELL start_CELL 1 - 2 italic_S start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_ϕ ) italic_S start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) end_CELL start_CELL italic_S ( italic_ϕ ) italic_S ( italic_θ ) end_CELL start_CELL italic_h italic_S ( italic_ϕ ) italic_S ( italic_θ / 2 ) end_CELL end_ROW start_ROW start_CELL - italic_C ( italic_ϕ ) italic_S ( italic_θ ) end_CELL start_CELL - italic_S ( italic_ϕ ) italic_S ( italic_θ ) end_CELL start_CELL italic_C ( italic_θ ) end_CELL start_CELL italic_h italic_C ( italic_θ / 2 ) end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 end_CELL end_ROW end_ARRAY ] (14)

Under such motion, the movement of the tendons in the pitch and roll directions can be calculated as

Lp1subscript𝐿𝑝1\displaystyle L_{p1}italic_L start_POSTSUBSCRIPT italic_p 1 end_POSTSUBSCRIPT =|𝑨p1wp𝑻wdwp𝑨pd1wd|,absentsuperscriptsubscript𝑨𝑝1𝑤𝑝superscriptsubscript𝑻𝑤𝑑𝑤𝑝superscriptsubscript𝑨𝑝𝑑1𝑤𝑑\displaystyle=\left|{}^{wp}{\bm{A}_{p1}}-{}^{wp}{\bm{T}_{wd}}{}^{wd}{\bm{A}_{% pd1}}\right|,= | start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p 1 end_POSTSUBSCRIPT - start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p italic_d 1 end_POSTSUBSCRIPT | ,
Lp2subscript𝐿𝑝2\displaystyle L_{p2}italic_L start_POSTSUBSCRIPT italic_p 2 end_POSTSUBSCRIPT =|𝑨p2wp𝑻wdwp𝑨pd2wd|,absentsuperscriptsubscript𝑨𝑝2𝑤𝑝superscriptsubscript𝑻𝑤𝑑𝑤𝑝superscriptsubscript𝑨𝑝𝑑2𝑤𝑑\displaystyle=\left|{}^{wp}{\bm{A}_{p2}}-{}^{wp}{\bm{T}_{wd}}{}^{wd}{\bm{A}_{% pd2}}\right|,= | start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p 2 end_POSTSUBSCRIPT - start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p italic_d 2 end_POSTSUBSCRIPT | ,
Ly1subscript𝐿𝑦1\displaystyle L_{y1}italic_L start_POSTSUBSCRIPT italic_y 1 end_POSTSUBSCRIPT =|𝑨y1wp𝑻wdwp𝑨yd1wd|,absentsuperscriptsubscript𝑨𝑦1𝑤𝑝superscriptsubscript𝑻𝑤𝑑𝑤𝑝superscriptsubscript𝑨𝑦𝑑1𝑤𝑑\displaystyle=\left|{}^{wp}{\bm{A}_{y1}}-{}^{wp}{\bm{T}_{wd}}{}^{wd}{\bm{A}_{% yd1}}\right|,= | start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y 1 end_POSTSUBSCRIPT - start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y italic_d 1 end_POSTSUBSCRIPT | ,
Ly2subscript𝐿𝑦2\displaystyle L_{y2}italic_L start_POSTSUBSCRIPT italic_y 2 end_POSTSUBSCRIPT =|𝑨y2wp𝑻wdwp𝑨yd2wd|.absentsuperscriptsubscript𝑨𝑦2𝑤𝑝superscriptsubscript𝑻𝑤𝑑𝑤𝑝superscriptsubscript𝑨𝑦𝑑2𝑤𝑑\displaystyle=\left|{}^{wp}{\bm{A}_{y2}}-{}^{wp}{\bm{T}_{wd}}{}^{wd}{\bm{A}_{% yd2}}\right|.= | start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y 2 end_POSTSUBSCRIPT - start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_w italic_d end_POSTSUBSCRIPT start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y italic_d 2 end_POSTSUBSCRIPT | . (15)

where, Lp1subscript𝐿𝑝1L_{p}1italic_L start_POSTSUBSCRIPT italic_p end_POSTSUBSCRIPT 1 , Lp2subscript𝐿𝑝2L_{p}2italic_L start_POSTSUBSCRIPT italic_p end_POSTSUBSCRIPT 2, Ly1subscript𝐿𝑦1L_{y}1italic_L start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT 1 , and Ly2subscript𝐿𝑦2L_{y}2italic_L start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT 2 respectively represent the two sets of tendons in the pitch and yaw directions, where 𝑨p1wp=𝑨pd1wd=(w,0,0,1)superscriptsubscript𝑨𝑝1𝑤𝑝superscriptsubscript𝑨𝑝𝑑1𝑤𝑑𝑤001{}^{wp}{\bm{A}_{p1}}={}^{wd}{\bm{A}_{pd1}}=\left({w,0,0,1}\right)start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p 1 end_POSTSUBSCRIPT = start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p italic_d 1 end_POSTSUBSCRIPT = ( italic_w , 0 , 0 , 1 );𝑨p2wp=𝑨pd2wd=(w,0,0,1)superscriptsubscript𝑨𝑝2𝑤𝑝superscriptsubscript𝑨𝑝𝑑2𝑤𝑑𝑤001{}^{wp}{\bm{A}_{p2}}={}^{wd}{\bm{A}_{pd2}}=\left({-w,0,0,1}\right)start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p 2 end_POSTSUBSCRIPT = start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_p italic_d 2 end_POSTSUBSCRIPT = ( - italic_w , 0 , 0 , 1 );𝑨y1wp=𝑨yd1wd=(0,w,0,1)superscriptsubscript𝑨𝑦1𝑤𝑝superscriptsubscript𝑨𝑦𝑑1𝑤𝑑0𝑤01{}^{wp}{\bm{A}_{y1}}={}^{wd}{\bm{A}_{yd1}}=\left({0,w,0,1}\right)start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y 1 end_POSTSUBSCRIPT = start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y italic_d 1 end_POSTSUBSCRIPT = ( 0 , italic_w , 0 , 1 );𝑨y2wp=𝑨yd2wd=(0,w,0,1)superscriptsubscript𝑨𝑦2𝑤𝑝superscriptsubscript𝑨𝑦𝑑2𝑤𝑑0𝑤01{}^{wp}{\bm{A}_{y2}}={}^{wd}{\bm{A}_{yd2}}=\left({0,-w,0,1}\right)start_FLOATSUPERSCRIPT italic_w italic_p end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y 2 end_POSTSUBSCRIPT = start_FLOATSUPERSCRIPT italic_w italic_d end_FLOATSUPERSCRIPT bold_italic_A start_POSTSUBSCRIPT italic_y italic_d 2 end_POSTSUBSCRIPT = ( 0 , - italic_w , 0 , 1 );These are the homogeneous coordinates of the endpoints of the TATs. For each pair of mutually coupled motion tendons, the amount of change in their lengths is the same. By substituting the homogeneous coordinates into the equation, we can compute the total change in length of the TATs as

ΔLpitch=2Nwwcos(φ)sin(θ/2)ΔLyaw=2Nwwsin(φ)sin(θ/2)Δsubscript𝐿𝑝𝑖𝑡𝑐2subscript𝑁𝑤𝑤𝜑𝜃2Δsubscript𝐿𝑦𝑎𝑤2subscript𝑁𝑤𝑤𝜑𝜃2\begin{array}[]{l}\Delta L_{pitch}=2N_{w}w\cos(\varphi)\sin(\theta/2)\\ \Delta L_{yaw}=2N_{w}w\sin(\varphi)\sin(\theta/2)\end{array}start_ARRAY start_ROW start_CELL roman_Δ italic_L start_POSTSUBSCRIPT italic_p italic_i italic_t italic_c italic_h end_POSTSUBSCRIPT = 2 italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT italic_w roman_cos ( italic_φ ) roman_sin ( italic_θ / 2 ) end_CELL end_ROW start_ROW start_CELL roman_Δ italic_L start_POSTSUBSCRIPT italic_y italic_a italic_w end_POSTSUBSCRIPT = 2 italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT italic_w roman_sin ( italic_φ ) roman_sin ( italic_θ / 2 ) end_CELL end_ROW end_ARRAY (16)

where, Nwsubscript𝑁𝑤N_{w}italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT represents the number of windings of the TAT steel cable in the wrist.

The 3-DOF joint at the end of manipulator can flexibly adjust orientation, allowing the AMS to adapt to complex environments while decreasing adjustment-induced disturbances.

3.4 Finite Element Analysis

The finite element analysis (FEA) of the ATDM encompasses strength, stiffness, and topology optimization.

Strength and stiffness were analyzed using Abaqus 2021, focusing on material selection and key parameters of the manipulator. For heavier components, boundary conditions were set based on constraints and forces, with topology optimization performed in Altair Inspire 2022.

In aerial manipulation, the primary structure of the manipulator must possess high strength and stiffness to counteract substantial forces and torques. Given that aluminum alloys exhibit stiffness an order of magnitude higher than commonly used additive manufacturing plastics, such as PC and ABS, the main structure of the ATDM (encompassing joints and links) was fabricated from aluminum alloy. This choice was made to bolster stiffness, diminish weight, and enhance end positioning accuracy.

For the iterative design, components like gears and pulleys, responsible for transmitting cable tension, don’t necessitate the same rigidity as the primary structure. To ensure adaptability in diverse environments, including underwater exploration, fire rescue, and electrical operations, Peek was chosen for these components. Peek is renowned for its wear resistance, stable chemical structure, superior mechanical properties, low friction coefficient, and fatigue resistance, making it apt for cable-driven mechanisms [43].

Table 1 displays the material choices for each component.

Table 1: Material Selection
Items Material
joint Aluminum alloy(7075)
link(Except for the forearm) Aluminum alloy(7075)
link(forearm) AlSi10Mg
gear Peek
pulley Peek
end-effector Pc

Topology optimization, irrespective of initial models and engineering experience, determines optimal structures under constraints, commonly used in aerospace lightweight design.

However, the intricate geometries from topology optimization are hard to realize with traditional manufacturing. This demands a trade-off between technology and optimization, complicating the achievement of optimal product performance. Additive manufacturing, especially Selective Laser Melting (SLM), can accurately produce these optimal structures.

Refer to caption
Figure 8: Finite element-based weight reduction of elbow joint

Note:PDF format, 1-column fitting image

Considering the TAT system setup and pulleys for cable routing at each joint, a post-optimization redesign was based on the joint’s topology optimization results, as in Fig.(8). The joint’s weight was reduced by 40%percent4040\%40 % from its original based on optimization calculations.

Refer to caption
Figure 9: Finite element-based weight reduction of elbow link. (a) Original version. (b) PolyNURBS part. (c) Prototype version. (d) Stiffness analysis of the original. (e) Stiffness analysis of the PolyNURBS part. (f) Stiffness analysis of the Prototype version.

Note:PDF format, 1-column fitting image

Aside from the fixed tendon sheath structure of the end-effector’s motion path, the links only have to reserve space for installation at the connection with the joint. In order to obtain better optimization results, this study enlarged the initial design area without interfering with the tendon paths,after setting the design space, topology optimization calculations were conducted.The calculation maximizes the stiffness under load conditions where multiple combinations of bending and torsional deformations are considered. mass targets are set to 30% of total design space volume.

Then,lattice optimization were applied to the links, aiming to mimic the tight radially gradient structure of human bone to reduce weight and inertia while maximizing stiffness under theboundary conditions in which AMS operates.Lattice parameters were set with a target length of 6mm6mm6\text{mm}6 mm, diameters ranging from 1mm1mm1\text{mm}1 mm to 2mm2mm2\text{mm}2 mm, and filling the design space.

The entire process can refer to Fig.(9),Fig.(9(a)-(c)) shows the entire optimization process, and Fig.(9(d)-(f)) shows the finite element stiffness analysis of the corresponding structure when it is subjected to a large impact (such as AMS falling). Considering the large dynamic load coefficient, a shear force of 500N500𝑁500N500 italic_N and A bending moment of 15Nm15𝑁𝑚15N\cdot m15 italic_N ⋅ italic_m is applied to the distal end of the link.

Based on optimization calculations, the weight of the manipulator link was reduced by 71%percent7171\%71 % from its original weight, which includes the non-optimized area necessary for assembly, and the optimized area is reduced by 83%percent8383\%83 %. Based on the results of finite element stiffness calculation, the stiffness is only increased by 2.4 times, and there is no plastic deformation, which shows that After the elbow link is reduced in weight, it still has a certain residual strength coefficient when facing impact loads on the basis of meeting the strength and stiffness.

3.5 Overall Configuration of the Manipulator

Refer to caption
Figure 10: Details of the manipulator

Note:PDF format, 2-column fitting image

Sections 3.2 and 3.3 detail the 1-dof elbow and 3-dof wrist joints. The ATDM comprises a hexrotor and a 4-DOF tendon-driven manipulator with a compliant underactuated soft end-effector. This section showcases the drive, tensioning, and end-effector of the manipulator. Details are shown in Fig.(10).

Actuators are distributed on a UAV-attached base. The design ensures consistent length changes between primary and antagonist tendons during single joint motion. The ’8’ decoupling pulley on the elbow joint, combined with the pre-elbow link, decouples elbow and wrist joint motions. This setup achieves mutual cancellation of radial forces on the pulley shaft, eliminating the need for additional cable tension retention once each manipulator cable is pretensioned.

Though no tension retention mechanism is needed, mechanical pre-tightening of each steel cableis essential for motion accuracy under load and quick reverse movements. The pre-tensioning force is set to half the steel cable’s maximum load.

Considering AMS’s weight sensitivity, the pre-tensioning mechanism’s weight and size are crucial. While both rotating screw and ratchet methods at the cable end are lightweight, they have issues with force control and smoothness, respectively. The motor-connected winch drum was divided into a rotating shaft, primary muscle drum, and antagonist muscle drum. The shaft connects to the motor, with the muscle capstans tensioned via a sprocket.

Grappling with object manipulation in unstructured settings remains a significant challenge in robotics [44]. While many studies favor two-fingered parallel grippers [45, 8], their dexterity is limited in dynamic environments. In AMS, high-DOF fingers have proven to enhance grasping success due to vibrations during flight. Soft underactuated end-effectors, which passively adapt to object shapes, offer a more efficient approach than traditional manipulators requiring multiple servo motors[46]. They utilize fewer actuators for versatile grasps [44, 46, 47]. Such end-effectors not only enhance AMS versatility but also reduce disturbances from aerial platforms, providing a cost-effective solution. This paper provides a brief overview of the end-effector’s design, as depicted in the lower right part of Fig.(10).

4 Analysis of the ATDM

This section is dedicated to analyzing the workspace of the ATDM and deriving the output torque and joint stiffness of the joints, which are based on the TAT mechanism.

4.1 Analysis of ATDM’s Working Space

UAV with six degrees of freedom is an underactuated system, there are coupling between its position and attitude loops, with only four control channels available. The ATDM features a 4-DOF manipulator system. Its 3-DOF joint end allows flexible posture adjustments, minimizing UAV coupling disturbance. Additionally, redundancy in the end’s degree of freedom enables tasks like UAV obstacle avoidance, singularity avoidance, joint limit prevention, load optimization, and posture optimization.

Fig. 2 shows the ATDM’s schematic with coordinate systems. ΣI{OIXIYIZI}subscriptΣ𝐼subscript𝑂𝐼subscript𝑋𝐼subscript𝑌𝐼subscript𝑍𝐼{\Sigma_{I}}\{{O_{I}}-{X_{I}}{Y_{I}}{Z_{I}}\}roman_Σ start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT { italic_O start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT - italic_X start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT italic_Y start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT italic_Z start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT } denotes the inertial frame, ΣB{OBXBYBZB}subscriptΣ𝐵subscript𝑂𝐵subscript𝑋𝐵subscript𝑌𝐵subscript𝑍𝐵{\Sigma_{B}}\{{O_{B}}-{X_{B}}{Y_{B}}{Z_{B}}\}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT { italic_O start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT - italic_X start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT italic_Y start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT italic_Z start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT } represents the body coordinate at the UAV’s COM, and ΣE{OEXEYEZE}subscriptΣ𝐸subscript𝑂𝐸subscript𝑋𝐸subscript𝑌𝐸subscript𝑍𝐸{\Sigma_{E}}\{{O_{E}}-{X_{E}}{Y_{E}}{Z_{E}}\}roman_Σ start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT { italic_O start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT - italic_X start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT italic_Y start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT italic_Z start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT } is the end-effector’s system.

The manipulator is modeled as a 7-DOF arm with three pairs of coupled joints. Each joint’s coordinate system is established following section 3, with the MD-H parameters shown in Table 2.

Table 2: MD-H Parameters of The Manipulator
Linki θisubscript𝜃𝑖\theta_{i}italic_θ start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT (°) disubscript𝑑𝑖d_{i}italic_d start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT (mm) ai1subscript𝑎𝑖1a_{i-1}italic_a start_POSTSUBSCRIPT italic_i - 1 end_POSTSUBSCRIPT (mm) αi1subscript𝛼𝑖1\alpha_{i-1}italic_α start_POSTSUBSCRIPT italic_i - 1 end_POSTSUBSCRIPT (°)
Link1 θ¯1subscript¯𝜃1{\overline{\theta}}_{1}over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT 0 200 0
Link2 θ¯1+π/2subscript¯𝜃1𝜋2{\overline{\theta}}_{1}+\pi/2over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + italic_π / 2 0 80 0
Link3 θ¯2subscript¯𝜃2{\overline{\theta}}_{2}over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT 300 1 π/2𝜋2\pi/2italic_π / 2
Link4 θ¯3π/2subscript¯𝜃3𝜋2{\overline{\theta}}_{3}-\pi/2over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT - italic_π / 2 0 0 π/2𝜋2-\pi/2- italic_π / 2
Link5 θ¯3+π/2subscript¯𝜃3𝜋2{\overline{\theta}}_{3}+\pi/2over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT + italic_π / 2 0 90 0
Link6 θ¯2subscript¯𝜃2{\overline{\theta}}_{2}over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT 0 0 π/2𝜋2\pi/2italic_π / 2
Link7 θ¯4subscript¯𝜃4{\overline{\theta}}_{4}over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT 4 end_POSTSUBSCRIPT 100 0 0

Due to the existence of virtual coupled joints,there are only four independent anglesθ¯i(i=1,2,3,4)subscript¯𝜃𝑖𝑖1234{\bar{\theta}_{i}}(i=1,2,3,4)over¯ start_ARG italic_θ end_ARG start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT ( italic_i = 1 , 2 , 3 , 4 ), the ranges of which are as follows: θ1[π/4,π/4],θ2[π/4,π/4],θ3[π/4,π/4],θ4[π,π]formulae-sequencesubscript𝜃1𝜋4𝜋4formulae-sequencesubscript𝜃2𝜋4𝜋4formulae-sequencesubscript𝜃3𝜋4𝜋4subscript𝜃4𝜋𝜋{\theta_{1}}\in[-\pi/4,\pi/4],{\theta_{2}}\in[-\pi/4,\pi/4],{\theta_{3}}\in[-% \pi/4,\pi/4],{\theta_{4}}\in[-\pi,\pi]italic_θ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ∈ [ - italic_π / 4 , italic_π / 4 ] , italic_θ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ∈ [ - italic_π / 4 , italic_π / 4 ] , italic_θ start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT ∈ [ - italic_π / 4 , italic_π / 4 ] , italic_θ start_POSTSUBSCRIPT 4 end_POSTSUBSCRIPT ∈ [ - italic_π , italic_π ]. The description of ΣEsubscriptΣ𝐸{\Sigma_{E}}roman_Σ start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT in ΣBsubscriptΣ𝐵{\Sigma_{B}}roman_Σ start_POSTSUBSCRIPT italic_B end_POSTSUBSCRIPT can be obtained through the homogeneous transformation matrices between joints, which is represented as 𝑻EBsuperscriptsubscript𝑻𝐸𝐵{}^{B}{\bm{T}_{E}}start_FLOATSUPERSCRIPT italic_B end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_E end_POSTSUBSCRIPT, and the homogeneous transformation matrices 𝑻ii1superscriptsubscript𝑻𝑖𝑖1{}^{i-1}{\bm{T}_{i}}start_FLOATSUPERSCRIPT italic_i - 1 end_FLOATSUPERSCRIPT bold_italic_T start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT between adjacent links refer to [48].

Refer to caption
Figure 11: Analysis of ATDM’s working space. (a) Hover. (b) Yaw. (c) Vertically ascend and descend

Note:PDF format, 1-column fitting image

Equipping a UAV with a 4-DOF manipulator enables the end-effector to reach any desired spatial position with any arbitrary orientation. Given the UAV’s lack of coupling in gravitational or yaw directions and the typical front-mounted camera, we analyze the ATDM’s end-effector workspace under three conditions:

  1. 1.

    the UAV remains in hover (Fig. 11(a)),

  2. 2.

    the UAV hovers at a fixed point with a varying yaw angle (Fig. 11(b)),

  3. 3.

    the UAV can move along the gravitational axis while also executing yaw movements (Fig. 11(c)).

Assuming the UAV is near its target and needs only pose fine-tuning, we consider only two motion directions. The 3-DOF wrist joint allows flexible attitude adjustments of the end, with minimal position fluctuations, reducing UAV disturbances. In hover mode, the end’s workspace is limited. However, with the ATDM system combining a UAV and tendon-driven manipulator, the workspace expands in the latter two scenarios. While the workspace is initially small, it expands significantly when the UAV utilizes its two uncoupled degrees of freedom. This heart-shaped three-dimensional workspace allows for flexible operations.

4.2 Torque and Stiffness Analysis of ATDM

This section focuses on analyzing the output torque and stiffness of the elbow and wrist joints in the ATDM.

4.2.1 Analysis of the 1-DOF Elbow Joint

The torque in the joints of the manipulator can be represented as

τelbowΔθ=ΔTΔlsubscript𝜏𝑒𝑙𝑏𝑜𝑤Δ𝜃Δ𝑇Δ𝑙{\tau_{elbow}}\Delta\theta=\Delta T\Delta litalic_τ start_POSTSUBSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUBSCRIPT roman_Δ italic_θ = roman_Δ italic_T roman_Δ italic_l (17)

Where ΔθΔ𝜃\Delta\thetaroman_Δ italic_θ is the joint rotation angle, ΔTΔ𝑇\Delta Troman_Δ italic_T is the difference in tension between the agonist and antagonist muscles in a single cable, and ΔlΔ𝑙\Delta lroman_Δ italic_l is the displacement of the tendon cable. Due to the uniformity of the agonist and antagonist muscles, according to Equ (8)

ΔlΔθ=Nede2cos(θ/2)Δ𝑙Δ𝜃subscript𝑁𝑒subscript𝑑𝑒2𝜃2\frac{\Delta l}{\Delta\theta}=\frac{N_{e}d_{e}}{2}\cos(\theta/2)divide start_ARG roman_Δ italic_l end_ARG start_ARG roman_Δ italic_θ end_ARG = divide start_ARG italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT end_ARG start_ARG 2 end_ARG roman_cos ( italic_θ / 2 ) (18)

The output torque of the elbow joint can be represented as:

τelbow=Nede2cos(θ/2)ΔTs.tΔT=min(kcable,τmotorelbowRcapstan)formulae-sequencesubscript𝜏𝑒𝑙𝑏𝑜𝑤subscript𝑁𝑒subscript𝑑𝑒2𝜃2Δ𝑇𝑠𝑡Δ𝑇subscript𝑘𝑐𝑎𝑏𝑙𝑒superscriptsubscript𝜏𝑚𝑜𝑡𝑜𝑟𝑒𝑙𝑏𝑜𝑤subscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛\tau_{elbow}=\frac{N_{e}d_{e}}{2}\cos(\theta/2)\Delta T\quad s.t\quad\Delta T=% \min\left(k_{cable},\frac{\tau_{motor}^{elbow}}{R_{capstan}}\right)italic_τ start_POSTSUBSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUBSCRIPT = divide start_ARG italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT end_ARG start_ARG 2 end_ARG roman_cos ( italic_θ / 2 ) roman_Δ italic_T italic_s . italic_t roman_Δ italic_T = roman_min ( italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT , divide start_ARG italic_τ start_POSTSUBSCRIPT italic_m italic_o italic_t italic_o italic_r end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUPERSCRIPT end_ARG start_ARG italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT end_ARG ) (19)

Where, kcablesubscript𝑘𝑐𝑎𝑏𝑙𝑒k_{cable}italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT represents the maximum tensile strength of the steel cable, τmotorelbowsuperscriptsubscript𝜏𝑚𝑜𝑡𝑜𝑟𝑒𝑙𝑏𝑜𝑤\tau_{motor}^{elbow}italic_τ start_POSTSUBSCRIPT italic_m italic_o italic_t italic_o italic_r end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUPERSCRIPT denoting the motor’s output torque at this time.

The stiffness of the manipulator is derived as follows:

Assuming the mechanical arm is in equilibrium at angle θ𝜃\thetaitalic_θ, and a torque δτsubscript𝛿𝜏\delta_{\tau}italic_δ start_POSTSUBSCRIPT italic_τ end_POSTSUBSCRIPT is applied to the joint, the joint undergoes a minor deformation δθsubscript𝛿𝜃\delta_{\theta}italic_δ start_POSTSUBSCRIPT italic_θ end_POSTSUBSCRIPT. According to the principle of virtual work

δWint=δWout𝛿subscript𝑊𝑖𝑛𝑡𝛿subscript𝑊𝑜𝑢𝑡\delta{W_{int}}=\delta{W_{out}}italic_δ italic_W start_POSTSUBSCRIPT italic_i italic_n italic_t end_POSTSUBSCRIPT = italic_δ italic_W start_POSTSUBSCRIPT italic_o italic_u italic_t end_POSTSUBSCRIPT (20)

we obtain

δτδθ=Σi=1nδTiδLi𝛿𝜏𝛿𝜃superscriptsubscriptΣ𝑖1𝑛𝛿subscript𝑇𝑖𝛿subscript𝐿𝑖\delta\tau\delta\theta=\Sigma_{i=1}^{n}\delta{T_{i}}\delta{L_{i}}italic_δ italic_τ italic_δ italic_θ = roman_Σ start_POSTSUBSCRIPT italic_i = 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_n end_POSTSUPERSCRIPT italic_δ italic_T start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT italic_δ italic_L start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT (21)

According to Equ.(18) and Equ.(21),it can be deduced that

δτ𝛿𝜏\displaystyle\delta\tauitalic_δ italic_τ =Nede2cos(θ/2)(TagoTant)absentsubscript𝑁𝑒subscript𝑑𝑒2𝜃2subscript𝑇𝑎𝑔𝑜subscript𝑇𝑎𝑛𝑡\displaystyle=\frac{N_{e}d_{e}}{2}\cos(\theta/2)(T_{ago}-T_{ant})= divide start_ARG italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT end_ARG start_ARG 2 end_ARG roman_cos ( italic_θ / 2 ) ( italic_T start_POSTSUBSCRIPT italic_a italic_g italic_o end_POSTSUBSCRIPT - italic_T start_POSTSUBSCRIPT italic_a italic_n italic_t end_POSTSUBSCRIPT )
=Nede2cos(θ/2)(kcableδl2Rdesin(θ/2)+kcableδl2R+desin(θ/2))absentsubscript𝑁𝑒subscript𝑑𝑒2𝜃2subscript𝑘𝑐𝑎𝑏𝑙𝑒𝛿𝑙2𝑅subscript𝑑𝑒𝜃2subscript𝑘𝑐𝑎𝑏𝑙𝑒𝛿𝑙2𝑅subscript𝑑𝑒𝜃2\displaystyle=\frac{N_{e}d_{e}}{2}\cos(\theta/2)\left(k_{cable}\frac{\delta l}% {2R-d_{e}\sin(\theta/2)}+k_{cable}\frac{\delta l}{2R+d_{e}\sin(\theta/2)}\right)= divide start_ARG italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT end_ARG start_ARG 2 end_ARG roman_cos ( italic_θ / 2 ) ( italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT divide start_ARG italic_δ italic_l end_ARG start_ARG 2 italic_R - italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT roman_sin ( italic_θ / 2 ) end_ARG + italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT divide start_ARG italic_δ italic_l end_ARG start_ARG 2 italic_R + italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT roman_sin ( italic_θ / 2 ) end_ARG )
=Nede2cos(θ/2)kcable4Rδl4R2de2sin2(θ/2)absentsubscript𝑁𝑒subscript𝑑𝑒2𝜃2subscript𝑘𝑐𝑎𝑏𝑙𝑒4𝑅𝛿𝑙4superscript𝑅2superscriptsubscript𝑑𝑒2superscript2𝜃2\displaystyle=\frac{N_{e}d_{e}}{2}\cos(\theta/2)k_{cable}\frac{4R\delta l}{4R^% {2}-d_{e}^{2}\sin^{2}(\theta/2)}= divide start_ARG italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT end_ARG start_ARG 2 end_ARG roman_cos ( italic_θ / 2 ) italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT divide start_ARG 4 italic_R italic_δ italic_l end_ARG start_ARG 4 italic_R start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT roman_sin start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) end_ARG (22)

the stiffness of the elbow joint can be derived as

kelbow=δτδθ=Nede2cos(θ/2)kcable4R4R2de2sin2(θ/2)δlδθsubscript𝑘𝑒𝑙𝑏𝑜𝑤𝛿𝜏𝛿𝜃subscript𝑁𝑒subscript𝑑𝑒2𝜃2subscript𝑘𝑐𝑎𝑏𝑙𝑒4𝑅4superscript𝑅2superscriptsubscript𝑑𝑒2superscript2𝜃2𝛿𝑙𝛿𝜃k_{elbow}=\frac{\delta\tau}{\delta\theta}=\frac{N_{e}d_{e}}{2}\cos(\theta/2)k_% {cable}\frac{4R}{4R^{2}-d_{e}^{2}\sin^{2}(\theta/2)}\frac{\delta l}{\delta\theta}italic_k start_POSTSUBSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUBSCRIPT = divide start_ARG italic_δ italic_τ end_ARG start_ARG italic_δ italic_θ end_ARG = divide start_ARG italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT end_ARG start_ARG 2 end_ARG roman_cos ( italic_θ / 2 ) italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT divide start_ARG 4 italic_R end_ARG start_ARG 4 italic_R start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT roman_sin start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) end_ARG divide start_ARG italic_δ italic_l end_ARG start_ARG italic_δ italic_θ end_ARG (23)

From Equ.(18) and Equ.(23),kelbowsubscript𝑘𝑒𝑙𝑏𝑜𝑤k_{elbow}italic_k start_POSTSUBSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUBSCRIPT can be calculated as

kelbow=(Nedecos(θ/2))2kcableR4R2de2sin2(θ/2)subscript𝑘𝑒𝑙𝑏𝑜𝑤superscriptsubscript𝑁𝑒subscript𝑑𝑒𝜃22subscript𝑘𝑐𝑎𝑏𝑙𝑒𝑅4superscript𝑅2superscriptsubscript𝑑𝑒2superscript2𝜃2k_{elbow}=\left(N_{e}d_{e}\cos(\theta/2)\right)^{2}k_{cable}\frac{R}{4R^{2}-d_% {e}^{2}\sin^{2}(\theta/2)}italic_k start_POSTSUBSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUBSCRIPT = ( italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT roman_cos ( italic_θ / 2 ) ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT divide start_ARG italic_R end_ARG start_ARG 4 italic_R start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT roman_sin start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) end_ARG (24)

According Equ.(19) and Equ.(24), it’s clear that increasing Nesubscript𝑁𝑒N_{e}italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT and desubscript𝑑𝑒d_{e}italic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT can obtain higher joint torque. In the design of the elbow joint, we have chosen R=45mm𝑅45𝑚𝑚R=45mmitalic_R = 45 italic_m italic_m,Ne=6subscript𝑁𝑒6N_{e}=6italic_N start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT = 6, de=482mmsubscript𝑑𝑒482𝑚𝑚{d_{e}}=48\sqrt{2}mmitalic_d start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT = 48 square-root start_ARG 2 end_ARG italic_m italic_m and Rcapstan=11mmsubscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛11𝑚𝑚R_{capstan}=11mmitalic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT = 11 italic_m italic_m,These are designable parameters.

4.2.2 Analysis of the 3-dof Wrist Joint

The pitch and yaw motions of the 2-DOF portion of the wrist joint can be calculated using Equ(16) and the calculations for the 1-DOF joint in section(4.2.1). The resultant output torque and stiffness for a single pair of antagonistic tendons can be obtained likewise. When both tendons are engaged, the total output torque for the 2-dof section is as follows:

τwrist2dofsubscript𝜏𝑤𝑟𝑖𝑠𝑡2𝑑𝑜𝑓\displaystyle{\tau_{wrist-2dof}}italic_τ start_POSTSUBSCRIPT italic_w italic_r italic_i italic_s italic_t - 2 italic_d italic_o italic_f end_POSTSUBSCRIPT =Nwwcos(θ/2)(ΔTpitch|sin(φ)|+ΔTyaw|cos(φ)|)absentsubscript𝑁𝑤𝑤𝜃2Δsubscript𝑇𝑝𝑖𝑡𝑐𝜑Δsubscript𝑇𝑦𝑎𝑤𝜑\displaystyle={N_{w}}w\cos(\theta/2)(\Delta{T_{pitch}}\left|{\sin(\varphi)}% \right|+\Delta{T_{yaw}}\left|{\cos(\varphi)}\right|)= italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT italic_w roman_cos ( italic_θ / 2 ) ( roman_Δ italic_T start_POSTSUBSCRIPT italic_p italic_i italic_t italic_c italic_h end_POSTSUBSCRIPT | roman_sin ( italic_φ ) | + roman_Δ italic_T start_POSTSUBSCRIPT italic_y italic_a italic_w end_POSTSUBSCRIPT | roman_cos ( italic_φ ) | )
ΔTpitchΔsubscript𝑇𝑝𝑖𝑡𝑐\displaystyle\Delta{T_{pitch}}roman_Δ italic_T start_POSTSUBSCRIPT italic_p italic_i italic_t italic_c italic_h end_POSTSUBSCRIPT =min(kcable,τmotorpitchRcapstan)absentsubscript𝑘𝑐𝑎𝑏𝑙𝑒superscriptsubscript𝜏𝑚𝑜𝑡𝑜𝑟𝑝𝑖𝑡𝑐subscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛\displaystyle=\min({k_{cable}},\frac{{\tau_{motor}^{pitch}}}{{{R_{capstan}}}})= roman_min ( italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT , divide start_ARG italic_τ start_POSTSUBSCRIPT italic_m italic_o italic_t italic_o italic_r end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_p italic_i italic_t italic_c italic_h end_POSTSUPERSCRIPT end_ARG start_ARG italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT end_ARG )
ΔTyawΔsubscript𝑇𝑦𝑎𝑤\displaystyle\Delta{T_{yaw}}roman_Δ italic_T start_POSTSUBSCRIPT italic_y italic_a italic_w end_POSTSUBSCRIPT =min(kcable,τmotoryawRcapstan)absentsubscript𝑘𝑐𝑎𝑏𝑙𝑒superscriptsubscript𝜏𝑚𝑜𝑡𝑜𝑟𝑦𝑎𝑤subscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛\displaystyle=\min({k_{cable}},\frac{{\tau_{motor}^{yaw}}}{{{R_{capstan}}}})= roman_min ( italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT , divide start_ARG italic_τ start_POSTSUBSCRIPT italic_m italic_o italic_t italic_o italic_r end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_y italic_a italic_w end_POSTSUPERSCRIPT end_ARG start_ARG italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT end_ARG ) (25)

Similarly, the joint stiffness for the 2-dof part when both tendons are engaged can be calculated as

kwrist2dofsubscript𝑘𝑤𝑟𝑖𝑠𝑡2𝑑𝑜𝑓\displaystyle k_{wrist-2dof}italic_k start_POSTSUBSCRIPT italic_w italic_r italic_i italic_s italic_t - 2 italic_d italic_o italic_f end_POSTSUBSCRIPT =12(2Nwwcos(θ/2)cos(φ))2kcableabsent12superscript2subscript𝑁𝑤𝑤𝜃2𝜑2subscript𝑘𝑐𝑎𝑏𝑙𝑒\displaystyle=\frac{1}{2}\left(2N_{w}w\cos(\theta/2)\cos(\varphi)\right)^{2}k_% {cable}= divide start_ARG 1 end_ARG start_ARG 2 end_ARG ( 2 italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT italic_w roman_cos ( italic_θ / 2 ) roman_cos ( italic_φ ) ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT
+12(2Nwwcos(θ/2)sin(φ))2kcable12superscript2subscript𝑁𝑤𝑤𝜃2𝜑2subscript𝑘𝑐𝑎𝑏𝑙𝑒\displaystyle+\frac{1}{2}\left(2N_{w}w\cos(\theta/2)\sin(\varphi)\right)^{2}k_% {cable}+ divide start_ARG 1 end_ARG start_ARG 2 end_ARG ( 2 italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT italic_w roman_cos ( italic_θ / 2 ) roman_sin ( italic_φ ) ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT
=2Nw2w2cos2(θ/2)kcableabsent2superscriptsubscript𝑁𝑤2superscript𝑤2superscript2𝜃2subscript𝑘𝑐𝑎𝑏𝑙𝑒\displaystyle=2N_{w}^{2}w^{2}\cos^{2}(\theta/2)k_{cable}= 2 italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT roman_cos start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ / 2 ) italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT (26)

A capstan with a radius of Rcapstanrollsuperscriptsubscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛𝑟𝑜𝑙𝑙R_{capstan}^{roll}italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r italic_o italic_l italic_l end_POSTSUPERSCRIPT is used to control the motion of the wrist joint in the roll direction, rather than to amplify tendon tension. Likewise, we can calculate the stiffness and output torque based on a planetary gear reducer with a gear ratio Nrsubscript𝑁𝑟N_{r}italic_N start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT as

τwristroll=NrRcapstanrollΔT;s.tΔT=min(kcable,τmotorelbowRcapstan)kwristroll=2(NrRcapstanroll)2kcableformulae-sequencesubscript𝜏𝑤𝑟𝑖𝑠𝑡𝑟𝑜𝑙𝑙subscript𝑁𝑟superscriptsubscript𝑅𝑐𝑎𝑝𝑠𝑟𝑜𝑙𝑙Δ𝑇𝑠𝑡Δ𝑇subscript𝑘𝑐𝑎𝑏𝑙𝑒superscriptsubscript𝜏𝑚𝑜𝑡𝑜𝑟𝑒𝑙𝑏𝑜𝑤subscript𝑅𝑐𝑎𝑝𝑠subscript𝑘𝑤𝑟𝑖𝑠𝑡𝑟𝑜𝑙𝑙2superscriptsubscript𝑁𝑟superscriptsubscript𝑅𝑐𝑎𝑝𝑠𝑟𝑜𝑙𝑙2subscript𝑘𝑐𝑎𝑏𝑙𝑒\begin{split}{\tau_{wrist-roll}}&={N_{r}}R_{caps\tan}^{roll}\Delta T;{\rm{}}s.% t{\rm{}}\Delta T=\min({k_{cable}},\frac{{\tau_{motor}^{elbow}}}{{{R_{caps\tan}% }}})\\ {k_{wrist-roll}}&=2{\left({{N_{r}}R_{caps\tan}^{roll}}\right)^{2}}{k_{cable}}% \end{split}start_ROW start_CELL italic_τ start_POSTSUBSCRIPT italic_w italic_r italic_i italic_s italic_t - italic_r italic_o italic_l italic_l end_POSTSUBSCRIPT end_CELL start_CELL = italic_N start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s roman_tan end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r italic_o italic_l italic_l end_POSTSUPERSCRIPT roman_Δ italic_T ; italic_s . italic_t roman_Δ italic_T = roman_min ( italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT , divide start_ARG italic_τ start_POSTSUBSCRIPT italic_m italic_o italic_t italic_o italic_r end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_e italic_l italic_b italic_o italic_w end_POSTSUPERSCRIPT end_ARG start_ARG italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s roman_tan end_POSTSUBSCRIPT end_ARG ) end_CELL end_ROW start_ROW start_CELL italic_k start_POSTSUBSCRIPT italic_w italic_r italic_i italic_s italic_t - italic_r italic_o italic_l italic_l end_POSTSUBSCRIPT end_CELL start_CELL = 2 ( italic_N start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT italic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s roman_tan end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r italic_o italic_l italic_l end_POSTSUPERSCRIPT ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_k start_POSTSUBSCRIPT italic_c italic_a italic_b italic_l italic_e end_POSTSUBSCRIPT end_CELL end_ROW (27)

From Equ.(25) to Equ.(27), it’s evident that increasing Nwsubscript𝑁𝑤N_{w}italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT and w𝑤witalic_w boosts the 2-DOF wrist joint’s output torque and stiffness. Increasing the gear ratio Nrsubscript𝑁𝑟N_{r}italic_N start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT improves the output torque and stiffness in the roll direction. Given the requirements for aerial grasping, the torque needed in pitch and yaw motions significantly exceeds that in the roll direction. In the design of the elbow joint, we have chosen Nw=4subscript𝑁𝑤4N_{w}=4italic_N start_POSTSUBSCRIPT italic_w end_POSTSUBSCRIPT = 4, w=40mm𝑤40𝑚𝑚w=40mmitalic_w = 40 italic_m italic_m, Nr=5subscript𝑁𝑟5N_{r}=5italic_N start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT = 5, Rcapstan=11mmsubscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛11𝑚𝑚R_{capstan}=11mmitalic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT = 11 italic_m italic_m, and Rcapstanroll=25mmsuperscriptsubscript𝑅𝑐𝑎𝑝𝑠𝑡𝑎𝑛𝑟𝑜𝑙𝑙25𝑚𝑚R_{capstan}^{roll}=25mmitalic_R start_POSTSUBSCRIPT italic_c italic_a italic_p italic_s italic_t italic_a italic_n end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r italic_o italic_l italic_l end_POSTSUPERSCRIPT = 25 italic_m italic_m.

Referring to Equ.(27), with Nr=1subscript𝑁𝑟1N_{r}=1italic_N start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT = 1, the output torque and stiffness expressions for the traditional cable-roller driven manipulator can be similarly derived. By comparing with Equ.(19),(24),(25),(26), it is clear that the TAT mechanism effectively increases the output torque and output stiffness.

5 Simulation Analysis

Refer to caption
Figure 12: Semi-physical simulation of ATDM

Note:JPG format, 1-column fitting image

Table 3: Mass & Inertia of UAV and Each Link of ATDM
Items Mass (kg)kg\left(\text{kg}\right)( kg ) Inertial (kgm2)kgsuperscriptm2\left(\text{kg}\cdot\text{m}^{2}\right)( kg ⋅ m start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT )
UAV 2.711 diag(1.1101,1.1101,2.2101)diag1.1superscript1011.1superscript1012.2superscript101\text{diag}\left(1.1\cdot 10^{-1},1.1\cdot 10^{-1},2.2\cdot 10^{-1}\right)diag ( 1.1 ⋅ 10 start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT , 1.1 ⋅ 10 start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT , 2.2 ⋅ 10 start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT )
Base 1.899 diag(1.1102,1.6102,8.5103)diag1.1superscript1021.6superscript1028.5superscript103\text{diag}\left(1.1\cdot 10^{-2},1.6\cdot 10^{-2},8.5\cdot 10^{-3}\right)diag ( 1.1 ⋅ 10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT , 1.6 ⋅ 10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT , 8.5 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT )
Joint1 2.351022.35superscript1022.35\cdot 10^{-2}2.35 ⋅ 10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT diag(2.2105,2.4105,1.5106)diag2.2superscript1052.4superscript1051.5superscript106\text{diag}\left(2.2\cdot 10^{-5},2.4\cdot 10^{-5},1.5\cdot 10^{-6}\right)diag ( 2.2 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 2.4 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 1.5 ⋅ 10 start_POSTSUPERSCRIPT - 6 end_POSTSUPERSCRIPT )
Joint2 5.361015.36superscript1015.36\cdot 10^{-1}5.36 ⋅ 10 start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT diag(6.2103,6.4103,5.1104)diag6.2superscript1036.4superscript1035.1superscript104\text{diag}\left(6.2\cdot 10^{-3},6.4\cdot 10^{-3},5.1\cdot 10^{-4}\right)diag ( 6.2 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT , 6.4 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT , 5.1 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT )
Joint3 1.111031.11superscript1031.11\cdot 10^{-3}1.11 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT diag(1.7109,1.7109,2.9109)diag1.7superscript1091.7superscript1092.9superscript109\text{diag}\left(1.7\cdot 10^{-9},1.7\cdot 10^{-9},2.9\cdot 10^{-9}\right)diag ( 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 9 end_POSTSUPERSCRIPT , 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 9 end_POSTSUPERSCRIPT , 2.9 ⋅ 10 start_POSTSUPERSCRIPT - 9 end_POSTSUPERSCRIPT )
Joint4 2.41022.4superscript1022.4\cdot 10^{-2}2.4 ⋅ 10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT diag(1.7105,1.7105,4.3106)diag1.7superscript1051.7superscript1054.3superscript106\text{diag}\left(1.7\cdot 10^{-5},1.7\cdot 10^{-5},4.3\cdot 10^{-6}\right)diag ( 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 4.3 ⋅ 10 start_POSTSUPERSCRIPT - 6 end_POSTSUPERSCRIPT )
Joint5 1.111031.11superscript1031.11\cdot 10^{-3}1.11 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT diag(1.7109,1.7109,2.9109)diag1.7superscript1091.7superscript1092.9superscript109\text{diag}\left(1.7\cdot 10^{-9},1.7\cdot 10^{-9},2.9\cdot 10^{-9}\right)diag ( 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 9 end_POSTSUPERSCRIPT , 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 9 end_POSTSUPERSCRIPT , 2.9 ⋅ 10 start_POSTSUPERSCRIPT - 9 end_POSTSUPERSCRIPT )
Joint6 6.261026.26superscript1026.26\cdot 10^{-2}6.26 ⋅ 10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT diag(6.7105,6.7105,1.0104)diag6.7superscript1056.7superscript1051.0superscript104\text{diag}\left(6.7\cdot 10^{-5},6.7\cdot 10^{-5},1.0\cdot 10^{-4}\right)diag ( 6.7 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 6.7 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 1.0 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT )
Joint7 1.701011.70superscript1011.70\cdot 10^{-1}1.70 ⋅ 10 start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT diag(3.0104,6.3104,5.8104)diag3.0superscript1046.3superscript1045.8superscript104\text{diag}\left(3.0\cdot 10^{-4},6.3\cdot 10^{-4},5.8\cdot 10^{-4}\right)diag ( 3.0 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT , 6.3 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT , 5.8 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT )
QDD-NE30-36 2.51012.5superscript1012.5\cdot 10^{-1}2.5 ⋅ 10 start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT diag(1.7104,1.7104,1.2104)diag1.7superscript1041.7superscript1041.2superscript104\text{diag}\left(1.7\cdot 10^{-4},1.7\cdot 10^{-4},1.2\cdot 10^{-4}\right)diag ( 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT , 1.7 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT , 1.2 ⋅ 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT )
XM430-W350 8.01028.0superscript1028.0\cdot 10^{-2}8.0 ⋅ 10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT diag(2.2105,1.3105,1.9105)diag2.2superscript1051.3superscript1051.9superscript105\text{diag}\left(2.2\cdot 10^{-5},1.3\cdot 10^{-5},1.9\cdot 10^{-5}\right)diag ( 2.2 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 1.3 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT , 1.9 ⋅ 10 start_POSTSUPERSCRIPT - 5 end_POSTSUPERSCRIPT )

To validate the effectiveness of the proposed ATDM in decreasing coupling disturbance during motion compared to traditional serial manipulators, we established a semi-physical simulation environment using Simscape, which provides facilitates multi-body dynamic simulations for the ATDM, as presented in Fig. (12).

Refer to caption
Refer to caption
Refer to caption
Refer to caption
Refer to caption
Refer to caption
Figure 13: Simulation result.(a)Force of coupling disturbance under wide-range of rapid movement.(b)Torque of coupling disturbance under wide-range of rapid movement.(c)(c)Position deviation of UAV under wrist joint motion.(d)Attitude deviation of UAV under wrist joint motion.(e)Position deviation of UAV under wide-range of rapid movement.(f)Attitude deviation of UAV under wide-range of rapid movement

Note:PDF format, 1-column fitting image

For a comparative analysis with the serial manipulator, the mass and inertia of actuators for each joint and the end-effector are allocated at the COM of the preceding link. This is a conservative approach in contrast to allocations at the joints. The mass, length, and inertia parameters for the AMS are outlined in Table 3. Where the parameters of the base have taken into account the parameters of the actuators of both manipulator and end-effector.Simulations were performed under three working conditions.

5.1 Coupling Disturbance Forces and Torques

Using the coupling disturbance model from section 2.2, we compare the disturbances on the UAV from both manipulator types. Under this condition, once the AMS reaches the target location, the UAV’s movement is restricted. The manipulator’s 1-DOF elbow joint performs sinusoidal oscillations with an amplitude of π/2𝜋2\pi/2italic_π / 2 and a period of 5 seconds, while the wrist joint angles also oscillate sinusoidally with an amplitude of π/2𝜋2\pi/2italic_π / 2 and periods of 10 seconds. The results of these simulations are depicted in Fig.(13) and Fig.(13).

To evaluate the magnitude of the disturbance force and moment during the simulation time, we introduce two metrics: mean absolute variable (MAV) and root mean square variable (RMSV). The expressions for these metrics are:

MAV=1ni=1n|yi|MAV1𝑛superscriptsubscript𝑖1𝑛subscript𝑦𝑖\text{MAV}=\frac{1}{n}\sum_{i=1}^{n}\left|y_{i}\right|MAV = divide start_ARG 1 end_ARG start_ARG italic_n end_ARG ∑ start_POSTSUBSCRIPT italic_i = 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_n end_POSTSUPERSCRIPT | italic_y start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT | (28)
RMSV=1ni=1n(yi)2RMSV1𝑛superscriptsubscript𝑖1𝑛superscriptsubscript𝑦𝑖2\text{RMSV}=\sqrt{\frac{1}{n}\sum_{i=1}^{n}(y_{i})^{2}}RMSV = square-root start_ARG divide start_ARG 1 end_ARG start_ARG italic_n end_ARG ∑ start_POSTSUBSCRIPT italic_i = 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_n end_POSTSUPERSCRIPT ( italic_y start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG (29)

Table 4 presents a comparison of the coupling disturbance for both manipulator types, using MAV and RMSV as metrics.

Table 4: Comparison of coupling disturbance forces and torques
Items MAV:ATDM/serial RMSV:ATDM/serial
Fdissubscript𝐹disF_{\text{dis}}italic_F start_POSTSUBSCRIPT dis end_POSTSUBSCRIPT 0.5548 0.5591
τdissubscript𝜏dis\tau_{\text{dis}}italic_τ start_POSTSUBSCRIPT dis end_POSTSUBSCRIPT 0.4843 0.4757

5.2 Flexible Wrist Movement of Manipulator in AMS Hovering State

In this scenario, once the AMS reaches its target position, it remains in a hovering state. The manipulator’s 3-DOF wrist joint is subjected to sinusoidal oscillations, with each joint oscillating with an amplitude of π/2𝜋2\pi/2italic_π / 2 and a period of 10 seconds.

To analyze the effects of different manipulators on the AMS system, a robust controller, as detailed in [22], is utilized. The outcomes of these simulations are illustrated in Figures 13 and 13.

Consistent with the previous section, we employ the same metrics to evaluate the impact of the two manipulator types on the AMS’s positional and attitudinal stability during fixed-point hovering. The results are summarized in Table 5.

Table 5: Comparison of pose changes during AMS hovering with wrist motion
Items MAV:ATDM/serial RMSV:ATDM/serial
Position 0.4244 0.4215
Attitude 0.5017 0.5044

5.3 Wide-Range Rapid Movement of Manipulator in AMS Hovering State

In this scenario, utilizing the same controller as in the second working condition, the AMS, upon reaching its desired position, remains in a hovering state. The manipulator operates similarly to the first working condition. The results of these simulations are depicted in Figures 13 and 13.

Table 6: Comparison of pose changes during AMS hovering with wide-range rapid manipulator movement
Items MAV:ATDM/serial RMSV:ATDM/serial
Position 0.3738 0.3644
Attitude 0.4760 0.4884

Consistent with the previous sections, we evaluate the impact of both the ATDM and the serial manipulator on the AMS’s stability. The results are summarized in Table 6.

5.4 Summary and Conclusions

Upon reviewing Tables 4, 5, and 6, it becomes clear that modifying the actuator distribution in the tendon-driven manipulator can significantly reduce the coupling disturbance within the AMS system. This reduction is particularly evident during high-speed, wide-range movements of the manipulator. It is noteworthy that in the semi-physical simulation system, a rather conservative approach was adopted by assigning the physical properties of the actuator to the center of mass of the preceding link. This inevitably results in less coupling disturbance compared to the real-world scenario where the actuator is located at the joint in a serial manipulator. This further corroborates the significant improvement demonstrated by the proposed ATDM system in minimizing coupling interference, as opposed to the traditional AMS system.

6 Conclusion

To address the challenges of load, stiffness, and coupling disturbance in AMS, this study pivots towards a groundbreaking structural solution.

The paper presents a novel AMS equipped with a 4-DOF anthropomorphic tendon-driven manipulator. The design process involved the utilization of TAT structures for the elbow and wrist joints, and the application of finite element analysis, topology, and lattice optimization to select materials and achieve weight reduction. The kinematics were established based on a 7-DOF manipulator with virtual coupling joints, and theoretical models were developed to analyze joint torques and stiffness.By leveraging the remote actuation of tendon-driven systems and through strategic actuator distribution combined with topology and lattice optimization, we achieved a moving component weight of 0.818 kg and a base weight of 1.899 kg. This design effectively minimizes coupling disturbance in the AMS, as validated through our simulation environment.

In future endeavors, considering ATDM’s adaptability for integrated waterproofing and electromagnetic interference shielding, we plan to deploy it for aerial operations in challenging environments.

Declaration of Competing Interest

The authors declare that they have no known competing financial interests or personal relationships that could have appeared to influence the work reported in this paper.

Acknowledgment

This work was supported partially by the National Natural Science Foundation of China (Grant No. 62273122), and Heilongjiang Natural Science Foundation (Grant No. YQ2023F009).

Data Availability

Data will be made available on request.

Appendix A Antiparallelogram Analysis

Refer to caption
Refer to caption
Refer to caption
Refer to caption
Figure 14: anti-parallelogram mechanism.(a)Anti-parallelogram mechanism (initial state).(b)Anti-parallelogram mechanism (Deflection state).(c)Approximation between circular rolling motion and elliptical rolling motion.(d)The error curve between ellipse and approximated circle

For planar motion, the antiparallelogram linkage can be designed such that the motion between the fixed platform and the moving platform resembles pure rolling on an approximate circular surface. The error of this is less than the machining error. Its fundamental principle is shown in Fig. (14).

The degree of freedom of the antiparallelogram mechanism was calculated using the screw theory. As illustrated, establish coordinate system OAXYsubscript𝑂𝐴𝑋𝑌O_{A-XY}italic_O start_POSTSUBSCRIPT italic_A - italic_X italic_Y end_POSTSUBSCRIPT at the midpoint of AC. Assume the coordinates of B and C are (a,b)𝑎𝑏(a,b)( italic_a , italic_b ) and (c,d)𝑐𝑑(c,d)( italic_c , italic_d ) respectively. Let the two branches of the antiparallelogram mechanism be LF and LS. The four revolute pairs on these two branches are 𝑺F1subscript𝑺𝐹1\bm{S}_{F1}bold_italic_S start_POSTSUBSCRIPT italic_F 1 end_POSTSUBSCRIPT, 𝑺F2subscript𝑺𝐹2\bm{S}_{F2}bold_italic_S start_POSTSUBSCRIPT italic_F 2 end_POSTSUBSCRIPT, 𝑺S1subscript𝑺𝑆1\bm{S}_{S1}bold_italic_S start_POSTSUBSCRIPT italic_S 1 end_POSTSUBSCRIPT, and 𝑺S2subscript𝑺𝑆2\bm{S}_{S2}bold_italic_S start_POSTSUBSCRIPT italic_S 2 end_POSTSUBSCRIPT. The motion twist systems of the two branches are

{𝑺F1=(001;0w0)𝑺F2=(001;ba0)casessubscript𝑺𝐹10010𝑤0missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionsubscript𝑺𝐹2001𝑏𝑎0missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpression\displaystyle\left\{{\begin{array}[]{*{20}{l}}{{\bm{S}_{F1}}=\left({\begin{% array}[]{*{20}{l}}0&0&{1;}&0&{-w}&0\end{array}}\right)}\\ {{\bm{S}_{F2}}=\left({\begin{array}[]{*{20}{l}}0&0&{1;}&{-b}&a&0\end{array}}% \right)}\end{array}}\right.{\rm{}}{ start_ARRAY start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_F 1 end_POSTSUBSCRIPT = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL 0 end_CELL start_CELL - italic_w end_CELL start_CELL 0 end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY ) end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_F 2 end_POSTSUBSCRIPT = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL - italic_b end_CELL start_CELL italic_a end_CELL start_CELL 0 end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY ) end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY (34)
{𝑺S1=(001;0w0)𝑺S2=(001;dc0)casessubscript𝑺𝑆10010𝑤0missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionsubscript𝑺𝑆2001𝑑𝑐0missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpression\displaystyle{\rm{}}\left\{{\begin{array}[]{*{20}{l}}{{\bm{S}_{S1}}=\left({% \begin{array}[]{*{20}{l}}0&0&{1;}&0&w&0\end{array}}\right)}\\ {{\bm{S}_{S2}}=\left({\begin{array}[]{*{20}{l}}0&0&{1;}&{-d}&c&0\end{array}}% \right)}\end{array}}\right.{ start_ARRAY start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_S 1 end_POSTSUBSCRIPT = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL 0 end_CELL start_CELL italic_w end_CELL start_CELL 0 end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY ) end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_S 2 end_POSTSUBSCRIPT = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL - italic_d end_CELL start_CELL italic_c end_CELL start_CELL 0 end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY ) end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY (39)

The reciprocal twist systems (constraint twist systems) for each are

{𝑺LF1r=(001;000)𝑺LF2r=(000;100)𝑺LF3r=(000;010)𝑺LF4r=((a+w)b10;00w)\displaystyle\left\{\begin{aligned} \bm{S}_{LF1}^{r}&=\left(\begin{array}[]{% cccccc}0&0&1;&0&0&0\end{array}\right)\\ \bm{S}_{LF2}^{r}&=\left(\begin{array}[]{cccccc}0&0&0;&1&0&0\end{array}\right)% \\ \bm{S}_{LF3}^{r}&=\left(\begin{array}[]{cccccc}0&0&0;&0&1&0\end{array}\right)% \\ \bm{S}_{LF4}^{r}&=\left(\begin{array}[]{cccccc}\frac{(a+w)}{b}&1&0;&0&0&w\end{% array}\right)\end{aligned}\right.{ start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_F 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_F 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 ; end_CELL start_CELL 1 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_F 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 ; end_CELL start_CELL 0 end_CELL start_CELL 1 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_F 4 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL divide start_ARG ( italic_a + italic_w ) end_ARG start_ARG italic_b end_ARG end_CELL start_CELL 1 end_CELL start_CELL 0 ; end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_w end_CELL end_ROW end_ARRAY ) end_CELL end_ROW (40)
{𝑺LS1r=(001;000)𝑺LS2r=(000;100)𝑺LS3r=(000;010)𝑺LS4r=((cw)d10;00w)\displaystyle\left\{\begin{aligned} \bm{S}_{LS1}^{r}&=\left(\begin{array}[]{% cccccc}0&0&1;&0&0&0\end{array}\right)\\ \bm{S}_{LS2}^{r}&=\left(\begin{array}[]{cccccc}0&0&0;&1&0&0\end{array}\right)% \\ \bm{S}_{LS3}^{r}&=\left(\begin{array}[]{cccccc}0&0&0;&0&1&0\end{array}\right)% \\ \bm{S}_{LS4}^{r}&=\left(\begin{array}[]{cccccc}\frac{(c-w)}{d}&1&0;&0&0&{-w}% \end{array}\right)\end{aligned}\right.{ start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_S 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_S 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 ; end_CELL start_CELL 1 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_S 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 ; end_CELL start_CELL 0 end_CELL start_CELL 1 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT italic_L italic_S 4 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL divide start_ARG ( italic_c - italic_w ) end_ARG start_ARG italic_d end_ARG end_CELL start_CELL 1 end_CELL start_CELL 0 ; end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL - italic_w end_CELL end_ROW end_ARRAY ) end_CELL end_ROW (41)

The linear sum of Equ.(40) and Equ.(41) is

{𝑺1r=(001;000),𝑺2r=(000;100),𝑺3r=(000;010),𝑺4r=((a+w)b10;00w),𝑺5r=((cw)d10;00w)\left\{\begin{aligned} \bm{S}_{1}^{r}&=\left(\begin{array}[]{cccccc}0&0&1;&0&0% &0\end{array}\right),\\ \bm{S}_{2}^{r}&=\left(\begin{array}[]{cccccc}0&0&0;&1&0&0\end{array}\right),\\ \bm{S}_{3}^{r}&=\left(\begin{array}[]{cccccc}0&0&0;&0&1&0\end{array}\right),\\ \bm{S}_{4}^{r}&=\left(\begin{array}[]{cccccc}\frac{(a+w)}{b}&1&0;&0&0&w\end{% array}\right),\\ \bm{S}_{5}^{r}&=\left(\begin{array}[]{cccccc}\frac{(c-w)}{d}&1&0;&0&0&{-w}\end% {array}\right)\end{aligned}\right.{ start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) , end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 ; end_CELL start_CELL 1 end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) , end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 0 ; end_CELL start_CELL 0 end_CELL start_CELL 1 end_CELL start_CELL 0 end_CELL end_ROW end_ARRAY ) , end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT 4 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL divide start_ARG ( italic_a + italic_w ) end_ARG start_ARG italic_b end_ARG end_CELL start_CELL 1 end_CELL start_CELL 0 ; end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_w end_CELL end_ROW end_ARRAY ) , end_CELL end_ROW start_ROW start_CELL bold_italic_S start_POSTSUBSCRIPT 5 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_r end_POSTSUPERSCRIPT end_CELL start_CELL = ( start_ARRAY start_ROW start_CELL divide start_ARG ( italic_c - italic_w ) end_ARG start_ARG italic_d end_ARG end_CELL start_CELL 1 end_CELL start_CELL 0 ; end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL - italic_w end_CELL end_ROW end_ARRAY ) end_CELL end_ROW (42)

The motion twist system of the moving platform can be determined by finding the reciprocal twist system of Equ. (42) as

𝑺M=(001;2wbdbcwbadwdw2bwbcwadw2dbcwbadwd0)superscript𝑺𝑀0012𝑤𝑏𝑑𝑏𝑐𝑤𝑏𝑎𝑑𝑤𝑑superscript𝑤2𝑏𝑤𝑏𝑐𝑤𝑎𝑑superscript𝑤2𝑑𝑏𝑐𝑤𝑏𝑎𝑑𝑤𝑑0missing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpressionmissing-subexpression{\bm{S}^{M}}=\left({\begin{array}[]{*{20}{l}}0&0&{1;}&{\frac{{2wbd}}{{bc-wb-ad% -wd}}}&{\frac{{{w^{2}}b-wbc-wad-{w^{2}}d}}{{bc-wb-ad-wd}}}&0\end{array}}\right)bold_italic_S start_POSTSUPERSCRIPT italic_M end_POSTSUPERSCRIPT = ( start_ARRAY start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL 1 ; end_CELL start_CELL divide start_ARG 2 italic_w italic_b italic_d end_ARG start_ARG italic_b italic_c - italic_w italic_b - italic_a italic_d - italic_w italic_d end_ARG end_CELL start_CELL divide start_ARG italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_b - italic_w italic_b italic_c - italic_w italic_a italic_d - italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_d end_ARG start_ARG italic_b italic_c - italic_w italic_b - italic_a italic_d - italic_w italic_d end_ARG end_CELL start_CELL 0 end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL start_CELL end_CELL end_ROW end_ARRAY ) (43)

Clearly, the antiparallelogram mechanism is a 1-DOF joint. When the link lengths are set such that AB=CD=l𝑙litalic_l and AC=BD=2w2𝑤2w2 italic_w, the trajectory of the intersection point P can be described as an ellipse with A and C as its focus and l𝑙litalic_l as its major axis,which can be represented as

x2(l/2)2+(yh)2(l/2)2w2=1superscript𝑥2superscript𝑙22superscript𝑦2superscript𝑙22superscript𝑤21\frac{x^{2}}{(l/2)^{2}}+\frac{(y-h)^{2}}{(l/2)^{2}-w^{2}}=1divide start_ARG italic_x start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG ( italic_l / 2 ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + divide start_ARG ( italic_y - italic_h ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG ( italic_l / 2 ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG = 1 (44)

By satisfying the link length constraints, substituting the dual part of the motion twist of the moving platform into Equ.(44) satisfies the equation. When the parameters of the ellipse are chosen appropriately, over a certain range of motion, the elliptical arc can approximate a segment of a circular arc. To better compare the error during the rotation process, a polar coordinate system OCXYsubscript𝑂𝐶𝑋𝑌O_{C-XY}italic_O start_POSTSUBSCRIPT italic_C - italic_X italic_Y end_POSTSUBSCRIPT is established at the center of the desired circle with the vertical direction as the polar axis, as shown in Fig.(14). The polar radius of the ellipse can be expressed as:

re=hcos(θ)±h2cos2(θ)4(cos2(θ)l24w2+sin2(θ)l2)(4h2l24w21)4(cos2(θ)l24w2+sin2(θ)l2)subscript𝑟𝑒plus-or-minus𝜃superscript2superscript2𝜃4superscript2𝜃superscript𝑙24superscript𝑤2superscript2𝜃superscript𝑙24superscript2superscript𝑙24superscript𝑤214superscript2𝜃superscript𝑙24superscript𝑤2superscript2𝜃superscript𝑙2r_{e}=\frac{h\cos(\theta)\pm\sqrt{h^{2}\cos^{2}(\theta)-4\left(\frac{\cos^{2}(% \theta)}{l^{2}-4w^{2}}+\frac{\sin^{2}(\theta)}{l^{2}}\right)\left(\frac{4h^{2}% }{l^{2}-4w^{2}}-1\right)}}{4\left(\frac{\cos^{2}(\theta)}{l^{2}-4w^{2}}+\frac{% \sin^{2}(\theta)}{l^{2}}\right)}italic_r start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT = divide start_ARG italic_h roman_cos ( italic_θ ) ± square-root start_ARG italic_h start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT roman_cos start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ ) - 4 ( divide start_ARG roman_cos start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ ) end_ARG start_ARG italic_l start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - 4 italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + divide start_ARG roman_sin start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ ) end_ARG start_ARG italic_l start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG ) ( divide start_ARG 4 italic_h start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_l start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - 4 italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG - 1 ) end_ARG end_ARG start_ARG 4 ( divide start_ARG roman_cos start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ ) end_ARG start_ARG italic_l start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - 4 italic_w start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + divide start_ARG roman_sin start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_θ ) end_ARG start_ARG italic_l start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG ) end_ARG (45)

Aim to use the segment of the ellipse where π/4<θ<π/4𝜋4𝜃𝜋4-\pi/4<\theta<\pi/4- italic_π / 4 < italic_θ < italic_π / 4 to approximate a segment of a circle with radius rcsubscript𝑟𝑐r_{c}italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT, we calculate this using the following constraint optimization approach:

min(π4π4|re(θ)rc(θ)|𝑑θ),s.trc=40;w=12;formulae-sequencesuperscriptsubscript𝜋4𝜋4subscript𝑟𝑒𝜃subscript𝑟𝑐𝜃differential-d𝜃𝑠𝑡subscript𝑟𝑐40𝑤12\min(\int_{-\frac{\pi}{4}}^{\frac{\pi}{4}}{\left|{{r_{e}}\left(\theta\right)-{% r_{c}}\left(\theta\right)}\right|}d\theta),\quad s.t\quad{r_{c}}=40;w=12;roman_min ( ∫ start_POSTSUBSCRIPT - divide start_ARG italic_π end_ARG start_ARG 4 end_ARG end_POSTSUBSCRIPT start_POSTSUPERSCRIPT divide start_ARG italic_π end_ARG start_ARG 4 end_ARG end_POSTSUPERSCRIPT | italic_r start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT ( italic_θ ) - italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT ( italic_θ ) | italic_d italic_θ ) , italic_s . italic_t italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT = 40 ; italic_w = 12 ; (46)

Upon calculation, with the ellipse’s focal length set at 24242424 and the desired circle’s radius approximated at 40404040, the values h=3.433.43h=3.43italic_h = 3.43 and l=76.95𝑙76.95l=76.95italic_l = 76.95 yield the minimum approximation error. As shown in Fig.(14), the fitting error across the entire motion space is less than 0.05mm, which is below the machining error. Due to the characteristic of pure rolling, the angular rotation range between the fixed platform and the moving platform is:[π2,π2]𝜋2𝜋2[-\frac{\pi}{2},\frac{\pi}{2}][ - divide start_ARG italic_π end_ARG start_ARG 2 end_ARG , divide start_ARG italic_π end_ARG start_ARG 2 end_ARG ].

Appendix B Movement Capabilities of Quaternion Joint

The quaternion joint, as theoretically analyzed, is completely constrained. However, experimental studies related to it have showcased its superior performance when functioning as a 2-DOF mechanism.

Refer to caption
Refer to caption
Refer to caption
Figure 15: Finite element analysis of quaternion joint.(a) Finite element model.(b)Displacement contour plot(mm).(c)Stress contour plot(Mpa)

As depicted in Fig. 15, a finite element model was developed in Abaqus (shown in Fig. 15). In this model, each pin in the structure was designated as a connector, with the connection category set to ”hinge”. Aluminum alloy 7075 was chosen as the material, and a general contact interaction was established. A small enough force of 0.01N was exerted on the moving platform. The explicit dynamics analysis results, as shown in Fig. 15, indicate the quaternion joint’s capability for a wide range of motion. While there is stress concentration evident in the structure, as seen in Fig. 15, it remains unyielded. This attests to the mechanism’s ability to move even under stress and micro-deformation conditions when subjected to minimal force.

References

  • [1] F. Song, Z. Li, S. Yang, J. J. Rodriguez-Andina, Anti-disturbance compensation for quadrotor close crossing flight based on deep reinforcement learning, IEEE Transactions on Industrial Electronics 70 (3) (2022) 3013–3023.
  • [2] G. S. Ramos, M. F. Pinto, F. O. Coelho, L. M. Honório, D. B. Haddad, Hybrid methodology based on computational vision and sensor fusion for assisting autonomous uav on offshore messenger cable transfer operation, Robotica 40 (8) (2022) 2786–2814.
  • [3] F. Song, Z. Li, X. Yu, A feedforward quadrotor disturbance rejection method for visually identified gust sources based on transfer reinforcement learning, IEEE Transactions on Aerospace and Electronic Systems (2023) 1–11.
  • [4] H. Bonyan Khamseh, F. Janabi-Sharifi, A. Abdessameud, Aerial manipulation—a literature survey, Robotics and Autonomous Systems 107 (2018) 221–235.
  • [5] G. Zhang, Y. He, B. Dai, F. Gu, L. Yang, J. Han, G. Liu, J. Qi, Grasp a moving target from the air: System & control of an aerial manipulator, in: 2018 IEEE International Conference on Robotics and Automation (ICRA), IEEE, 2018, pp. 1681–1687.
  • [6] J. Acosta, C. De Cos, A. Ollero, Accurate control of aerial manipulators outdoors. a reliable and self-coordinated nonlinear approach, Aerospace Science and Technology 99 (2020) 105731.
  • [7] M. Xu, S. Huang, R. He, D. Yu, H. Wang, Aerial shooting manipulator for distant grasping, IEEE Robotics and Automation Letters 8 (4) (2023) 1991–1998.
  • [8] W. Dong, Z. Ma, X. Sheng, X. Zhu, Centimeter-level aerial assembly achieved with manipulating condition inference and compliance, IEEE/ASME Transactions on Mechatronics 27 (3) (2021) 1660–1671.
  • [9] Y. Sun, Z. Jing, P. Dong, J. Huang, W. Chen, H. Leung, A switchable unmanned aerial manipulator system for window-cleaning robot installation, IEEE Robotics and Automation Letters 6 (2) (2021) 3483–3490.
  • [10] A. Suarez, A. Caballero, A. Garofano, P. J. Sanchez-Cuevas, G. Heredia, A. Ollero, Aerial manipulator with rolling base for inspection of pipe arrays, IEEE Access 8 (2020) 162516–162532.
  • [11] J. Zeng, H. Zhong, Y. Wang, S. Fan, H. Zhang, Autonomous control design of an unmanned aerial manipulator for contact inspection, Robotica 41 (4) (2023) 1145–1158.
  • [12] T. Ikeda, S. Minamiyama, S. Yasui, K. Ohara, A. Ichikawa, S. Ashizawa, A. Okino, T. Oomichi, T. Fukuda, Stable camera position control of unmanned aerial vehicle with three-degree-of-freedom manipulator for visual test of bridge inspection, Journal of Field Robotics 36 (7) (2019) 1212–1221.
  • [13] W. R. Roderick, M. R. Cutkosky, D. Lentink, Bird-inspired dynamic grasping and perching in arboreal environments, Science Robotics 6 (61) (2021) eabj7562.
  • [14] A. McLaren, Z. Fitzgerald, G. Gao, M. Liarokapis, A passive closing, tendon driven, adaptive robot hand for ultra-fast, aerial grasping and perching, in: 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE, 2019, pp. 5602–5607.
  • [15] K. Bodie, M. Brunner, M. Pantic, S. Walser, P. Pfändler, U. Angst, R. Siegwart, J. Nieto, An omnidirectional aerial manipulation platform for contact-based inspection, in: Robotics: Science and Systems, 2019, pp. 1–9.
  • [16] A. Ollero, M. Tognon, A. Suarez, D. Lee, A. Franchi, Past, present, and future of aerial robotic manipulators, IEEE Transactions on Robotics 38 (1) (2021) 626–645.
  • [17] H. B. Khamseh, S. Ghorbani, F. Janabi-Sharifi, Unscented kalman filter state estimation for manipulating unmanned aerial vehicles, Aerospace Science and Technology 92 (2019) 446–463.
  • [18] Z. Samadikhoshkho, S. Ghorbani, F. Janabi-Sharifi, Vision-based reduced-order adaptive control of aerial continuum manipulation systems, Aerospace Science and Technology 121 (2022) 107322.
  • [19] H. Cao, Y. Wu, L. Wang, Adaptive nn motion control and predictive coordinate planning for aerial manipulators, Aerospace Science and Technology 126 (2022) 107607.
  • [20] S. A. Emami, A. Banazadeh, Simultaneous trajectory tracking and aerial manipulation using a multi-stage model predictive control, Aerospace Science and Technology 112 (2021) 106573.
  • [21] Y. Chen, J. Liang, Y. Wu, Z. Miao, H. Zhang, Y. Wang, Adaptive sliding-mode disturbance observer-based finite-time control for unmanned aerial manipulator with prescribed performance, IEEE transactions on cybernetics 53 (5) (2022) 3263–3276.
  • [22] H. Cao, Y. Li, C. Liu, S. Zhao, Eso-based robust and high-precision tracking control for aerial manipulation, IEEE Transactions on Automation Science and Engineering (2023).
  • [23] H. Li, Z. Li, X. Zheng, J. Liu, Adaptive neural network backstepping control method for aerial manipulator based on variable inertia parameter modeling, arXiv preprint arXiv:2212.04250 (2022).
  • [24] G. Zhang, Y. He, B. Dai, F. Gu, J. Han, G. Liu, Robust control of an aerial manipulator based on a variable inertia parameters model, IEEE Transactions on Industrial Electronics 67 (11) (2020) 9515–9525.
  • [25] A. Mörtl, M. Lawitzky, A. Kucukyilmaz, M. Sezgin, C. Basdogan, S. Hirche, The role of roles: Physical cooperation between humans and robots, The International Journal of Robotics Research 31 (13) (2012) 1656–1674.
  • [26] Y. Chen, X. Zhang, Y. Huang, Y. Wu, J. Ota, Kinematics optimization of a novel 7-dof redundant manipulator, Robotics and Autonomous Systems 163 (2023) 104377.
  • [27] S. Sefati, R. Hegeman, F. Alambeigi, I. Iordachita, P. Kazanzides, H. Khanuja, R. H. Taylor, M. Armand, A surgical robotic system for treatment of pelvic osteolysis using an fbg-equipped continuum manipulator and flexible instruments, IEEE/ASME Transactions on Mechatronics 26 (1) (2020) 369–380.
  • [28] Y.-J. Kim, Anthropomorphic low-inertia high-stiffness manipulator for high-speed safe interaction, IEEE Transactions on robotics 33 (6) (2017) 1358–1374.
  • [29] R. Ozawa, H. Kobayashi, K. Hashirii, Analysis, classification, and design of tendon-driven mechanisms, IEEE transactions on robotics 30 (2) (2013) 396–410.
  • [30] W. Li, P. Chen, D. Bai, X. Zhu, S. Togo, H. Yokoi, Y. Jiang, Modularization of 2-and 3-dof coupled tendon-driven joints, IEEE Transactions on Robotics 37 (3) (2020) 905–917.
  • [31] R. Dou, S. Yu, W. Li, P. Chen, P. Xia, F. Zhai, H. Yokoi, Y. Jiang, Inverse kinematics for a 7-dof humanoid robotic arm with joint limit and end pose coupling, Mechanism and Machine Theory 169 (2022) 104637.
  • [32] J. L. Chien, C. Leong, J. Liu, S. Foong, Design and control of an aerial-ground tethered tendon-driven continuum robot with hybrid routing, Robotics and Autonomous Systems 161 (2023) 104344.
  • [33] X. Gu, H. Ren, A survey of transoral robotic mechanisms: Distal dexterity, variable stiffness, and triangulation, Cyborg and Bionic Systems 4 (2023) 0007.
  • [34] J. H. Kaouk, R. J. Stein, G.-P. Haber, Atlas of Laparoscopic and Robotic Single Site Surgery, Humana Press, 2017.
  • [35] M. B. Hong, Y.-H. Jo, Design of a novel 4-dof wrist-type surgical instrument with enhanced rigidity and dexterity, IEEE/ASME transactions on mechatronics 19 (2) (2013) 500–511.
  • [36] Y. Wang, S. Li, D. Wang, F. Ju, B. Chen, H. Wu, Adaptive time-delay control for cable-driven manipulators with enhanced nonsingular fast terminal sliding mode, IEEE Transactions on Industrial Electronics 68 (3) (2020) 2356–2367.
  • [37] W. Li, Y. Wang, S. Togo, H. Yokoi, Y. Jiang, Development of a humanoid shoulder based on 3-motor 3 degrees-of-freedom coupled tendon-driven joint module, IEEE Robotics and Automation Letters 6 (2) (2021) 1105–1111.
  • [38] Y.-J. Kim, J.-I. Kim, W. Jang, Quaternion joint: Dexterous 3-dof joint representing quaternion motion for high-speed safe interaction, in: 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE, 2018, pp. 935–942.
  • [39] S. A. Nejat, N. Changizi, M. Tootkaboni, A. Asadpoure, Topology optimization of lightweight periodic lattices under stiffness and stability constraints, International Journal of Mechanical Sciences 209 (2021) 106727.
  • [40] D. Li, R. Qin, J. Xu, J. Zhou, B. Chen, Topology optimization of thin-walled tubes filled with lattice structures, International Journal of Mechanical Sciences 227 (2022) 107457.
  • [41] A. M. Agur, A. F. Dalley, Grant’s atlas of anatomy, Lippincott Williams & Wilkins, 2009.
  • [42] K. Shikata, K. Masuya, T. Sugihara, Zero-dof 3-uu parallel mechanism that inclines largely in two directions, in: Proceedings of the 2014 JSME Conference on Robotics and Mechatronics, 2014.
  • [43] Z. Wang, M. Runzi, M. Gilchrist, H. Gong, Mechanical properties of high-performance plastic polyether-ether-ketone (peek) printed by fused deposition modeling, in: 2021 International Solid Freeform Fabrication Symposium, University of Texas at Austin, 2021.
  • [44] A. M. Dollar, R. D. Howe, The highly adaptive sdm hand: Design and performance evaluation, The international journal of robotics research 29 (5) (2010) 585–597.
  • [45] M. Fanni, A. Khalifa, A new 6-dof quadrotor manipulation system: Design, kinematics, dynamics, and control, IEEE/ASME Transactions On Mechatronics 22 (3) (2017) 1315–1326.
  • [46] I. Hussain, M. Malvezzi, D. Gan, Z. Iqbal, L. Seneviratne, D. Prattichizzo, F. Renda, Compliant gripper design, prototyping, and modeling using screw theory formulation, The International Journal of Robotics Research 40 (1) (2021) 55–71.
  • [47] W. Ruotolo, D. Brouwer, M. R. Cutkosky, From grasping to manipulation with gecko-inspired adhesives on a multifinger gripper, Science Robotics 6 (61) (2021) eabi9773.
  • [48] J. J. Craig, Introduction to Robotics: Mechanics and Control, Introduction to Robotics: Mechanics and Control, 1986.