Fixed all logic for path creation. TODO: Need to draw to screen.