Actually use provided configuration

Now that the gyro configuration is provided with dynamic reconfigure, the code currently is completely ignoring the parameters given to it.  Please merge this quickly to prevent anyone else with a 250 d/s gyro from having a week of hell.