move Specification::equals() into test utilities

[airballking]

The equals method is only used during unit tests. So, it makes sense to move them there.

[airballking]

In fact, I think I can get rid of that code completely: Always evaluate the test specifications, and then use KDL::Equal for comparison. That should do the trick.