add rgb pwm output

PB 5,6,7 pwm putput for visual feedback
thersold fine adjustment

works better nor, show rgb values on display