Trajectory optimization for cable-driven soft robot locomotion