Add ultrasonic sensor demo
Remove unnecesary defs, and fix not working pwms