PIMU data parsing improved