-
Comparative Evaluation of RGB-D SLAM Methods for Humanoid Robot Localization and Map**
Authors:
Amirhosein Vedadi,
Aghil Yousefi-Koma,
Parsa Yazdankhah,
Amin Mozayyan
Abstract:
In this paper, we conducted a comparative evaluation of three RGB-D SLAM (Simultaneous Localization and Map**) algorithms: RTAB-Map, ORB-SLAM3, and OpenVSLAM for SURENA-V humanoid robot localization and map**. Our test involves the robot to follow a full circular pattern, with an Intel RealSense D435 RGB-D camera installed on its head. In assessing localization accuracy, ORB-SLAM3 outperformed…
▽ More
In this paper, we conducted a comparative evaluation of three RGB-D SLAM (Simultaneous Localization and Map**) algorithms: RTAB-Map, ORB-SLAM3, and OpenVSLAM for SURENA-V humanoid robot localization and map**. Our test involves the robot to follow a full circular pattern, with an Intel RealSense D435 RGB-D camera installed on its head. In assessing localization accuracy, ORB-SLAM3 outperformed the others with an ATE of 0.1073, followed by RTAB-Map at 0.1641 and OpenVSLAM at 0.1847. However, it should be noted that both ORB-SLAM3 and OpenVSLAM faced challenges in maintaining accurate odometry when the robot encountered a wall with limited feature points. Nevertheless, OpenVSLAM demonstrated the ability to detect loop closures and successfully relocalize itself within the map when the robot approached its initial location. The investigation also extended to map** capabilities, where RTAB-Map excelled by offering diverse map** outputs, including dense, OctoMap, and occupancy grid maps. In contrast, both ORB-SLAM3 and OpenVSLAM provided only sparse maps.
△ Less
Submitted 5 January, 2024;
originally announced January 2024.
-
Kinematic Base State Estimation for Humanoid using Invariant Extended Kalman Filter
Authors:
Amirhosein Vedadi,
Aghil Yousefi-Koma,
Masoud Shariat-Panahi,
Mahdi Nozari
Abstract:
This paper presents the design and implementation of a Right Invariant Extended Kalman Filter (RIEKF) for estimating the states of the kinematic base of the Surena V humanoid robot. The state representation of the robot is defined on the Lie group $SE_4(3)$, encompassing the position, velocity, and orientation of the base, as well as the position of the left and right feet. In addition, we incorpo…
▽ More
This paper presents the design and implementation of a Right Invariant Extended Kalman Filter (RIEKF) for estimating the states of the kinematic base of the Surena V humanoid robot. The state representation of the robot is defined on the Lie group $SE_4(3)$, encompassing the position, velocity, and orientation of the base, as well as the position of the left and right feet. In addition, we incorporated IMU biases as concatenated states within the filter.
The prediction step of the RIEKF utilizes IMU equations, while the update step incorporates forward kinematics. To evaluate the performance of the RIEKF, we conducted experiments using the Choreonoid dynamic simulation framework and compared it against a Quaternion-based Extended Kalman Filter (QEKF). The results of the analysis demonstrate that the RIEKF exhibits reduced drift in localization and achieves estimation convergence in a shorter time compared to the QEKF. These findings highlight the effectiveness of the proposed RIEKF for accurate state estimation of the kinematic base in humanoid robotics.
△ Less
Submitted 5 January, 2024;
originally announced January 2024.
-
Estimation and Early Prediction of Grip Force Based on sEMG Signals and Deep Recurrent Neural Networks
Authors:
Atusa Ghorbani,
Aghil Yousefi-Koma,
Amirhosein Vedadi
Abstract:
Hands are used for communicating with the surrounding environment and have a complex structure that enables them to perform various tasks with their multiple degrees of freedom. Hand amputation can prevent a person from performing their daily activities. In that event, finding a suitable, fast, and reliable alternative for the missing limb can affect the lives of people who suffer from such condit…
▽ More
Hands are used for communicating with the surrounding environment and have a complex structure that enables them to perform various tasks with their multiple degrees of freedom. Hand amputation can prevent a person from performing their daily activities. In that event, finding a suitable, fast, and reliable alternative for the missing limb can affect the lives of people who suffer from such conditions. As the most important use of the hands is to grasp objects, the purpose of this study is to accurately predict grip** force from surface electromyography (sEMG) signals during a pinch-type grip. In that regard, grip** force and sEMG signals are derived from 10 healthy subjects. Results show that for this task, recurrent networks outperform nonrecurrent ones, such as a fully connected multilayer perceptron (MLP) network. Gated recurrent unit (GRU) and long short-term memory (LSTM) networks can predict the grip** force with R-squared values of 0.994 and 0.992, respectively, and a prediction rate of over 1300 predictions per second. The predominant advantage of using such frameworks is that the grip** force can be predicted straight from preprocessed sEMG signals without any form of feature extraction, not to mention the ability to predict future force values using larger prediction horizons adequately. The methods presented in this study can be used in the myoelectric control of prosthetic hands or robotic grippers.
△ Less
Submitted 19 February, 2023;
originally announced February 2023.
-
Online Bipedal Locomotion Adaptation for Step** on Obstacles Using a Novel Foot Sensor
Authors:
Pezhman Abdolahnezhad,
Aghil Yousefi-Koma,
Amirhosein Vedadi,
Kasra Sinaei,
Behnam Maleki,
Milad Shafiee
Abstract:
In this paper, we present a novel control architecture for the online adaptation of bipedal locomotion on inclined obstacles. In particular, we introduce a novel, cost-effective, and versatile foot sensor to detect the proximity of the robot's feet to the ground (bump sensor). By employing this sensor, feedback controllers are implemented to reduce the impact forces during the transition of the sw…
▽ More
In this paper, we present a novel control architecture for the online adaptation of bipedal locomotion on inclined obstacles. In particular, we introduce a novel, cost-effective, and versatile foot sensor to detect the proximity of the robot's feet to the ground (bump sensor). By employing this sensor, feedback controllers are implemented to reduce the impact forces during the transition of the swing to stance phase or stee** on inclined unseen obstacles. Compared to conventional sensors based on contact reaction force, this sensor detects the distance to the ground or obstacles before the foot touches the obstacle and therefore provides predictive information to anticipate the obstacles. The controller of the proposed bump sensor interacts with another admittance controller to adjust leg length. The walking experiments show successful locomotion on the unseen inclined obstacle without reducing the locomotion speed with a slope angle of 12. Foot position error causes a hard impact with the ground as a consequence of accumulative error caused by links and connections' deflection (which is manufactured by university tools). The proposed framework drastically reduces the feet' impact with the ground.
△ Less
Submitted 27 December, 2022;
originally announced December 2022.
-
Bipedal Locomotion Optimization by Exploitation of the Full Dynamics in DCM Trajectory Planning
Authors:
Amirhosein Vedadi,
Kasra Sinaei,
Pezhman Abdolahnezhad,
Shahriar Sheikh Aboumasoudi,
Aghil Yousefi-Koma
Abstract:
Walking motion planning based on Divergent Component of Motion (DCM) and Linear Inverted Pendulum Model (LIPM) is one of the alternatives that could be implemented to generate online humanoid robot gait trajectories. This algorithm requires different parameters to be adjusted. Herein, we developed a framework to attain optimal parameters to achieve a stable and energy-efficient trajectory for real…
▽ More
Walking motion planning based on Divergent Component of Motion (DCM) and Linear Inverted Pendulum Model (LIPM) is one of the alternatives that could be implemented to generate online humanoid robot gait trajectories. This algorithm requires different parameters to be adjusted. Herein, we developed a framework to attain optimal parameters to achieve a stable and energy-efficient trajectory for real robot's gait. To find the optimal trajectory, four cost functions representing energy consumption, the sum of joints velocity and applied torque at each lower limb joint of the robot, and a cost function based on the Zero Moment Point (ZMP) stability criterion were considered. Genetic algorithm was employed in the framework to optimize each of these cost functions. Although the trajectory planning was done with the help of the simplified model, the values of each cost function were obtained by considering the full dynamics model and foot-ground contact model in Bullet physics engine simulator. The results of this optimization yield that walking with the most stability and walking in the most efficient way are in contrast with each other. Therefore, in another attempt, multi-objective optimization for ZMP and energy cost functions at three different speeds was performed. Finally, we compared the designed trajectory, which was generated using optimal parameters, with the simulation results in Choreonoid simulator.
△ Less
Submitted 30 July, 2022;
originally announced August 2022.
-
Design and Implementation of a Fuzzy Adaptive Controller for Time-Varying Formation Leader-Follower Configuration of Nonholonomic Mobile Robots
Authors:
Payam Nourizadeh,
Aghil Yousefi-Koma,
Moosa Ayati
Abstract:
In this paper, a time-varying leader-follower formation control of nonholonomic mobile robots based on a trajectory tracking control strategy is considered. In the time-varying formation, the relative bearing and distance of each follower are variable parameters, and therefore, the followers can carry out various and complex behaviour even without changing the linear and angular velocities of the…
▽ More
In this paper, a time-varying leader-follower formation control of nonholonomic mobile robots based on a trajectory tracking control strategy is considered. In the time-varying formation, the relative bearing and distance of each follower are variable parameters, and therefore, the followers can carry out various and complex behaviour even without changing the linear and angular velocities of the leader robot. After proposing the kinematic model of the time-varying leader-follower formation, the backstep** control method is exploited to keep the structure of the defined formation. The global stability of the formation is investigated using the Lyapunov theorem. Moreover, the designed nonlinear controller suffers from the ineffectual large input commands at the beginning of the formation. To rectify this problem, a fuzzy adaptive algorithm is proposed to improve the backstep** controller and the global stability of the resulting fuzzy adaptive backstep** controller is guaranteed. Considering the rate change of relative distance and bearing in the kinematic model of the leader-follower formation and controller design procedure, makes the formation more practical in dynamic and clutter environments, as well as capable of defining complicated behaviour for followers, and provides crash and obstacle avoidance without switching between different control strategies. Finally, the performance of the proposed kinematics model and designed controllers are investigated through simulations and experimental studies.
△ Less
Submitted 23 May, 2022;
originally announced May 2022.
-
SURENA IV: Towards A Cost-effective Full-size Humanoid Robot for Real-world Scenarios
Authors:
Aghil Yousefi-Koma,
Behnam Maleki,
Hessam Maleki,
Amin Amani,
Mohammad Ali Bazrafshani,
Hossein Keshavarz,
Ala Iranmanesh,
Alireza Yazdanpanah,
Hamidreza Alai,
Sahel Salehi,
Mahyar Ashkvari,
Milad Mousavi,
Milad Shafiee Ashtiani
Abstract:
This paper describes the hardware, software framework, and experimental testing of SURENA IV humanoid robotics platform. SURENA IV has 43 degrees of freedom (DoFs), including seven DoFs for each arm, six DoFs for each hand, and six DoFs for each leg, with a height of 170 cm and a mass of 68 kg and morphological and mass properties similar to an average adult human. SURENA IV aims to realize a cost…
▽ More
This paper describes the hardware, software framework, and experimental testing of SURENA IV humanoid robotics platform. SURENA IV has 43 degrees of freedom (DoFs), including seven DoFs for each arm, six DoFs for each hand, and six DoFs for each leg, with a height of 170 cm and a mass of 68 kg and morphological and mass properties similar to an average adult human. SURENA IV aims to realize a cost-effective and anthropomorphic humanoid robot for real-world scenarios. In this way, we demonstrate a locomotion framework based on a novel and inexpensive predictive foot sensor that enables walking with 7cm foot position error because of accumulative error of links and connections' deflection(that has been manufactured by the tools which are available in the Universities). Thanks to this sensor, the robot can walk on unknown obstacles without any force feedback, by online adaptation of foot height and orientation. Moreover, the arm and hand of the robot have been designed to grasp the objects with different stiffness and geometries that enable the robot to do drilling, visual servoing of a moving object, and writing his name on the white-board.
△ Less
Submitted 30 August, 2021;
originally announced August 2021.
-
A Whole-Body Model Predictive Control Scheme Including External Contact Forces and CoM Height Variations
Authors:
Reihaneh Mirjalili,
Aghil Yousefi-koma,
Farzad A. Shirazi,
Arman Nikkhah,
Fatemeh Nazemi,
Majid Khadiv
Abstract:
In this paper, we present an approach for generating a variety of whole-body motions for a humanoid robot. We extend the available Model Predictive Control (MPC) approaches for walking on flat terrain to plan for both vertical motion of the Center of Mass (CoM) and external contact forces consistent with a given task. The optimization problem is comprised of three stages, i. e. the CoM vertical mo…
▽ More
In this paper, we present an approach for generating a variety of whole-body motions for a humanoid robot. We extend the available Model Predictive Control (MPC) approaches for walking on flat terrain to plan for both vertical motion of the Center of Mass (CoM) and external contact forces consistent with a given task. The optimization problem is comprised of three stages, i. e. the CoM vertical motion, joint angles, and contact forces planning. The choice of external contact (e. g. hand contact with the object or environment) among all available locations and the appropriate time to reach and maintain a contact are all computed automatically within the algorithm. The presented algorithm benefits from the simplicity of the Linear Inverted Pendulum Model (LIPM), while it overcomes the common limitations of this model and enables us to generate a variety of whole-body motions through external contacts. Simulation and experimental implementation of several whole-body actions in multi-contact scenarios on a humanoid robot show the capability of the proposed algorithm.
△ Less
Submitted 24 October, 2018;
originally announced October 2018.
-
Push Recovery of a Position-Controlled Humanoid Robot Based on Capture Point Feedback Control
Authors:
Milad Shafiee-Ashtiani,
Aghil Yousefi-Koma,
Reihaneh Mirjalili,
Hessam Maleki,
Mojtaba Karimi
Abstract:
In this paper, a combination of ankle and hip strategy is used for push recovery of a position-controlled humanoid robot. Ankle strategy and hip strategy are equivalent to Center of Pressure (CoP) and Centroidal Moment Pivot (CMP) regulation respectively. For controlling the CMP and CoP we need a torque-controlled robot, however most of the conventional humanoid robots are position controlled. In…
▽ More
In this paper, a combination of ankle and hip strategy is used for push recovery of a position-controlled humanoid robot. Ankle strategy and hip strategy are equivalent to Center of Pressure (CoP) and Centroidal Moment Pivot (CMP) regulation respectively. For controlling the CMP and CoP we need a torque-controlled robot, however most of the conventional humanoid robots are position controlled. In this regard, we present an efficient way for implementation of the hip and ankle strategies on a position controlled humanoid robot. We employ a feedback controller to compensate the capture point error. Using our scheme, a simple and practical push recovery controller is designed which can be implemented on the most of the conventional humanoid robots without the need for torque sensors. The effectiveness of the proposed approach is verified through push recovery experiments on SURENA-Mini humanoid robot under severe pushes.
△ Less
Submitted 29 October, 2017;
originally announced October 2017.
-
A Reactive and Efficient Walking Pattern Generator for Robust Bipedal Locomotion
Authors:
Fatemeh Nazemi,
Aghil Yousefi-koma,
Farzad A. shirazi,
Majid Khadiv
Abstract:
Available possibilities to prevent a biped robot from falling down in the presence of severe disturbances are mainly Center of Pressure (CoP) modulation, step location and timing adjustment, and angular momentum regulation. In this paper, we aim at designing a walking pattern generator which employs an optimal combination of these tools to generate robust gaits. In this approach, first, the next s…
▽ More
Available possibilities to prevent a biped robot from falling down in the presence of severe disturbances are mainly Center of Pressure (CoP) modulation, step location and timing adjustment, and angular momentum regulation. In this paper, we aim at designing a walking pattern generator which employs an optimal combination of these tools to generate robust gaits. In this approach, first, the next step location and timing are decided consistent with the commanded walking velocity and based on the Divergent Component of Motion (DCM) measurement. This stage which is done by a very small-size Quadratic Program (QP) uses the Linear Inverted Pendulum Model (LIPM) dynamics to adapt the switching contact location and time. Then, consistent with the first stage, the LIPM with flywheel dynamics is used to regenerate the DCM and angular momentum trajectories at each control cycle. This is done by modulating the CoP and Centroidal Momentum Pivot (CMP) to realize a desired DCM at the end of current step. Simulation results show the merit of this reactive approach in generating robust and dynamically consistent walking patterns.
△ Less
Submitted 24 October, 2017;
originally announced October 2017.
-
Rigid vs compliant contact: An experimental study on biped walking
Authors:
Majid Khadiv,
S. Ali A. Moosvian,
Aghil Yousefi-Koma,
Majid Sadedel,
Abbas Ehsani-Seresht,
Saeed Mansouri
Abstract:
Contact modeling plays a central role in motion planning, simulation, and control of legged robots, as legged locomotion is realized through contact. The two prevailing approaches to model the contact consider rigid and compliant premise at interaction ports. Contrary to the dynamics model of legged systems with rigid contact (without impact) which is straightforward to develop, there is no consen…
▽ More
Contact modeling plays a central role in motion planning, simulation, and control of legged robots, as legged locomotion is realized through contact. The two prevailing approaches to model the contact consider rigid and compliant premise at interaction ports. Contrary to the dynamics model of legged systems with rigid contact (without impact) which is straightforward to develop, there is no consensus among researchers to employ a standard compliant contact model. Our main goal in this paper is to study the dynamics model structure of bipedal walking systems with a rigid contact and a \textit{novel} compliant contact model and to present experimental validation of both models. For the model with rigid contact, after develo** the model of the articulated bodies in flight phase without any contact with the environment, we apply the holonomic constraints at contact points and develop a constrained dynamics model of the robot in both single and double support phases. For the model with compliant contact, we propose a novel nonlinear contact model and simulate the motion of the robot using this model. In order to show the performance of the developed models, we compare obtained results from these models to the empirical measurements from bipedal walking of the human-sized humanoid robot SURENA III, which has been designed and fabricated at CAST, University of Tehran. This analysis shows the merit of both models in estimating dynamic behavior of the robot walking on a semi-rigid surface. The model with rigid contact, which is less complex and independent of the physical properties of the contacting bodies, can be employed for model-based motion optimization, analysis as well as control, while the model with compliant contact and more complexity is suitable for more realistic simulation scenarios.
△ Less
Submitted 13 December, 2018; v1 submitted 19 September, 2017;
originally announced September 2017.
-
Online Adaptation for Humanoids Walking On Uncertain Surfaces
Authors:
Majid Khadiv,
S. Ali. A. Moosavian,
Aghil Yousefi-Koma,
Hessam Maleki,
Majid Sadedel
Abstract:
In this paper, an online adaptation algorithm for bipedal walking on uneven surfaces with height uncertainty is proposed. In order to generate walking patterns on flat terrains, the trajectories in the task space are planned to satisfy the dynamic balance and slippage avoidance constraints, and also to guarantee smooth landing of the swing foot. To ensure smooth landing of the swing foot on surfac…
▽ More
In this paper, an online adaptation algorithm for bipedal walking on uneven surfaces with height uncertainty is proposed. In order to generate walking patterns on flat terrains, the trajectories in the task space are planned to satisfy the dynamic balance and slippage avoidance constraints, and also to guarantee smooth landing of the swing foot. To ensure smooth landing of the swing foot on surfaces with height uncertainty, the preplanned trajectories in the task space should be adapted. The proposed adaptation algorithm consists of two stages. In the first stage, once the swing foot reaches its maximum height, the supervisory control is initiated until the touch is detected. After the detection, the trajectories in the task space are modified to guarantee smooth landing. In the second stage, this modification is preserved during the Double Support Phase (DSP), and released in the next Single Support Phase (SSP). Effectiveness of the proposed online adaptation algorithm is experimentally verified through realization of the walking patterns on the SURENA III humanoid robot, designed and fabricated at CAST. The walking is tested on a surface with various flat obstacles, where the swing foot is prone to either land on the ground soon or late.
△ Less
Submitted 30 March, 2017;
originally announced March 2017.
-
Robust Bipedal Locomotion Control Based on Model Predictive Control and Divergent Component of Motion
Authors:
Milad Shafiee-Ashtiani,
Aghil Yousefi-Koma,
Masoud Shariat-Panahi
Abstract:
In this paper, previous works on the Model Predictive Control (MPC) and the Divergent Component of Motion (DCM) for bipedal walking control are extended. To this end, we employ a single MPC which uses a combination of Center of Pressure (CoP) manipulation, step adjustment, and Centroidal Moment Pivot (CMP) modulation to design a robust walking controller. Furthermore, we exploit the concept of tim…
▽ More
In this paper, previous works on the Model Predictive Control (MPC) and the Divergent Component of Motion (DCM) for bipedal walking control are extended. To this end, we employ a single MPC which uses a combination of Center of Pressure (CoP) manipulation, step adjustment, and Centroidal Moment Pivot (CMP) modulation to design a robust walking controller. Furthermore, we exploit the concept of time-varying DCM to generalize our walking controller for walking in uneven surfaces. Using our scheme, a general and robust walking controller is designed which can be implemented on robots with different control authorities, for walking on various environments, e.g. uneven terrains or surfaces with a very limited feasible area for step**. The effectiveness of the proposed approach is verified through simulations on different scenarios and comparison to the state of the art.
△ Less
Submitted 28 February, 2017;
originally announced February 2017.
-
Push Recovery of a Humanoid Robot Based on Model Predictive Control and Capture Point
Authors:
Milad Shafiee-Ashtiani,
Aghil Yousefi-Koma,
Masoud Shariat-Panahi,
Majid Khadiv
Abstract:
The three bio-inspired strategies that have been used for balance recovery of biped robots are the ankle, hip and step** Strategies. However, there are several cases for a biped robot where step** is not possible, e. g. when the available contact surfaces are limited. In this situation, the balance recovery by modulating the angular momentum of the upper body (Hip-strategy) or the Zero Moment…
▽ More
The three bio-inspired strategies that have been used for balance recovery of biped robots are the ankle, hip and step** Strategies. However, there are several cases for a biped robot where step** is not possible, e. g. when the available contact surfaces are limited. In this situation, the balance recovery by modulating the angular momentum of the upper body (Hip-strategy) or the Zero Moment Point (ZMP) (Ankle strategy) is essential. In this paper, a single Model Predictive Control (MPC) scheme is employed for controlling the Capture Point (CP) to a desired position by modulating both the ZMP and the Centroidal Moment Pivot (CMP). The goal of the proposed controller is to control the CP, employing the CMP when the CP is out of the support polygon, and/or the ZMP when the CP is inside the support polygon. The proposed algorithm is implemented on an abstract model of the SURENA III humanoid robot. Obtained results show the effectiveness of the proposed approach in the presence of severe pushes, even when the support polygon is shrunken to a point or a line.
△ Less
Submitted 23 December, 2016;
originally announced December 2016.
-
Kinematic analysis of a 3-UPU parallel Robot using the Ostrowski-Homotopy Continuation
Authors:
Milad Shafiee-Ashtiani,
Aghil Yousefi-Koma,
Sahba Iravanimanesh,
Amir Siavosh Bashardoust
Abstract:
The direct kinematics analysis is the foundation of implementation of real world application of parallel manipulators. For most parallel manipulators the direct kinematics is challenging. In this paper, for the first time a fast and efficient Homotopy Continuation Method, called the Ostrowski Homotopy continuation method has been implemented to solve the direct and inverse kinematics problem of th…
▽ More
The direct kinematics analysis is the foundation of implementation of real world application of parallel manipulators. For most parallel manipulators the direct kinematics is challenging. In this paper, for the first time a fast and efficient Homotopy Continuation Method, called the Ostrowski Homotopy continuation method has been implemented to solve the direct and inverse kinematics problem of the parallel manipulators. This method has advantage over conventional numerical iteration methods, which is not rely on the initial values and is more efficient than other continuation method and it can find all solutions of equations without divergence just by changing auxiliary Homotopy function. Numerical example and simulation was done to solve the direct kinematic problem of the 3-UPU parallel manipulator that leads to 16 real solutions. Results obviously reveal the fastness and effectiveness of this method than the conventional Homotopy continuation methods such as Newton Homotopy. The results shows that the Ostrowski-Homotopy reduces computation time up to 80-97 % with more accuracy in solutions in comparison with the Newton Homotopy.
△ Less
Submitted 28 September, 2016;
originally announced September 2016.