More testing of omega estimation in 3d coop estimation
Not working... consistently. Sometimes seems to get angular velocity somewhat accurately. Not sure if observability problem, motion problem, something else
Tried implementing particle filter, so far does not seem to work. Not sure that implementation or starting code is correct.