JugglerOptiTrackMbedEsconSolution SoftTrunk code for 3D version of soft arm using rigid body model approach 3rd 3rd party libraries as submodules