More generic way to realize addPgToUrdfRobot.
Remove unused method initPostureTask2.
Remove deprecated method.