mirror of
https://github.com/opencv/opencv.git
synced 2024-12-15 09:49:13 +08:00
8b7e586faa
Complement PR: #3366@contrib Changes OdometryFrame losts its getters: a user can provide data at construction stage only, pyramids and other generated data is read-only now OdometryFrame is based on UMats: no TMat templates inside, CPU operations are done with UMat::getMat() method, chaining issues are solved ad-hoc No more Odometry::createOdometryFrame() method, frames are compatible with all odometry algorithms Normals computer is cached inside Odometry and exposed to API as well as its settings Volume::raycast() won't return the result in OdometryFrame anymore Added test for Odometry::prepareFrame*() & other test fixes Minor code improvements TODOs: fix TODOs in code lower acceptable accuracy errors
57 lines
1.8 KiB
Python
57 lines
1.8 KiB
Python
#!/usr/bin/env python
|
|
|
|
import numpy as np
|
|
import cv2 as cv
|
|
|
|
from tests_common import NewOpenCVTests
|
|
|
|
class odometry_test(NewOpenCVTests):
|
|
def commonOdometryTest(self, needRgb, otype):
|
|
depth = self.get_sample('cv/rgbd/depth.png', cv.IMREAD_ANYDEPTH).astype(np.float32)
|
|
if needRgb:
|
|
rgb = self.get_sample('cv/rgbd/rgb.png', cv.IMREAD_ANYCOLOR)
|
|
radian = np.radians(1)
|
|
Rt_warp = np.array(
|
|
[[np.cos(radian), -np.sin(radian), 0],
|
|
[np.sin(radian), np.cos(radian), 0],
|
|
[0, 0, 1]], dtype=np.float32
|
|
)
|
|
Rt_curr = np.array(
|
|
[[np.cos(radian), -np.sin(radian), 0, 0],
|
|
[np.sin(radian), np.cos(radian), 0, 0],
|
|
[0, 0, 1, 0],
|
|
[0, 0, 0, 1]], dtype=np.float32
|
|
)
|
|
Rt_res = np.zeros((4, 4))
|
|
|
|
if otype is not None:
|
|
odometry = cv.Odometry(otype)
|
|
else:
|
|
odometry = cv.Odometry()
|
|
warped_depth = cv.warpPerspective(depth, Rt_warp, (640, 480))
|
|
if needRgb:
|
|
warped_rgb = cv.warpPerspective(rgb, Rt_warp, (640, 480))
|
|
isCorrect = odometry.compute(depth, rgb, warped_depth, warped_rgb, Rt_res)
|
|
else:
|
|
isCorrect = odometry.compute(depth, warped_depth, Rt_res)
|
|
|
|
res = np.absolute(Rt_curr - Rt_res).sum()
|
|
eps = 0.15
|
|
self.assertLessEqual(res, eps)
|
|
self.assertTrue(isCorrect)
|
|
|
|
def test_OdometryDefault(self):
|
|
self.commonOdometryTest(False, None)
|
|
|
|
def test_OdometryDepth(self):
|
|
self.commonOdometryTest(False, cv.DEPTH)
|
|
|
|
def test_OdometryRGB(self):
|
|
self.commonOdometryTest(True, cv.RGB)
|
|
|
|
def test_OdometryRGB_Depth(self):
|
|
self.commonOdometryTest(True, cv.RGB_DEPTH)
|
|
|
|
if __name__ == '__main__':
|
|
NewOpenCVTests.bootstrap()
|