Towards multipurpose autonomous manipulation with the UJI service robot