添加障碍物判断和转向逻辑(还未完全调通 , go to sleep_(:з」∠)_ )