Update for new servo centers, fix issues in robotInterface