implement first draft of imu constant rate query mode

[kawindme]

Fixes #143

A quick test shows that this seems to work. More thorough testing should be done before merging. Performance still needs to be evaluated (ref #144 )