Martowicz, Adam, AGH University of Science and Technology Faculty of Mechanical Engineering and Robotics Department of Robotics and Mechatronics Al. A. Mickiewicza 30, 30-059 Krakow, Poland, Poland