Working on functionality for pick and place