Fixed issue with init function when using the ITG3200 based on comments from Rogier Colijn