Add sensors, actuators, PWM code

Kept in separate files currently, can test and write proper function
once Beaglebone arrives