AICO: Fix cost computation (do not compute cost for 0th step) Cf. #297
AICO: Fix cost computation (do not compute cost for 0th step)
Cf. #297

openhumanoids/exotica,openhumanoids/exotica,openhumanoids/exotica,openhumanoids/exotica