Added funtion to read and write register in dynamic_reconfigure
0.0.3