Decluttering and Sorting Lego Blocks with the Toyota Human Support Robot