Goal is now printed (printBoard)

Goal is now printed. It shows the vehicle when a vehicle is on the same
position. Forgot to move the red car in BFSearch, it's commented because
of exception.