Roby,
Would you need centimeter resolution ? Or is the IMU travelling incredibly fast ? Bill did code up centimeter resolution. I use it. It is not yet in master.
At 40hz the normal SERIAL_UDB_EXTRA data will exceed the standard serial device interface, and characters will drop.
So you would have to re-engineer the telemetry to cut down on characters transmitted. You would need to cut out the telemetry that flan.pyw does not need for Google Earth. Flan.pyw should plot data at any frequency that it is presented with. e.g. If you move from 4Hz to 8Hz, I think that flan.pyw will seamlessly just plot the data.
At 40Hz for a normal RC flight, the model planes in Google Earth will overlap hugely. So it would look ugly and be hard to resolve visually. The time slider in GE does not have a very fine resolution. And GE will get quite slow if too much data is thrown at it for a given flight.
Best wishes, Pete