Sensor initialization change

Corrected PCA address. Reset to datasheet value for A0 and A1 grounded
Updated GPS initialization for sensor health and sensor enabled to
update on change
Complementary filter update

Velocity testing
Merge remote-tracking branch 'origin/Code_development' into Code_development

conflict