Simple example of bundle adjustment. Implemented in MATLAB using SE3 parameterization. Credit for 'rodrigues.m' and 'skew3.m' goes to Andrea Mennucci.