Sensor Fusion Algorithm Development