Minor cleanup of body and angle; fixed link distances
Streamlining of update functions
cleanup and NOTES update