tied the feedback provided by the sensor fusion into this as feedback.
consolidated parts, moved urdf into big_red_configs