该算法在matlab语言中实现，包含障碍物模型优化、平滑处理和启发函数改进，用户可根据实际情况自定义环境地图，代码附有详细注释。