Fixed minor errors
Handle comparisons between slam_results with different initial_states in planar_robot::map_rmse
Store rotation as scalar angle (Eigen::Rotation2Dd) instead of std::complex in planar_robot::{pose,position}
Maintain current state instead of accumulating bitree every time step, hopefully improving numerical precision