Tried to fix controller detour to 0 on startup
Workcell collision objects added to robot description
Updated pose mission for tests
hardware.cpp merge corrected