|
| 1 | +Manipulator Performance Constraints for human-robot Cooperation |
| 2 | + |
| 3 | +# Description: |
| 4 | +Use any local performance index of a robotic manipulator to constrain the robot above a certain threshold. |
| 5 | +This is particularly useful for singularity avoidance in physical human-robot interaction |
| 6 | + |
| 7 | +A detailed description can be found in the following RCIM paper: |
| 8 | +- Dimeas, Fotios, Vassilis C. Moulianitis, and Nikos Aspragathos. "Manipulator performance constraints in human-robot cooperation." Robotics and Computer-Integrated Manufacturing (2017). |
| 9 | + |
| 10 | +and also in ICRA 2016 (early version): |
| 11 | +- Dimeas, Fotios, et al. "Manipulator performance constraints in Cartesian admittance control for human-robot cooperation." Robotics and Automation (ICRA), 2016 IEEE International Conference on. IEEE, 2016. |
| 12 | + |
| 13 | +A video demonstration: |
| 14 | +<a href="http://www.youtube.com/watch?feature=player_embedded&v=1zTDmiDjDOA |
| 15 | +" target="_blank"><img src="http://img.youtube.com/vi/1zTDmiDjDOA/0.jpg" |
| 16 | +alt="IMAGE ALT TEXT HERE" width="240" height="180" border="10" /></a> |
| 17 | + |
| 18 | + |
| 19 | +This repository includes the Matlab code that was used in the ICRA 2016 paper and the extended method in C++ that is presented in the RCIM journal. |
| 20 | + |
| 21 | +The C++ implementation includes performance constraints in both translational and rotational axes. It also includes 3 ways of calculating them: |
| 22 | +⋅⋅* Serial: Each direction is calculated after the other. It might take a while |
| 23 | +⋅⋅* Parallel: Each direction is calculated in its own thread worker. Function returns when all calculations are over. This usually works in less than 1ms. Better have a multi-thread CPU. |
| 24 | +⋅⋅* Parallel non-blocking: Same as above but the function returns immediately. This can work in slow computers. WARNING! Be very careful when you use it, synchronization issues of the constraint forces may arise. |
| 25 | + |
| 26 | +# Usage: |
| 27 | +## C++ |
| 28 | +> g++ demo.cpp performanceConstraints.cpp Jacobian.cpp -o demo -larmadillo -lpthread -std=c++11 |
| 29 | +
|
| 30 | +The Jacobian matrix that is provided in symbolic form is for the KUKA LWR 4+ |
| 31 | + |
| 32 | +### Requirements: |
| 33 | +- Armadillo library |
| 34 | + |
| 35 | +## Matlab |
| 36 | +1. Set the desired parameters for the robot and the performance |
| 37 | +constraints |
| 38 | +2. Run the simulation |
| 39 | +3. View the simulated motion of the robot and the plots |
| 40 | + |
| 41 | +### Requirements: |
| 42 | +- Robotics Toolbox for Matlab (http://www.petercorke.com/Robotics_Toolbox.html) |
| 43 | + |
| 44 | +### Notes: |
| 45 | +- The simulation does not consider the joint limits so the robot |
| 46 | +might behave weird |
| 47 | +- This code has been tested with Robotics Toolbox 9.10 and Matlab R2014a |
| 48 | + |
| 49 | + |
| 50 | +Authors: Fotios Dimeas, Charalambos Papakonstantinou |
| 51 | + |
| 52 | +Copyright 2015-2017 Fotios Dimeas |
0 commit comments