This is a CoSLAM branch from Dan ping NUS, designed for asctec pelican