Started work on full sensor fusion testing