Important improvements

• better floor angle and axis calculation
• unwrap angles to prevent jumps
• faster when load_trc

Full Changelog: v0.5.4...v0.5.5