set "zeta" as a parameter for dynamic reconfigure in the .cfg file
gyro drift correction function added in MARG implementation
fix initialization of initial rotation

Thanks to PaulKemppi! Closes #4.