室内清扫机器人环境搭建与算法测试简易代码

室内清扫机器人简易代码，由于时间紧张，地图构建和智能规划算法还没有研究，

给出已经完成的部分内容，抛砖引玉吧。