Added a custom wait function to enable interrupts

Fork of m3pi by Chris Styles

m3pi.cpp/shortlog@35c3c0fa2416: not found in manifest