sub-optimal a-star impl
simple test script