Human-Robot interfaces and intelligence

Summary
First release of the algorithms for planning, active sensing and control of the robot activities