Work on autonomous trajectory following performance and automatic alignment performance

[ElliotScher]

This is going to include general performance improvements such as:

• Improving capture efficiency - start with MJPEG so we're not frame limited.
• Improving pose queuing efficiency
• Verify latency calculation
• Issue could be that camera calibrations are bad, try again with known good calibration method (not matlab), maybe use calibdb