Incorporate some code improvements, mostly related to IMU but not only.
merged
mentioned in commit 431927b9