Added IMUs.
Added support for joint status structure.