A systematic approach to improve robot motion control