joint velocity fixed using radius instead of diameter