P-satI-D Shape Regulation of Soft Robots