Add data line wiggling for testing
Add USB Measurement delay

Rippled through to several other changes.