ADC Works. Added I_SENSE code

- Added current sense code as well as voltage measurement