Coupled joints identification

Merging coupledJoint branch with master