initial commit

extracted from mas_industrial_robotics