Whole body task planning for JRL