The weekend's testing had ups and downs. In balance, I'm doomed.
I'm not giving up but basically what happened is that on Saturday, I crashed more than I made it around. I did make it fairly consistently through the first 3 turns. Going into Sunday I had a tiny bit of hope that I could fix what I thought was the problem: gyro bias. I was wrong. The robot never made it past the 2nd corner. But I think I know what's wrong. Maybe.
So here I am with no more time to test at SFE during the day and no obstacle avoidance, still, and basically not much shot of anything. But I did realize something.The problem isn't simply gyro bias. It's that the Kalman Filter isn't able to merge Gyro heading rate and GPS heading together if the truck turns too sharply.
Here's a plot of heading from an early run where I made it around the building (albeit bouncing off a curb). Notice how the Gyro heading (green) drifts pretty fast but the Kalman estimate (red) is close to the GPS heading (blue), while still retaining some dynamic range from the gyro. Here, the robot made turns at about 5 m/s or about 30°/sec heading rate.
I'm making a late-night run to Boulder to test my theory. It probably will turn out poorly but one can always hope.