Forward state space planning agent using A*