Hexapod Robot Mat6 Climbs Stairs

The robot uses lio-sam to localize itself, uses elevation map from ETH to do terrain mapping, and then use direct collocation to generate optimal motion trajectory.