Fixed the ARM code, now it's pretty accurate. THUMB work next.