added comments
corrected transforming coordinate system
deleted comments
deleted comments
Merge remote-tracking branch 'origin/daniela' into calib_test