Ordering Commands by level floor : Algorithm improving almost finished