Minor fix
Moved things to look nicer
Changed REF parameter in SET_SENSOR_OPERATINGS command from 2 to 1 per Ronaldo's instructions