many improvements + laser scans (ready for SLAM?)