Added initialization of PDs with configuration file. Already tested. Needs yet to be tested in the real robot.
Check previous commit