Made some progress with the laser scanner, though I'm currently getting incorrect measurements when the robot is moving