Updated sensor equations. Extra control to peripherals.