Fix delay_ms() bug, keymatrix functional.
Fix some glitching, send packet.

Still not perfectly happy with keymatrix, an improbably long delay is
necessary to eliminate glitches.