Added bounding box constraint so h >= 0
Merge pull request #2 from avalenzu/trajopt

InverseKin and RigidBodyConstraint updates
Fixes related to failing unit tests.
Fix MultipleTimeKinematicConstraint & testKinCnst
Fix testQuasiStaticConstraint