`mlint` suggests changing line 82 to 
```
current_body.joint_axis = T_old_body_to_new_body(1:3,1:3) * (-old_child_new_parent_body.joint_axis);
```