Fixed possible bug in GazeboYarpIMUDriver