Added basic code to calculate std error in sensor and correct for it.
Added basic complementry filter.

	modified:   ins_driver.go
	new file:   motioncalc.go
	modified:   navicomp.go