Add a waist task template in pr2_tasks.py