Energy Shaping Control OF Soft Robots