Added IMU libraries.
Misc. particle filter tweaks.