高自由度（DoF）串联机械臂的快速发展要求使用快速、基于采样的运动规划器来处理高维空间。尽管快速探索随机树（RRT）等基于采样的规划器被广泛使用，但在机械臂的关节空间中进行规划却面临重大挑战，因为正向运动学是非可逆的。一个任务空间的末端执行器姿态可能对应多个配置空间状态，这为规划器创建了多臂老虎机问题。在复杂环境中，简单地选择错误的关节空间目标可能导致次优轨迹甚至无法找到可行的计划。为了解决这一规划问题，我们提出了Many-RRT*，这是RRT*-Connect的扩展，能够同时规划多个目标。通过生成多个逆运动学（IK）解决方案，并在同时生长单个起始树的同时，从这些目标配置生成独立的树，Many-RRT*确保不会浪费在次优IK解决方案上的计算努力。这种方法保持了鲁棒收敛性和渐近最优性。在不同机器人形态和多样障碍环境中的实验评估表明，Many-RRT*在相同运行时间内提供了质量更高的轨迹（成本降低了44.5%），并且成功率显著更高（100% vs. 下一最佳的1.6%），而不会牺牲运行时间性能。
英文摘要：
The rapid advancement of high degree-of-freedom (DoF) serial manipulators necessitates the use of swift, sampling-based motion planners for high-dimensional spaces. While sampling-based planners like the Rapidly-Exploring Random Tree (RRT) are widely used, planning in the manipulator's joint space presents significant challenges due to non-invertible forward kinematics. A single task-space end-effector pose can correspond to multiple configuration-space states, creating a multi-arm bandit problem for the planner. In complex environments, simply choosing the wrong joint space goal can result in suboptimal trajectories or even failure to find a viable plan. To address this planning problem, we propose Many-RRT*: an extension of RRT*-Connect that plans to multiple goals in parallel. By generating multiple IK solutions and growing independent trees from these goal configurations simultaneously alongside a single start tree, Many-RRT* ensures that computational effort is not wasted on suboptimal IK solutions. This approach maintains robust convergence and asymptotic optimality. Experimental evaluations across robot morphologies and diverse obstacle environments demonstrate that Many-RRT* provides higher quality trajectories (44.5% lower cost in the same runtime) with a significantly higher success rate (100% vs. the next best of 1.6%) than previous RRT iterations without compromising on runtime performance.
DK-RRT: Deep Koopman RRT for Collision-Aware Motion Planning of Space Manipulators in Dynamic Debris Environments
University of California, Irvine（加州大学尔湾分校）；Illinois Institute of Technology（伊利诺伊理工学院）；University of Illinois Urbana-Champaign（伊利诺伊大学厄巴纳-香槟分校）；University of California, Davis（加州大学戴维斯分校）；University of California, Berkeley（加州大学伯克利分校）
Zhejiang University（浙江大学）；Shenzhen Sensetime Technology CO.,LTD（深圳商汤科技有限公司）；Shenzhen Institutes of Advanced Technology, Chinese Academy of Sciences（中国科学院深圳先进技术研究院）
Autonomous Underwater Vehicle-Manipulator systems (AUVMS) is a new tool for ocean exploration, the AUVMS path planning problem is addressed in this paper. AUVMS is a high dimension system with a large difference in inertia distribution, also it works in a complex environment with obstacles. By integrating the rapidly-exploring random tree(RRT) algorithm with the AUVMS kinematics model, the proposed RRTAUVMS algorithm could randomly sample in the configuration space(C-Space), and also grow the tree directly towards the workspace goal in the task space. The RRTAUVMS can also deal with the redund…
IMT Atlantique Bretagne Pays de la Loire（大西洋布列塔尼卢瓦尔河国家高等矿业电信学校）；Centre National de la Recherche Scientifique (CNRS)（法国国家科学研究中心）
The paper focuses on the redundancy resolution in kinematic control of a new type of serial manipulator composed of multiple tensegrity segments, which are moving in a multi-obstacle environment. The general problem is decomposed into two sub-problems, which deal with collision-free path planning for the robot end-effector and collision-free motion planning for the robot body. The first of them is solved via discrete dynamic programming, the second one is worked out using quadratic programming with mixed linear equality/nonequality constraints. Efficiency of the proposed technique is confirmed…
Kent Artificial Intelligence Laboratory（肯特人工智能实验室）
Apart from solving complicated problems that require a certain level of intelligence, fine-tuned deep neural networks can also create fast algorithms for slow, numerical tasks. In this paper, we introduce an improved version of [1]'s work, a fast, deep-learning framework capable of generating the full workspace of serial-link manipulators. The architecture consists of two neural networks: an estimation net that approximates the manipulator Jacobian, and a confidence net that measures the confidence of the approximation. We also introduce M3 (Manipulability Maps of Manipulators), a MATLAB robot…
This paper presents a kinematic definition of a serialized Stewart platform designed for autonomous in-space assembly called an Assembler. The Assemblers architecture describes problems inherent to the inverse kinematics of over-actuated mixed kinematic systems. This paper also presents a methodology for optimizing poses. In order to accomplish this with the Assembler system, an algorithm for finding a feasible solution to its inverse kinematics was developed with a wrapper for a nonlinear optimization algorithm designed to minimize the magnitude of forces incurred by each actuator. A simulate…
Institut de Recherche en Cybernétique de Nantes（南特控制论研究所）；École Centrale de Nantes（南特中央理工学院）
The aim of this paper is to characterize the notion of aspect in the workspace and in the joint space for parallel manipulators. In opposite to the serial manipulators, the parallel manipulators can admit not only multiple inverse kinematic solutions, but also multiple direct kinematic solutions. The notion of aspect introduced for serial manipulators in [Borrel 86], and redefined for parallel manipulators with only one inverse kinematic solution in [Wenger 1997], is redefined for general fully parallel manipulators. Two Jacobian matrices appear in the kinematic relations between the joint-rat…
FACTO: Function-space Adaptive Constrained Trajectory Optimization for Robotic Manipulators
J. Mike Walker ’66 Department of Mechanical Engineering, Texas A&M University（J. Mike Walker ’66 机械工程系，德克萨斯A&M大学）；Zachry Department of Civil and Environmental Engineering, Texas A&M University（Zachry 土木与环境工程系，德克萨斯A&M大学）
Laboratoire des Sciences du Numérique de Nantes（南特数字科学实验室）；University of Innsbruck（因斯布鲁克大学）
Cuspidal robots can travel from one inverse kinematic solution to another without meeting a singularity. The name cuspidal was coined based on the existence of a cusp point in the workspace of 3R serial robots. The existence of a cusp point was proved to be a necessary and sufficient condition for orthogonal robots to be cuspidal, but it was not possible to extend this condition to non-orthogonal robots. The goal of this paper is to prove that this condition stands for any generic 3R robot. This result would give the designer more flexibility. In the presented work, the geometrical interpretat…
Australian Centre for Robotic Vision（澳大利亚机器人视觉中心）；Queensland University of Technology（昆士兰科技大学）
The elementary transform sequence (ETS) provides a universal method of describing the kinematics of any serial-link manipulator. The ETS notation is intuitive and easy to understand, while avoiding the complexity and limitations of Denvit-Hartenberg frame assignment. In this paper, we describe a systematic method for computing the manipulator Jacobian and Hessian (differential kinematics) using the ETS notation. Differential kinematics have many applications including numerical inverse kinematics, resolved-rate motion control and manipulability motion control. Furthermore, we provide an open-s…
Singularity Avoidance with Application to Online Trajectory Optimization for Serial Manipulators
Automation and Control Institute (ACIN), TU Wien（维也纳工业大学自动化与控制研究所（ACIN））；Center for Vision, Automation and Control, AIT Austrian Institute of Technology（奥地利技术研究所（AIT）视觉、自动化与控制中心）
Deploying large, complex space structures is of great interest to the modern scientific world as it can provide new capabilities in obtaining scientific, communicative, and observational information. However, many theoretical mission designs contain complexities that must be constrained by the requirements of the launch vehicle, such as volume and mass. To mitigate such constraints, the use of on-orbit additive manufacturing and robotic assembly allows for the flexibility of building large complex structures including telescopes, space stations, and communication satellites. The contribution o…
To continuously generate trajectories for serial manipulators with high dimensional degrees of freedom (DOF) in the dynamic environment, a real-time optimal trajectory generation method based on machine learning aiming at high dimensional inputs is presented in this paper. First, a learning optimization (LO) framework is established, and implementations with different sub-methods are discussed. Additionally, multiple criteria are defined to evaluate the performance of LO models. Furthermore, aiming at high dimensional inputs, a database generation method based on input space dimension-reducing…
CIIRC CTU in Prague（布拉格捷克理工大学信息、机器人与控制研究所）；Sorbonne Université, LIP6 CNRS（索邦大学，法国国家科学研究中心LIP6实验室）；LAAS-CNRS, FEE CTU in Prague（法国国家科学研究中心系统分析与架构实验室，布拉格捷克理工大学电气工程学院）
The Inverse Kinematics (IK) problem is to nd robot control parameters to bring it into the desired position under the kinematics and collision constraints. We present a global solution to the optimal IK problem for a general serial 7DOF manipulator with revolute joints and a quadratic polynomial objective function. We show that the kinematic constraints due to rotations can all be generated by second-degree polynomials. This is important since it signicantly simplies further step where we nd the optimal solution by Lasserre relaxations of non-convex polynomial systems. We demonstrate that the …
University of South Carolina（南卡罗来纳大学）；United States Naval Academy（美国海军学院）
Despite the performance advantages of modern sampling-based motion planners, solving high dimensional planning problems in near real-time remains a challenge. Applications include hyper-redundant manipulators, snake-like and humanoid robots. Based on the intuition that many of these problem instances do not require the robots to exercise every degree of freedom independently, we introduce an enhancement to popular sampling-based planning algorithms aimed at circumventing the exponential dependence on dimensionality. We propose beginning the search in a lower dimensional subspace of the configu…
Technische Universität Darmstadt（达姆施塔特工业大学）；Aalto University（阿尔托大学）
Path planning is a crucial algorithmic approach for designing robot behaviors. Sampling-based approaches, like rapidly exploring random trees (RRTs) or probabilistic roadmaps, are prominent algorithmic solutions for path planning problems. Despite its exponential convergence rate, RRT can only find suboptimal paths. On the other hand, $\textrm{RRT}^*$, a widely-used extension to RRT, guarantees probabilistic completeness for finding optimal paths but suffers in practice from slow convergence in complex environments. Furthermore, real-world robotic environments are often partially observable or…
Presented in this paper is the kinematic analysis of a symmetrical three-degree-of-freedom planar parallel manipulator. In opposite to serial manipulators, parallel manipulators can admit not only multiple inverse kinematic solutions, but also multiple direct kinematic solutions. This property produces more complicated kinematic models but allows more flexibility in trajectory planning. To take into account this property, the notion of aspects, i.e. the maximal singularity-free domains, was introduced, based on the notion of working modes, which makes it possible to separate the inverse kinema…
Institut de Recherche en Cybernétique de Nantes（南特控制论研究所）
The aim of this paper is to characterize the moveability of fully-parallel manipulators in the presence of obstacles. Fully parallel manipulators are used in applications where accuracy, stiffness or high speeds and accelerations are required \cite{Merlet:97}. However, one of its main drawbacks is a relatively small workspace compared to the one of serial manipulators. This is due mainly to the existence of potential internal collisions, and the existence of singularities. In this paper, the notion of free aspect is defined which permits to exhibit domains of the workspace and the joint space …
Ecole Centrale de Lille（里尔中央理工学院）；Beihang University（北京航空航天大学）
A high redundant non-holonomic humanoid mobile dual-arm manipulator system is presented in this paper where the motion planning to realize "human-like" autonomous navigation and manipulation tasks is studied. Firstly, an improved MaxiMin NSGA-II algorithm, which optimizes five objective functions to solve the problems of singularity, redundancy, and coupling between mobile base and manipulator simultaneously, is proposed to design the optimal pose to manipulate the target object. Then, in order to link the initial pose and that optimal pose, an off-line motion planning algorithm is designed. I…
Multimodal Control of Manipulators: Coupling Kinematics and Vision for Self-Driving Laboratory Operations
1 Department of Electronics Systems, Aalborg University, Denmark；3 Extreme Robotics Laboratory, School of Metallurgy \& Materials, University of Birmingham, Birmingham, United Kingdom
École Centrale de Nantes（南特中央理工学院）；Université de Nantes（南特大学）
This work investigates new kinematic features of parallel manipulators. It is well known that parallel manipulators admit generally several direct kinematic solutions for a given set of input joint values. The aim of this paper is to characterize the uniqueness domains in the workspace of parallel manipulators, as well as their image in the joint space. The study focuses on the most usual case of parallel manipulators with only one inverse kinematic solution. The notion of aspect introduced for serial manipulators in [Borrel 86] is redefined for such parallel manipulators. Then, it is shown th…
KU Leuven – University of Leuven（鲁汶大学）；University of Cambridge（剑桥大学）
This work addresses the inverse kinematics of serial robots using conformal geometric algebra. Classical approaches include either the use of homogeneous matrices, which entails high computational cost and execution time or the development of particular geometric strategies that cannot be generalized to arbitrary serial robots. In this work, we present a compact, elegant and intuitive formulation of robot kinematics based on conformal geometric algebra that provides a suitable framework for the closed-form resolution of the inverse kinematic problem for manipulators with a spherical wrist. For…
For a nonlinear system (e.g. a robot) with its continuous state space trajectories constrained by a linear temporal logic specification, the synthesis of a low-level controller for mission execution often results in a non-convex optimization problem. We devise a new algorithm to solve this type of non-convex problems by formulating a rapidly-exploring random tree of barrier pairs, with each barrier pair composed of a quadratic barrier function and a full state feedback controller. The proposed method employs a rapid-exploring random tree to deal with the non-convex constraints and uses barrier…
A polynomial solution to the inverse kinematic problem of the Kinova Gen3 Lite robot is proposed in this paper. This serial robot is based on a 6R kinematic chain and is not wrist-partitioned. We first start from the forward kinematics equation providing the position and orientation of the end-effector, finally, the univariate polynomial equation is given as a function of the first joint variable $θ_{1}$. The remaining joint variables are computed by back substitution. Thus, an unique set of joint position is obtain for each root of the univariate equation. Numerical examples, simulated in ROS…
Research Institute for Symbolic Computation, Johannes Kepler University（约翰内斯·开普勒大学符号计算研究所）；University of the Philippines Diliman（菲律宾大学迪里曼分校）
We develop an algorithm that solves the inverse kinematics of general serial 2RP3R, 2R2P2R, 3RP2R and 6R manipulators based on the HuPf algorithm. We identify the workspaces of the 3-subchains of the manipulator with a quasi-projective variety in $\mathbb{P}^7$ via dual quaternions. This allows us to compute linear forms that describe linear spaces containing the workspaces of these 3-subchains. We present numerical examples that illustrate the algorithm and show the real solutions.
DRAFTO: Decoupled Reduced-space and Adaptive Feasibility-repair Trajectory Optimization for Robotic Manipulators
J. Mike Walker ’66 Department of Mechanical Engineering, Texas A&M University（J. Mike Walker ’66 机械工程系，德克萨斯A&M大学）；Zachry Department of Civil and Environmental Engineering, Texas A&M University（Zachry 市政与环境工程系，德克萨斯A&M大学）
University of Toronto（多伦多大学）；University of Zagreb（萨格勒布大学）；Vector Institute（向量研究所）
Inverse kinematics is a fundamental problem for articulated robots: fast and accurate algorithms are needed for translating task-related workspace constraints and goals into feasible joint configurations. In general, inverse kinematics for serial kinematic chains is a difficult nonlinear problem, for which closed form solutions cannot be easily obtained. Therefore, computationally efficient numerical methods that can be adapted to a general class of manipulators are of great importance. % to motion planning and workspace generation tasks. In this paper, we use convex optimization techniques to…
Parallel Transmission Aware Co-Design: Enhancing Manipulator Performance Through Actuation-Space Optimization
Robotics Innovation Center, DFKI GmbH（DFKI机器人创新中心）；Dynamics Division, Department of Mechanics & Maritime Sciences, Chalmers University of Technology（楚基姆斯理工大学机械与航海科学系动力分部）；AG Robotik, University of Bremen（不莱梅大学机器人技术研究所）
The present project deals with the elastostatic modeling and calibration experiment of spacial industrial manipulators using an optimal selection of measurements pose, for the calibration procedure, the optimal pose selection aims to the efficiency improvement of identification procedure for serial manipulators which reduces noise impact on the parameters identification precision, it is usually used for planar manipulators, our work is mainly to extend the approach for a more complicated manipulator in 3D space using a wise decomposition of the spacial manipulator into a set of serial sub-chai…
Co-optimizing Physical Reconfiguration Parameters and Controllers for an Origami-inspired Reconfigurable Manipulator
Colorado State University（科罗拉多州立大学）；University of Massachusetts Amherst（马萨诸塞大学阿默斯特分校）；Manning College of Information and Computer Sciences（曼宁信息与计算机科学学院）
School of Electrical and Computer Engineering, Georgia Institute of Technology（佐治亚理工学院电气与计算机工程学院）；Daniel Guggenheim School of Aerospace Engineering, Institute for Robotics and Intelligent Machines, Georgia Institute of Technology（佐治亚理工学院丹尼尔·古根海姆航空航天工程学院，机器人与智能机器研究所）
Sampling-based planning has become a de facto standard for complex robots given its superior ability to rapidly explore high-dimensional configuration spaces. Most existing optimal sampling-based planning algorithms are sequential in nature and cannot take advantage of wide parallelism available on modern computer hardware. Further, tight synchronization of exploration and exploitation phases in these algorithms limits sample throughput and planner performance. Policy Iteration RRT# (PI-RRT#) exposes fine-grained parallelism during the exploitation phase, but this parallelism has not yet been …
Laboratoire des Sciences du Numérique de Nantes (LS2N)（南特数字科学实验室）；Innopolis University（因诺波利斯大学）；IMT Atlantique Nantes（大西洋矿业电信学院南特校区）；Centre National de la Recherche Scientifique (CNRS)（法国国家科学研究中心）
The paper focuses on the stiffness analysis of multi-link serial planar manipulators, which may demonstrate nonlinear stiffness behavior under the compressive loading. Two important cases are considered, where the manipulator has either a straight or non-straight initial configuration. It was proved that in the first case the loading may cause the buckling if it exceeds some critical value, and the manipulator suddenly changes its straight shape and stiffness properties. For computing this critical force, a general eigenvalue-based technique was proposed that can be applied to any multi-link s…
Laboratoire des Sciences du Numérique de Nantes（南特数字科学实验室）；Ecole Centrale Nantes（南特中央理工学院）；IMT Atlantique（IMT大西洋）；Innopolis University（因诺波利斯大学）；Centre National de la Recherche Scientifique (CNRS)（法国国家科学研究中心）
The paper focuses on the kinematics control of a compliant serial manipulator composed of a new type of dualtriangle elastic segments. Some useful optimization techniques were applied to solve the geometric redundancy problem, ensure the stability of the manipulator configurations with respect to the external forces/torques applied to the endeffector. The efficiency of the developed control algorisms is confirmed by simulation.
Laboratoire des Sciences du Numérique de Nantes (LS2N), UMR CNRS 6004（南特数字科学实验室（法国国家科学研究中心UMR 6004））；Ecole Centrale Nantes（南特中央理工学院）；IMT Atlantique（大西洋电信学院）；Innopolis University（因诺波利斯大学）；Centre National de la Recherche Scientifique (CNRS)（法国国家科学研究中心）
The paper focuses on the mechanics of a compliant serial manipulator composed of new type of dual-triangle elastic segments. Both the analytical and numerical methods were used to find the manipulator stable and unstable equilibrium configurations, as well as to predict corresponding manipulator shapes. The stiffness analysis was carried on for both loaded and unloaded modes, the stiffness matrices were computed using the Virtual Joint Method (VJM). The results demonstrate that either buckling or quasi-buckling phenomenon may occur under the loading, if the manipulator corresponding initial co…
Laboratoire des Sciences du Numérique de Nantes (LS2N)（南特数字科学实验室）；IMT Atlantique（大西洋国立高等矿业电信学校）；Centre National de la Recherche Scientifique (CNRS)（法国国家科学研究中心）
The paper focuses on the stiffness modeling of a new type of compliant manipulator and its non-linear behavior while interacting with the environment. The manipulator under study is a serial mechanical structure composed of dualtriangle segments. The main attention is paid to the initial straight configuration which may suddenly change its shape under the loading. It was discovered that under the external loading such manipulator may have six equilibrium configurations but only two of them are stable. In the neighborhood of these configurations, the manipulator behavior was analyzed using the …
The singularities of serial robotic manipulators are those configurations in which the robot loses the ability to move in at least one direction. Hence, their identification is fundamental to enhance the performance of current control and motion planning strategies. While classical approaches entail the computation of the determinant of either a 6x n or nxn matrix for an n degrees of freedom serial robot, this work addresses a novel singularity identification method based on modelling the twists defined by the joint axes of the robot as vectors of the six-dimensional and three-dimensional geom…
Innopolis University（因诺波利斯大学）；Centre National de la Recherche Scientifique (CNRS)（法国国家科学研究中心）；Le Laboratoire des Sciences du Numérique de Nantes (LS2N)（南特数字科学实验室）；IMT Atlantique（大西洋国立高等工业技术与矿业学校）
The paper presents advancement of the matrix structural analysis technique (MSA) for stiffness modeling of robotic manipulators. In contrast to the classical MSA, it can be applied to both parallel and serial manipulators composed of flexible and rigid links connected by rigid, passive or elastic joints with multiple external loadings. The manipulator stiffness model is presented as a set of basic equations describing the link elasticities that are supplemented by a set of constraints describing connections between links. These equations are aggregated straightforwardly in a common linear syst…
This paper proposes a novel modelling approach for a heavy-duty manipulator with parallel$-$serial structures connected in series. Each considered parallel$-$serial structure contains a revolute segment with rigid links connected by a passive revolute joint and actuated by a linear hydraulic actuator, thus forming a closed kinematic loop. In addition, prismatic segments, consisting of prismatic joints driven by hydraulic linear actuators, also are considered. Expressions for actuator forces are derived using the Newton$-$Euler (N$-$E) dynamics formulation. The derivation process does not assum…
Institut de Robòtica i Informàtica Industrial, CSIC-UPC（工业机器人信息研究所，CSIC-UPC）
This paper presents a motion planner for systems subject to kinematic and dynamic constraints. The former appear when kinematic loops are present in the system, such as in parallel manipulators, in robots that cooperate to achieve a given task, or in situations involving contacts with the environment. The latter are necessary to obtain realistic trajectories, taking into account the forces acting on the system. The kinematic constraints make the state space become an implicitly-defined manifold, which complicates the application of common motion planning techniques. To address this issue, the …
