Control of a two arms robot