Minor fixes to driver file with IMU sharing. Seems to work consistently.
Added a version without IMU sharing that uses an estimate of the other
agent's ang. vel. Does not seem to work. Not 100% sure implementation is
correct.