Arduino 101 (Intel Curie) - IMU rate is low
I am trying to get the IMU measurement from an arduino 101. Even though I am already set the acceleration and gyro rate to 200:
CurieIMU.setGyroRate(200);
CurieIMU.setAccelerometerRate(200);
and set the baud rate to 500000, I can only get the IMU output rate around 40 Hz on the host PC running rosserial_python. I directly publish imu messages from the arduino.
I wonder if anyone has encountered this problem before and how to fix it? Thanks in advance!