This paper presents a novel analytic method to uniquely solve inverse kinematics of 7 degrees-of-freedom manipulators while avoiding joint limits and singularities. Two auxiliary parameters are introduced to deal with the self-motion manifolds: the global configuration (GC), which specifies the branch of inverse kinematics solutions; and the arm angle (ψ) that parametrizes the elbow redundancy within the specified branch. The relations between the joint angles and the arm angle are derived, in order to map the joint limits and singularities to arm angle values. Then, intervals of feasible arm angles for the specified target pose and global configuration are determined, taking joint limits and singularities into account. A simple metric is proposed to compute the elbow position according to the feasible intervals. When the arm angle is determined, the joint angles can be uniquely calculated from the position-based inverse kinematics algorithm. The presented method does not exhibit the disadvantages inherent to the use of the Jacobian matrix and can be implemented in real-time control systems. This novel algorithm is the first position-based inverse kinematics algorithm to solve both global and local manifolds, using a redundancy resolution strategy to avoid singularities and joint limits.This work was partially supported by the NETT Project [FP7-PEOPLE-2011-ITN-289146]; and Foundation for Science and Technology, Portugal [grant number SFRH/BD/86499/2012].info:eu-repo/semantics/publishedVersio
We present a distributed leader-helper architecture for teams of two autonomous mobile robots that jointly transport large payloads while avoiding collisions with obstacles (either static or dynamic). The leader navigates to the goal destination and the helper is responsible for maintaining an appropriate distance (which is a function of the object's length) to the leader. Both robots share the responsibility of ensuring that the transported object does not collide with obstructions. No path needs to be given a priori to the robots nor to the payload. The team is able to perform its transportation task in unknown environments that can have corridors, corners and may change the layout online. The payload can be of different dimensions. The team is able to cope with abrupt/strong perturbations that challenge the team behavior during the execution of the task. These characteristics make this approach suitable to be deployed in warehouses or office-like environments. The motion of each robot is controlled by a time series asymptotically stable states, which is formalized using the attractor dynamics approach to behavior based robotics. The advantages are: (i) the overt behavior is smooth and stable; (ii) because the behavior is generated as a time sequence of attractor states, for the control variables, it contributes to the overall asymptotically stability of the system that makes it robust against perturbations. We present results of experiments in simulated environments and with real robots in real environments.
In this paper we focus on modelling formations of non-holonomic mobile robots using non-linear attractor dynamics (see video). The benefit is that the behavior of each robot is generated by time series of asymptotically stable states, which therefore contribute to the robustness against environmental perturbations. This study extends our previous work [S Monteiro et al., 2002]. Here we develop a set of decentralized and distributed basic control architectures that allows each robot to maintain a desired pose within a formation and to enable changes in the shape of the formation which are necessary to avoid obstacles. Simulation results, for teams of four and six mobile robots driving in cluttered and unknown environments, while simultaneously trying to drive in line, column, square, diamond and hexagon are presented. We explain how this approach naturally extends to larger teams of robots.