Change planner expansion and update logic
- For each goal node N, if its parent goal P in the belonging case is satisfied, then start executing N

Signed-off-by: MHesham <mhesham.fcis@gmail.com>