added rigidMBS to do model-based smoothing.  IMPORTANT: needs to run within after Matlab Initialization.  To recover old version, just comment out this method.
matlab lib for rigid model-based smoothing