Mechatronic servo system control