Optimal path following control with efficient computation for snake robots subject to multiple constraints and unknown frictions