Update gyro configuration

Now it reads device ID.
- Set gyroscope to SPI1
- Fix minor bugs