Version 1.95, add part 1.4 but may still have a wrong astar search in part 1.3