Fixed FBL100 delay, Sonar & Optical navigation.

Needs tuning for flow.