1.Change the hierarchy of the RigidBodyConstraint, now robot and tspan are shared by the RigidBodyConstraint
2.Delete 'setActive' method in QuasiStaticConstraint, it is confusing