init all cov matrix as diag
Merge branch 'master' of github.com:yida/bus

Conflicts:
	script/ukf.lua