根據長度 傾角 方位計算三維座標

2022-10-11 09:42:13 字數 1734 閱讀 7259

描述一下此問題:已知第乙個點的座標,在這個點基礎上,衍生出去第二個點的長度、傾角、方位,求第二個點的座標

x0-當前鑽桿起點座標-在正東方向上的投影

y0-當前鑽桿起點座標-在正北方向上的投影

z0-當前鑽桿起點座標-垂深

第一顆鑽桿的起點座標為(0,0,0)

pipelength-鑽桿單桿長度

holeinc-當前實測傾角

holeazi-當前實測方位

當前鑽桿三個方向上的位移

垂直方向上的增量

dz:=(pipelegth*sin(p.holeinc*pi/180));

水平方向上的增量

horizonlen-水平投影(斜)

horizonlen:=pipelegth*abs(cos(p.holeinc*pi/180));

dx:=(horizonlen*sin(p.holeazi*pi/180));

dy:=(horizonlen*cos(p.holeazi*pi/180));

當前鑽桿的實測終點座標

x1:=x0+dx;

y1:=y0+dy;

z1:=z0+dz;

將當前鑽桿的終點座標作為下一顆鑽桿的起點座標,重複上述過程,依次計算每顆鑽桿的實測終點座標,至最後一點,即可得到鑽孔在三個方向上實測總位移,即實測靶點座標。

計算實際靶點的終點座標計算

verticaloff_real-總的垂直位移(z1的最終值)

horizenoff_real-總的水平位移( \(\sqrt \))

實際傾角:

holeinc_real:=arctan(verticaloff_real/horizenoff_real)*180/pi;

實際方位:

holeazi_real:=arctan(horizenoff_real_x/horizenoff_real_y)*180/pi;

調整方位角--反正切函式的值,即將方位角對映到北零座標中:

if(holehorizenoff_real_x>0)and (holehorizenoff_real_y<0) then

holeazi_real=holeazi_real+180;

if(holehorizenoff_real_x<0) and (holehorizenoff_real_y<0) then

holeazi_real=holeazi_real+180;

if(holehorizenoff_real_x<0) and (holehorizenoff_real_y>0) then

holeazi_real=holeazi_real+360;

設計鑽孔的計算與單根鑽桿的計算方法相同。

將設計孔深作為鑽桿長度,按照上述公式可以計算出三個方向上的設計位移,然後與實測資料相比較(實測-設計)得到實鑽和設計鑽孔之間的距離誤差和角度誤差(參見文前示意圖)。

cp_zuobiao: function(qidian, zuan_cs);

console.log(temp);

return temp;

},

三維座標 偏轉 三維座標下的旋轉

三維座標的旋轉有以下幾種常見的表示形式 旋轉向量,旋轉矩陣,尤拉角,四元數,下面對這四種表示形式及其之間的轉換進行介紹 旋轉向量 通常為3x1的列向量,向量方向即為旋轉軸,向量的模表示繞軸逆時針旋轉的角度,如旋轉向量v a,b,c 那麼旋轉角度theta sqrt a2 b2 c2 旋轉軸z a t...

python實現三維座標旋轉計算

計算空間三維座標系變換一般都是利用旋轉矩陣或者尤拉公式。python有個scipy庫可以直接用於計算空間三維座標變換。pip install scipyaxis是旋轉軸,radian旋轉角度 弧度 rot matrix linalg.expm np.cross np.eye 3 axis linal...

三維座標 偏轉 天津三維掃瞄

三維掃瞄的概念及儀器種類 三維掃瞄是指集光 機 電和計算機技術於一體的高新技術,主要用於對物體空間外形和結構及色彩進行掃瞄,以獲得物體表面的空間座標。它的重要意義在於能夠將實物的立體資訊轉換為計算機能直接處理的數碼訊號,為實物數位化提供了相當方便快捷的手段。三維掃瞄技術能實現非接觸測量,且具有速度快...