Get time measurement from Gyro (ITG3200) done

& stackcmd bugfixes