fix(goal planner): fix scenario fail and data race beta/v0.34

fix(goal planner): fix scenario fail and data race beta/v0.34 #170