Fixed covariance array indexes
Only set the first array index to be -1 for orientation covariance
Made kvh now publish integrated rotation
Fixed some bugs with using the IMU
Merge branch 'master' into development

Conflicts:
	kvh_driver/src/nodes/kvh_driver_node.cpp