Fixed parser to set root transformations to be called with setPos XYZ RPY in robot class