Software for the mobile manipulation robot Homemate, part of the KORUS project