Fixed rvec and tvec to correct types (CV_64F)

Using CV_32F produced junk results.