Merged with 0.6_STABLE + Tilting LaserScan