Added cfg file to prepare for dynamic reconfigure, created setup.py, modified CMakeLists.txt and copied test_speed_control.launch to tests