Simple C klotski solver