Initial import from SimTK