Update decoding of gyro; firmware now sets up the range +- 500, comparing to +- 2000 which were before. Also fix incorrect decoding, which we had before (for +/- 1000)