Adaptive Control of Soft Robots Based on an Enhanced 3D Augmented Rigid Robot Matching