Added path planning functions and tests. Currently broken, with failing test to be fix when my child is not wanting to play...
Fixed broken get_connected_pieces() function resulting in the planning tests passing properly. Added other tests to validate the internal functions.