Added methods in joints and algorithm working on Model to determine if two configurations are equivalent