testing psuedo-APLite algorithm with robot