Halfway Done Debugging makePlanToState

Preben rearranged the code to put the right state id on the front.
I've added a couple print methods and currently the program exits
the first time it generates a plan (for debugging).  Right now
the plans it creates don't seem to be correct.
Added toString method
Fixed compiler warning

Unneeded import.