Added method to begin correcting Issue #19

Added method to retrieve the PIDConfiguration in LinkConfiguration
Write PIDconfig with Link Config (more for #19)

Added code to setLinkConfiguration() to also configure the PID
controller for that link.