Optimal Path Following Control with Efficient Computation for Snake Robots Subject to Multiple Constraints and Unknown Frictions