Updated for Wii remote control
Many of the sleep functions have been removed from the
drive_motor() functions to llow wiimote to control properlly.