fixed transformation issues by adding imu2cam transform
first g2o tests, not working
first g2o working example using custom types..
added initial sbi functionality
forgot to add these
testing