general fixes/cleanup; added TODOs; ensuring joint angles are wrapped regardless of passing by reference/value
general fixes/cleanup; added TODOs; ensuring joint angles are wrapped regardless of passing by reference/value

nnadeau/pybotics