Create map of the lab (bad quality), get the leap motion working (RPY)