Added odometer and sensor documentation
Prevent double loading
Climbing works again.
Added worker documentation
Started arm motion planning