IF you don't mind grinding code where are many possible fixes.
I would suggest looking at V4.3 as it is a bit cleaner and more current.
The biggest issue is the software is a big loop and CW ke is checked
a few times in the loop. Speeding up the loop is one thing. Or making
the input interrupt driven so when there is an event it gets the processors