Change smoothness computation in stomp and add load from file in Move3d trajectory