A* optimised by getting rid of collision check, utilizing Cspace, and initializing close_list