Petar Doychev Georgiev AssistantMechatronics, Robotics and MechanicsEmail: petar.d.georgiev@fmi.uni-sofia.bg