Update ITG3200.cpp