You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
23 lines
689 B
23 lines
689 B
import numpy as np
|
|
from scipy.optimize import minimize
|
|
|
|
#保存相机内参、外参等参数
|
|
class Model:
|
|
def __init__(self):
|
|
self.K = np.array([[801.8319, 0, 647.8920],
|
|
[0, 801.7619, 532],
|
|
[0, 0, 1]])
|
|
self.f = 3.6
|
|
self.H = 1019
|
|
self.dx = self.f / self.K[0, 0]
|
|
self.dy = self.f / self.K[1, 1]
|
|
self.u0 = self.K[0, 2]
|
|
self.v0 = self.K[1, 2]
|
|
# self.alpha = 0.7474
|
|
# self.beta = 0.954
|
|
self.alpha = 7.005e-01
|
|
self.beta = 9.143e-01
|
|
# X轴距离车轮线的距离
|
|
self.distance = 60
|
|
self.tire_x = 160
|
|
self.tire_y = 22 |