我正在尝试估计与QR码在太空中相关的设备位置。我正在使用均在iOS11中引入的ARKit和Vision框架,但该问题的答案可能并不取决于它们。
使用Vision框架,我可以获得在相机框架中界定QR码的矩形。我想将此矩形与从标准位置转换QR码所需的设备平移和旋转进行匹配。
例如,如果我观察框架:
* *
B
C
A
D
* *
而如果我距QR码1m,以QR码为中心,假设QR码的边长为10cm,我会看到:
* *
A0 B0
D0 C0
* *
这两个帧之间的设备转换是什么?我了解可能无法获得确切的结果,因为观察到的QR码可能略微不是平面的,因此我们正在尝试估算并非完美的事物的仿射变换。
我猜sceneView.pointOfView?.camera?.projectionTransform
它比有用,sceneView.pointOfView?.camera?.projectionTransform?.camera.projectionMatrix
因为后面已经考虑了从ARKit推断出的转换,我对此问题不感兴趣。
我要如何填充
func get transform(
qrCodeRectangle: VNBarcodeObservation,
cameraTransform: SCNMatrix4) {
// qrCodeRectangle.topLeft etc is the position in [0, 1] * [0, 1] of A0
// expected real world position of the QR code in a referential coordinate system
let a0 = SCNVector3(x: -0.05, y: 0.05, z: 1)
let b0 = SCNVector3(x: 0.05, y: 0.05, z: 1)
let c0 = SCNVector3(x: 0.05, y: -0.05, z: 1)
let d0 = SCNVector3(x: -0.05, y: -0.05, z: 1)
let A0, B0, C0, D0 = ?? // CGPoints representing position in
// camera frame for camera in 0, 0, 0 facing Z+
// then get transform from 0, 0, 0 to current position/rotation that sees
// a0, b0, c0, d0 through the camera as qrCodeRectangle
}
====编辑====
在尝试了许多事情之后,我最终使用openCV投影和透视求解器进行相机姿态估计,solvePnP
这为我提供了旋转和平移,该旋转和平移应表示QR码参考中的相机姿态。但是,当使用这些值并放置与逆变换相对应的对象时,QR码应位于相机空间中,我得到的偏移值不准确,并且无法使旋转工作:
// some flavor of pseudo code below
func renderer(_ sender: SCNSceneRenderer, updateAtTime time: TimeInterval) {
guard let currentFrame = sceneView.session.currentFrame, let pov = sceneView.pointOfView else { return }
let intrisics = currentFrame.camera.intrinsics
let QRCornerCoordinatesInQRRef = [(-0.05, -0.05, 0), (0.05, -0.05, 0), (-0.05, 0.05, 0), (0.05, 0.05, 0)]
// uses VNDetectBarcodesRequest to find a QR code and returns a bounding rectangle
guard let qr = findQRCode(in: currentFrame) else { return }
let imageSize = CGSize(
width: CVPixelBufferGetWidth(currentFrame.capturedImage),
height: CVPixelBufferGetHeight(currentFrame.capturedImage)
)
let observations = [
qr.bottomLeft,
qr.bottomRight,
qr.topLeft,
qr.topRight,
].map({ (imageSize.height * (1 - $0.y), imageSize.width * $0.x) })
// image and SceneKit coordinated are not the same
// replacing this by:
// (imageSize.height * (1.35 - $0.y), imageSize.width * ($0.x - 0.2))
// weirdly fixes an issue, see below
let rotation, translation = openCV.solvePnP(QRCornerCoordinatesInQRRef, observations, intrisics)
// calls openCV solvePnP and get the results
let positionInCameraRef = -rotation.inverted * translation
let node = SCNNode(geometry: someGeometry)
pov.addChildNode(node)
node.position = translation
node.orientation = rotation.asQuaternion
}
这是输出:
其中,A,B,C,D是按传递到程序的顺序的QR码角。
旋转手机时,预测的原点会保留在原位,但会从应有的位置偏移。出乎意料的是,如果我改变观察值,我就能纠正这个问题:
// (imageSize.height * (1 - $0.y), imageSize.width * $0.x)
// replaced by:
(imageSize.height * (1.35 - $0.y), imageSize.width * ($0.x - 0.2))
现在,预测的原点稳固地保留在原位。但是我不知道移位值从何而来。
最后,我尝试将方向固定为相对于QR代码参考:
var n = SCNNode(geometry: redGeometry)
node.addChildNode(n)
n.position = SCNVector3(0.1, 0, 0)
n = SCNNode(geometry: blueGeometry)
node.addChildNode(n)
n.position = SCNVector3(0, 0.1, 0)
n = SCNNode(geometry: greenGeometry)
node.addChildNode(n)
n.position = SCNVector3(0, 0, 0.1)
当我直视QR码时,方向很好,但是随后发生了一些与手机旋转有关的偏移:
我有未解决的问题:
- 我该如何解决轮换问题?
- 位置偏移值从何而来?
- 旋转,平移,QRCornerCoordinatesInQRRef,观测值,本征能验证什么简单关系?是O〜K ^ -1 *(R_3x2 | T)Q吗?因为如果是这样的话,那将减少几个数量级。
如果有帮助,请使用以下几个数值:
Intrisics matrix
Mat 3x3
1090.318, 0.000, 618.661
0.000, 1090.318, 359.616
0.000, 0.000, 1.000
imageSize
1280.0, 720.0
screenSize
414.0, 736.0
====编辑2 ====
我注意到,当手机水平平行于QR码时,旋转效果很好(即旋转矩阵为[[a,0,b],[0,1,0],[c,0,d]] ),无论实际的QR码方向是什么:
其他旋转无效。