Finished implementation of A*. Closes #328.