1.把起点加入open list。2.重复如下过程：a.遍历open list，查找F值最小的节点，把它作为当前要处理的节点。b.把这个节点移到close list。c.对当前方格的8个相邻方格的每一个方格？◆如果它是不可抵达的或者它在close list中，忽略它。否则，做如下操作。◆如果它不在open list中，把它加入open list...

teb局部规划器部分源码解析

template<class T, int size>void CStack<T, size>::extend_space(int length) {T* temp_buf = new T[m_nSize+ length];memcpy(temp_buf, m_pBuf, sizeof(T)* m_nSize);m_nSize += length;delete []m_pB