Re-organising sensor read code and structuring hardware support code more cleanly
Hardware support directory restructure
Tests of restructured FCS pass