added files from Robert for RRT arm manipulation for nao