This code actually works.

Minus the hanging bug which appears to be a hardware issue on the sensor
side not the stellaris side.