Better maze generation

Now working with waypoints. Needs to get a lot more refined, though