All current reading functions work

Need to add readPWM