Create way to configure the transformation of the arms
MoveIt package for controlling the arms individually already exists. Use this package to create a python wrapper to configure the robots - i.e. get the transformation matrix to transform world coordinates into robot coordinates and dump them in some yaml/etc file.