Task, motion planning of objects in contact, task level programming, not robot level