Subversion Repositories seema-scanner

Rev

Rev 38 | Rev 48 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 38 Rev 42
Line 159... Line 159...
159 
        std::cout << "Tr[i]" << Tr[i] << std::endl;
 159 
        std::cout << "Tr[i]" << Tr[i] << std::endl;
160 
        std::cout << std::endl;
 160 
        std::cout << std::endl;
161 
    }
 161 
    }
162 
 
 162 
 
163 
    // determine the transformation from rotation stage to camera 0
 163 
    // determine the transformation from rotation stage to camera 0
164 
    cvtools::fitSixDofData(Rc, Tc, Rr, Tr, cal.Rr, cal.Tr);
 164 
    cvtools::handEyeCalibrationTsai(Rc, Tc, Rr, Tr, cal.Rr, cal.Tr);
165 
    cal.Rr = cal.Rr.t();
 - 
 
166 
    cal.Tr = -cal.Rr*cal.Tr;
 - 
 
167 
 
 165 
 
168 
    for(int i=0; i<Rc.size(); i++){
 - 
 
169 
 
 - 
 
170 
//        cv::Matx33f a = cal.Rr*Rc[i];
 - 
 
171 
//        cv::Matx33f b = Rr[i];
 - 
 
172 
 
 - 
 
173 
//        std::cout << "a:" << a << std::endl;
 - 
 
174 
//        std::cout << "b:" << b << std::endl;
 - 
 
175 
 
 - 
 
176 
        cv::Vec3f a = cal.Rr*Tr[i]+cal.Tr;
 - 
 
177 
        cv::Vec3f b = Tc[i];
 - 
 
178 
 
 - 
 
179 
        std::cout << "a:" << a << std::endl;
 - 
 
180 
        std::cout << "b:" << b << std::endl;
 - 
 
181 
    }
 - 
 
182 
    cv::Mat rrvec;
 166 
    cv::Mat rrvec;
183 
    cv::Rodrigues(cal.Rr, rrvec);
 167 
    cv::Rodrigues(cal.Rr, rrvec);
184 
    std::cout << "rrvec:" << rrvec << std::endl;
 168 
    std::cout << "rrvec:" << rrvec << std::endl;
185 
 
 169 
 
186 
    // Print to std::cout
 170 
    // Print to std::cout