Really basic operation is working. Need to add things like offsets from the ground, walls, etc to make it work better.