(R_est, R_gt)
| 33 | return R_avg |
| 34 | |
| 35 | def rad_error(R_est, R_gt): |
| 36 | cosvalue = np.trace(R_est @ R_gt.T) - 1 |
| 37 | cosvalue = min(1, cosvalue) |
| 38 | cosvalue = max(-1, cosvalue) |
| 39 | return np.arccos(cosvalue) |
| 40 | |
| 41 | def ATE_TEASER(R_est,t_est,R_gt,t_gt): |
| 42 | # R_est: 3x3N |
nothing calls this directly
no outgoing calls
no test coverage detected