添加对python算法的支持
This commit is contained in:
@@ -0,0 +1,933 @@
|
||||
import numpy as np
|
||||
from thickness_utils import warnlogic
|
||||
|
||||
|
||||
def strng2(x, left_edge, right_edge, flag=1):
|
||||
"""
|
||||
计算 X 射线穿过圆形/圆柱形截面物体时,在每个像素位置处的材料路径长度(厚度)。
|
||||
|
||||
对应 Matlab 的 strng2 函数。
|
||||
|
||||
参数:
|
||||
x: numpy.ndarray - 像素位置坐标数组
|
||||
left_edge: float - 物体左边缘位置
|
||||
right_edge: float - 物体右边缘位置
|
||||
flag: int - 计算模式标志 (默认1: 标准圆形截面路径长度)
|
||||
|
||||
返回:
|
||||
numpy.ndarray: 与 x 同长度的数组,每个位置处的材料厚度
|
||||
物体外的位置返回 0
|
||||
"""
|
||||
x = np.asarray(x, dtype=np.float64)
|
||||
|
||||
if right_edge <= left_edge:
|
||||
return np.zeros_like(x)
|
||||
|
||||
center = (left_edge + right_edge) / 2.0
|
||||
radius = (right_edge - left_edge) / 2.0
|
||||
|
||||
dx = x - center
|
||||
inside = np.abs(dx) <= radius
|
||||
|
||||
s = np.zeros_like(x)
|
||||
s[inside] = 2.0 * np.sqrt(radius**2 - dx[inside]**2)
|
||||
|
||||
return s
|
||||
|
||||
|
||||
def strngellips(x, left_edge, right_edge, other_axis_diameter, flag=1):
|
||||
"""
|
||||
计算 X 射线穿过椭圆形截面物体时,在每个像素位置处的材料路径长度(厚度)。
|
||||
|
||||
对应 Matlab 的 strngellips 函数。
|
||||
|
||||
参数:
|
||||
x: numpy.ndarray - 像素位置坐标数组(沿当前扫描轴)
|
||||
left_edge: float - 椭圆在当前扫描轴上的左边缘
|
||||
right_edge: float - 椭圆在当前扫描轴上的右边缘
|
||||
other_axis_diameter: float - 椭圆另一个正交轴的直径
|
||||
flag: int - 计算模式标志 (默认1: 标准椭圆截面路径长度)
|
||||
|
||||
返回:
|
||||
numpy.ndarray: 与 x 同长度的数组,每个位置处的材料厚度
|
||||
物体外的位置返回 0
|
||||
"""
|
||||
x = np.asarray(x, dtype=np.float64)
|
||||
|
||||
if right_edge <= left_edge or other_axis_diameter <= 0:
|
||||
return np.zeros_like(x)
|
||||
|
||||
a = (right_edge - left_edge) / 2.0
|
||||
b = other_axis_diameter / 2.0
|
||||
center = (left_edge + right_edge) / 2.0
|
||||
|
||||
dx = x - center
|
||||
inside = np.abs(dx) <= a
|
||||
|
||||
s = np.zeros_like(x)
|
||||
ratio = (dx[inside] / a) ** 2
|
||||
ratio = np.clip(ratio, 0.0, 1.0)
|
||||
s[inside] = 2.0 * b * np.sqrt(1.0 - ratio)
|
||||
|
||||
return s
|
||||
|
||||
|
||||
def xy_correct(xL_x, xR_x, xL_y, xR_y, x0_x, y0_x, xCCD_x, yCCD_x,
|
||||
x0_y, y0_y, xCCD_y, yCCD_y, gamma_x, gamma_y,
|
||||
status_x, status_y, statusL_x, statusR_x, statusL_y, statusR_y,
|
||||
delta_xk, delta_yk, kx, ky, mode, layeruse):
|
||||
xL_x = np.atleast_2d(np.asarray(xL_x, dtype=np.float64))
|
||||
xR_x = np.atleast_2d(np.asarray(xR_x, dtype=np.float64))
|
||||
xL_y = np.atleast_2d(np.asarray(xL_y, dtype=np.float64))
|
||||
xR_y = np.atleast_2d(np.asarray(xR_y, dtype=np.float64))
|
||||
status_x = np.atleast_2d(np.asarray(status_x, dtype=np.float64))
|
||||
status_y = np.atleast_2d(np.asarray(status_y, dtype=np.float64))
|
||||
statusL_x = np.atleast_2d(np.asarray(statusL_x, dtype=np.float64))
|
||||
statusR_x = np.atleast_2d(np.asarray(statusR_x, dtype=np.float64))
|
||||
statusL_y = np.atleast_2d(np.asarray(statusL_y, dtype=np.float64))
|
||||
statusR_y = np.atleast_2d(np.asarray(statusR_y, dtype=np.float64))
|
||||
|
||||
if kx is None or len(kx) == 0:
|
||||
kx = np.zeros(32)
|
||||
kx[27] = 1.0
|
||||
ky = np.zeros(32)
|
||||
ky[27] = 1.0
|
||||
else:
|
||||
kx = np.asarray(kx, dtype=np.float64).flatten()
|
||||
ky = np.asarray(ky, dtype=np.float64).flatten()
|
||||
if len(kx) == 40:
|
||||
kx = kx[:32]
|
||||
ky = ky[:32]
|
||||
|
||||
if gamma_x is None:
|
||||
gamma_x = 90.0
|
||||
gamma_y = 90.0
|
||||
|
||||
VALID = 0
|
||||
LOW_LEVEL_ERR = 1
|
||||
XL00_DETECT_ERR = 2
|
||||
XR00_DETECT_ERR = 3
|
||||
XL11_DETECT_ERR = 4
|
||||
XR11_DETECT_ERR = 5
|
||||
NO_CABLE_ERR = 6
|
||||
LOW_RADIATION_ERR = 9
|
||||
DOUBLE_ERR = 10
|
||||
OUTER_DM_ERR = 14
|
||||
CORE_DM_ERR = 15
|
||||
OSC_ERR = 16
|
||||
ISC_ERR = 17
|
||||
SCANNER_DATA_ERR = 18
|
||||
CONF_DATA_ERR = 19
|
||||
CHKSPEED_ERR = 24
|
||||
WINDOW_DIRTY_ERR = 25
|
||||
LAYER_NOT_REQUESTED = 45
|
||||
CAM_SYSERR = 251
|
||||
GV_OFF_SYSERR = 252
|
||||
HV_OFF_SYSERR = 253
|
||||
|
||||
globalfailure = np.array([LOW_LEVEL_ERR, XL00_DETECT_ERR, XR00_DETECT_ERR,
|
||||
XL11_DETECT_ERR, XR11_DETECT_ERR, NO_CABLE_ERR,
|
||||
LOW_RADIATION_ERR, DOUBLE_ERR, SCANNER_DATA_ERR,
|
||||
CONF_DATA_ERR, CHKSPEED_ERR, WINDOW_DIRTY_ERR,
|
||||
CAM_SYSERR, GV_OFF_SYSERR, HV_OFF_SYSERR] + list(range(180, 221)))
|
||||
|
||||
dmOut = np.zeros((3, 2))
|
||||
dmOut[1, :] = 255
|
||||
oscL = np.zeros((3, 2))
|
||||
oscR = np.zeros((3, 2))
|
||||
oscL[1, :] = 255
|
||||
oscR[1, :] = 255
|
||||
isoL = np.zeros((3, 2))
|
||||
isoR = np.zeros((3, 2))
|
||||
isoL[1, :] = 255
|
||||
isoR[1, :] = 255
|
||||
iscL = np.zeros((3, 2))
|
||||
iscR = np.zeros((3, 2))
|
||||
iscL[1, :] = 255
|
||||
iscR[1, :] = 255
|
||||
coreDm = np.zeros((3, 2))
|
||||
coreDm[1, :] = 255
|
||||
wthL = np.zeros((3, 2))
|
||||
wthR = np.zeros((3, 2))
|
||||
wthL[1, :] = 255
|
||||
wthR[1, :] = 255
|
||||
xk = np.zeros((3, 4))
|
||||
yk = np.zeros((3, 4))
|
||||
xk[1, :] = 255
|
||||
yk[1, :] = 255
|
||||
|
||||
gamma_x = gamma_x * np.pi / 180.0
|
||||
gamma_y = gamma_y * np.pi / 180.0
|
||||
|
||||
beta_x = np.zeros(4)
|
||||
beta_y = np.zeros(4)
|
||||
tgBeta_x = np.zeros(4)
|
||||
tgBeta_y = np.zeros(4)
|
||||
rL_x = np.zeros(4)
|
||||
rL_y = np.zeros(4)
|
||||
rR_x = np.zeros(4)
|
||||
rR_y = np.zeros(4)
|
||||
|
||||
for n in range(4):
|
||||
if mode == 1:
|
||||
denomLx = x0_x - xCCD_x - xL_x[0, n] * np.cos(gamma_x)
|
||||
denomRx = x0_x - xCCD_x - xR_x[0, n] * np.cos(gamma_x)
|
||||
if abs(denomLx) < 1e-15:
|
||||
denomLx = 1e-15
|
||||
if abs(denomRx) < 1e-15:
|
||||
denomRx = 1e-15
|
||||
beta_x[n] = 0.5 * (
|
||||
np.arctan((xL_x[0, n] * np.sin(gamma_x) - y0_x + yCCD_x) / denomLx) +
|
||||
np.arctan((xR_x[0, n] * np.sin(gamma_x) - y0_x + yCCD_x) / denomRx)
|
||||
)
|
||||
tgBeta_x[n] = np.tan(beta_x[n])
|
||||
|
||||
denomLy = y0_y - yCCD_y - xL_y[0, n] * np.cos(gamma_y)
|
||||
denomRy = y0_y - yCCD_y - xR_y[0, n] * np.cos(gamma_y)
|
||||
if abs(denomLy) < 1e-15:
|
||||
denomLy = 1e-15
|
||||
if abs(denomRy) < 1e-15:
|
||||
denomRy = 1e-15
|
||||
beta_y[n] = 0.5 * (
|
||||
np.arctan((xL_y[0, n] * np.sin(gamma_y) - x0_y + xCCD_y) / denomLy) +
|
||||
np.arctan((xR_y[0, n] * np.sin(gamma_y) - x0_y + xCCD_y) / denomRy)
|
||||
)
|
||||
tgBeta_y[n] = np.tan(beta_y[n])
|
||||
else:
|
||||
tgBeta_x[n] = ((xL_x[0, n] + xR_x[0, n]) / 2.0 - y0_x + yCCD_x) / (x0_x - xCCD_x)
|
||||
beta_x[n] = tgBeta_x[n]
|
||||
tgBeta_y[n] = ((xL_y[0, n] + xR_y[0, n]) / 2.0 - x0_y + xCCD_y) / (y0_y - yCCD_y)
|
||||
beta_y[n] = tgBeta_y[n]
|
||||
|
||||
if abs(tgBeta_y[n]) > 1e-15:
|
||||
xk[0, n] = (tgBeta_x[n] * x0_x + y0_x - 1.0 / tgBeta_y[n] * x0_y - y0_y) / (tgBeta_x[n] - 1.0 / tgBeta_y[n])
|
||||
else:
|
||||
xk[0, n] = x0_y
|
||||
yk[0, n] = -(xk[0, n] - x0_x) * tgBeta_x[n] + y0_x
|
||||
|
||||
xk[0, n] = xk[0, n] + delta_xk
|
||||
yk[0, n] = yk[0, n] + delta_yk
|
||||
|
||||
if (not statusL_x[0, n]) and (not statusR_x[0, n]) and (not statusL_y[0, n]) and (not statusR_y[0, n]):
|
||||
xk[1, n] = VALID
|
||||
yk[1, n] = VALID
|
||||
|
||||
if statusL_x[0, 1] or statusR_x[0, 1] or statusL_y[0, 1] or statusR_y[0, 1]:
|
||||
xk[0, 1] = xk[0, 0]
|
||||
yk[0, 1] = yk[0, 0]
|
||||
beta_x[1] = beta_x[0]
|
||||
beta_y[1] = beta_y[0]
|
||||
tgBeta_x[1] = tgBeta_x[0]
|
||||
tgBeta_y[1] = tgBeta_y[0]
|
||||
if statusL_x[0, 3] or statusR_x[0, 3] or statusL_y[0, 3] or statusR_y[0, 3]:
|
||||
xk[0, 3] = xk[0, 0]
|
||||
yk[0, 3] = yk[0, 0]
|
||||
beta_x[3] = beta_x[0]
|
||||
beta_y[3] = beta_y[0]
|
||||
tgBeta_x[3] = tgBeta_x[0]
|
||||
tgBeta_y[3] = tgBeta_y[0]
|
||||
if statusL_x[0, 2] or statusR_x[0, 2] or statusL_y[0, 2] or statusR_y[0, 2]:
|
||||
xk[0, 2] = xk[0, 3]
|
||||
yk[0, 2] = yk[0, 3]
|
||||
beta_x[2] = beta_x[3]
|
||||
beta_y[2] = beta_y[3]
|
||||
tgBeta_x[2] = tgBeta_x[3]
|
||||
tgBeta_y[2] = tgBeta_y[3]
|
||||
|
||||
for n in range(4):
|
||||
ek_x = np.sqrt((x0_x - xk[0, n])**2 + (y0_x - yk[0, n])**2)
|
||||
ek_y = np.sqrt((x0_y - xk[0, n])**2 + (y0_y - yk[0, n])**2)
|
||||
|
||||
if mode == 1:
|
||||
denomLx = x0_x - xCCD_x - xL_x[0, n] * np.cos(gamma_x)
|
||||
denomRx = x0_x - xCCD_x - xR_x[0, n] * np.cos(gamma_x)
|
||||
if abs(denomLx) < 1e-15:
|
||||
denomLx = 1e-15
|
||||
if abs(denomRx) < 1e-15:
|
||||
denomRx = 1e-15
|
||||
alphaL_x = np.arctan((xL_x[0, n] * np.sin(gamma_x) - y0_x + yCCD_x) / denomLx) - beta_x[n]
|
||||
alphaR_x = np.arctan((xR_x[0, n] * np.sin(gamma_x) - y0_x + yCCD_x) / denomRx) - beta_x[n]
|
||||
|
||||
denomLy = y0_y - yCCD_y - xL_y[0, n] * np.cos(gamma_y)
|
||||
denomRy = y0_y - yCCD_y - xR_y[0, n] * np.cos(gamma_y)
|
||||
if abs(denomLy) < 1e-15:
|
||||
denomLy = 1e-15
|
||||
if abs(denomRy) < 1e-15:
|
||||
denomRy = 1e-15
|
||||
alphaL_y = np.arctan((xL_y[0, n] * np.sin(gamma_y) - x0_y + xCCD_y) / denomLy) - beta_y[n]
|
||||
alphaR_y = np.arctan((xR_y[0, n] * np.sin(gamma_y) - x0_y + xCCD_y) / denomRy) - beta_y[n]
|
||||
else:
|
||||
alphaL_x = ((xL_x[0, n] - y0_x + yCCD_x) / (x0_x - xCCD_x)) - tgBeta_x[n]
|
||||
alphaR_x = ((xR_x[0, n] - y0_x + yCCD_x) / (x0_x - xCCD_x)) - tgBeta_x[n]
|
||||
alphaL_y = ((xL_y[0, n] - x0_y + xCCD_y) / (y0_y - yCCD_y)) - tgBeta_y[n]
|
||||
alphaR_y = ((xR_y[0, n] - x0_y + xCCD_y) / (y0_y - yCCD_y)) - tgBeta_y[n]
|
||||
|
||||
if mode == 1:
|
||||
rL_x[n] = abs(ek_x * np.sin(alphaL_x))
|
||||
rR_x[n] = abs(ek_x * np.sin(alphaR_x))
|
||||
rL_y[n] = abs(ek_y * np.sin(alphaL_y))
|
||||
rR_y[n] = abs(ek_y * np.sin(alphaR_y))
|
||||
else:
|
||||
rL_x[n] = abs(ek_x * alphaL_x)
|
||||
rR_x[n] = abs(ek_x * alphaR_x)
|
||||
rL_y[n] = abs(ek_y * alphaL_y)
|
||||
rR_y[n] = abs(ek_y * alphaR_y)
|
||||
|
||||
if len(kx) == 30:
|
||||
poly_terms = lambda xv, yv, rv: np.array([
|
||||
1, xv, xv*yv, xv*yv*(2*rv), xv*yv*(2*rv)**2,
|
||||
xv*yv**2, xv*yv**2*(2*rv), xv*yv**2*(2*rv)**2,
|
||||
xv*(2*rv), xv*(2*rv)**2, xv**2, xv**2*yv,
|
||||
xv**2*yv*(2*rv), xv**2*yv*(2*rv)**2, xv**2*yv**2,
|
||||
xv**2*yv**2*(2*rv), xv**2*yv**2*(2*rv)**2,
|
||||
xv**2*(2*rv), xv**2*(2*rv)**2, xv**3, yv,
|
||||
yv*(2*rv), yv*(2*rv)**2, yv**2, yv**2*(2*rv),
|
||||
yv**2*(2*rv)**2, yv**3, (2*rv), (2*rv)**2, (2*rv)**3
|
||||
])
|
||||
rL_x[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rL_x[n]), kx[:30])
|
||||
rR_x[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rR_x[n]), kx[:30])
|
||||
rL_y[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rL_y[n]), ky[:30])
|
||||
rR_y[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rR_y[n]), ky[:30])
|
||||
elif len(kx) == 32:
|
||||
poly_terms = lambda xv, yv, rv: np.array([
|
||||
1, xv, xv*yv, xv*yv*(2*rv), xv*yv*(2*rv)**2,
|
||||
xv*yv**2, xv*yv**2*(2*rv), xv*yv**2*(2*rv)**2,
|
||||
xv*(2*rv), xv*(2*rv)**2, xv**2, xv**2*yv,
|
||||
xv**2*yv*(2*rv), xv**2*yv*(2*rv)**2, xv**2*yv**2,
|
||||
xv**2*yv**2*(2*rv), xv**2*yv**2*(2*rv)**2,
|
||||
xv**2*(2*rv), xv**2*(2*rv)**2, xv**3, yv,
|
||||
yv*(2*rv), yv*(2*rv)**2, yv**2, yv**2*(2*rv),
|
||||
yv**2*(2*rv)**2, yv**3, (2*rv), (2*rv)**2, (2*rv)**3,
|
||||
xv**4, yv**4
|
||||
])
|
||||
rL_x[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rL_x[n]), kx)
|
||||
rR_x[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rR_x[n]), kx)
|
||||
rL_y[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rL_y[n]), ky)
|
||||
rR_y[n] = 0.5 * np.dot(poly_terms(xk[0, n], yk[0, n], rR_y[n]), ky)
|
||||
|
||||
if (not statusL_x[0, 0]) and (not statusR_x[0, 0]) and (not statusL_y[0, 0]) and (not statusR_y[0, 0]):
|
||||
dmOut[0, 0] = rL_x[0] + rR_x[0]
|
||||
dmOut[0, 1] = rL_y[0] + rR_y[0]
|
||||
dmOut[1, :] = VALID
|
||||
|
||||
if not statusL_x[0, 1]:
|
||||
oscL[0, 0] = rL_x[0] - rL_x[1] + (yk[0, 1] - yk[0, 0])
|
||||
oscL[1, 0] = VALID
|
||||
else:
|
||||
oscL[1, 0] = statusL_x[0, 1]
|
||||
if not statusR_x[0, 1]:
|
||||
oscR[0, 0] = rR_x[0] - rR_x[1] - (yk[0, 1] - yk[0, 0])
|
||||
oscR[1, 0] = VALID
|
||||
else:
|
||||
oscR[1, 0] = statusR_x[0, 1]
|
||||
if not statusL_y[0, 1]:
|
||||
oscL[0, 1] = rL_y[0] - rL_y[1] + (xk[0, 1] - xk[0, 0])
|
||||
oscL[1, 1] = VALID
|
||||
else:
|
||||
oscL[1, 1] = statusL_y[0, 1]
|
||||
if not statusR_y[0, 1]:
|
||||
oscR[0, 1] = rR_y[0] - rR_y[1] - (xk[0, 1] - xk[0, 0])
|
||||
oscR[1, 1] = VALID
|
||||
else:
|
||||
oscR[1, 1] = statusR_y[0, 1]
|
||||
|
||||
if not statusL_x[0, 3]:
|
||||
wthL[0, 0] = rL_x[0] - rL_x[3] + (yk[0, 3] - yk[0, 0])
|
||||
wthL[1, 0] = VALID
|
||||
else:
|
||||
wthL[1, 0] = statusL_x[0, 3]
|
||||
if not statusR_x[0, 3]:
|
||||
wthR[0, 0] = rR_x[0] - rR_x[3] - (yk[0, 3] - yk[0, 0])
|
||||
wthR[1, 0] = VALID
|
||||
else:
|
||||
wthR[1, 0] = statusR_x[0, 3]
|
||||
if not statusL_y[0, 3]:
|
||||
wthL[0, 1] = rL_y[0] - rL_y[3] + (xk[0, 3] - xk[0, 0])
|
||||
wthL[1, 1] = VALID
|
||||
else:
|
||||
wthL[1, 1] = statusL_y[0, 3]
|
||||
if not statusR_y[0, 3]:
|
||||
wthR[0, 1] = rR_y[0] - rR_y[3] - (xk[0, 3] - xk[0, 0])
|
||||
wthR[1, 1] = VALID
|
||||
else:
|
||||
wthR[1, 1] = statusR_y[0, 3]
|
||||
else:
|
||||
if np.any(np.isin(status_x[0, 0], globalfailure)):
|
||||
dmOut[1, 0] = status_x[0, 0]
|
||||
oscL[1, 0] = status_x[0, 0]
|
||||
oscR[1, 0] = status_x[0, 0]
|
||||
coreDm[1, 0] = status_x[0, 0]
|
||||
wthL[1, 0] = status_x[0, 0]
|
||||
wthR[1, 0] = status_x[0, 0]
|
||||
iscL[1, 0] = status_x[0, 0]
|
||||
iscR[1, 0] = status_x[0, 0]
|
||||
isoL[1, 0] = status_x[0, 0]
|
||||
isoR[1, 0] = status_x[0, 0]
|
||||
else:
|
||||
if statusL_x[0, 0]:
|
||||
dmOut[1, 0] = statusL_x[0, 0]
|
||||
elif statusR_x[0, 0]:
|
||||
dmOut[1, 0] = statusR_x[0, 0]
|
||||
else:
|
||||
dmOut[1, 0] = OUTER_DM_ERR
|
||||
if statusL_x[0, 1]:
|
||||
oscL[1, 0] = statusL_x[0, 1]
|
||||
else:
|
||||
oscL[1, 0] = OUTER_DM_ERR
|
||||
if statusR_x[0, 1]:
|
||||
oscR[1, 0] = statusR_x[0, 1]
|
||||
else:
|
||||
oscR[1, 0] = OUTER_DM_ERR
|
||||
if statusL_x[0, 2]:
|
||||
iscL[1, 0] = statusL_x[0, 2]
|
||||
else:
|
||||
iscL[1, 0] = OUTER_DM_ERR
|
||||
if statusR_x[0, 2]:
|
||||
iscR[1, 0] = statusR_x[0, 2]
|
||||
else:
|
||||
iscR[1, 0] = OUTER_DM_ERR
|
||||
if statusL_x[0, 3]:
|
||||
coreDm[1, 0] = statusL_x[0, 3]
|
||||
elif statusR_x[0, 3]:
|
||||
coreDm[1, 0] = statusR_x[0, 3]
|
||||
else:
|
||||
coreDm[1, 0] = OUTER_DM_ERR
|
||||
wthL[1, 0] = OUTER_DM_ERR
|
||||
wthR[1, 0] = OUTER_DM_ERR
|
||||
isoL[1, 0] = OUTER_DM_ERR
|
||||
isoR[1, 0] = OUTER_DM_ERR
|
||||
|
||||
if np.any(np.isin(status_y[0, 0], globalfailure)):
|
||||
dmOut[1, 1] = status_y[0, 0]
|
||||
oscL[1, 1] = status_y[0, 0]
|
||||
oscR[1, 1] = status_y[0, 0]
|
||||
coreDm[1, 1] = status_y[0, 0]
|
||||
wthL[1, 1] = status_y[0, 0]
|
||||
wthR[1, 1] = status_y[0, 0]
|
||||
iscL[1, 1] = status_y[0, 0]
|
||||
iscR[1, 1] = status_y[0, 0]
|
||||
isoL[1, 1] = status_y[0, 0]
|
||||
isoR[1, 1] = status_y[0, 0]
|
||||
else:
|
||||
if statusL_y[0, 0]:
|
||||
dmOut[1, 1] = statusL_y[0, 0]
|
||||
elif statusR_y[0, 0]:
|
||||
dmOut[1, 1] = statusR_y[0, 0]
|
||||
else:
|
||||
dmOut[1, 1] = OUTER_DM_ERR
|
||||
if statusL_y[0, 1]:
|
||||
oscL[1, 1] = statusL_y[0, 1]
|
||||
else:
|
||||
oscL[1, 1] = OUTER_DM_ERR
|
||||
if statusR_y[0, 1]:
|
||||
oscR[1, 1] = statusR_y[0, 1]
|
||||
else:
|
||||
oscR[1, 1] = OUTER_DM_ERR
|
||||
if statusL_y[0, 2]:
|
||||
iscL[1, 1] = statusL_y[0, 2]
|
||||
else:
|
||||
iscL[1, 1] = OUTER_DM_ERR
|
||||
if statusR_y[0, 2]:
|
||||
iscR[1, 1] = statusR_y[0, 2]
|
||||
else:
|
||||
iscR[1, 1] = OUTER_DM_ERR
|
||||
if statusL_y[0, 3]:
|
||||
coreDm[1, 1] = statusL_y[0, 3]
|
||||
elif statusR_y[0, 3]:
|
||||
coreDm[1, 1] = statusR_y[0, 3]
|
||||
else:
|
||||
coreDm[1, 1] = OUTER_DM_ERR
|
||||
wthL[1, 1] = OUTER_DM_ERR
|
||||
wthR[1, 1] = OUTER_DM_ERR
|
||||
iscL[1, 1] = OUTER_DM_ERR
|
||||
iscR[1, 1] = OUTER_DM_ERR
|
||||
isoL[1, 1] = OUTER_DM_ERR
|
||||
isoR[1, 1] = OUTER_DM_ERR
|
||||
|
||||
if ((not statusL_x[0, 3] and not statusR_x[0, 3] and not statusL_y[0, 3] and not statusR_y[0, 3]) or
|
||||
(not statusL_x[0, 0] and not statusR_x[0, 0] and not statusL_y[0, 0] and not statusR_y[0, 0])):
|
||||
if not statusL_x[0, 3] and not statusR_x[0, 3]:
|
||||
coreDm[0, 0] = rL_x[3] + rR_x[3]
|
||||
coreDm[1, 0] = VALID
|
||||
elif statusL_x[0, 3]:
|
||||
coreDm[1, 0] = statusL_x[0, 3]
|
||||
elif statusR_x[0, 3]:
|
||||
coreDm[1, 0] = statusR_x[0, 3]
|
||||
|
||||
if not statusL_y[0, 3] and not statusR_y[0, 3]:
|
||||
coreDm[0, 1] = rL_y[3] + rR_y[3]
|
||||
coreDm[1, 1] = VALID
|
||||
elif statusL_y[0, 3]:
|
||||
coreDm[1, 1] = statusL_y[0, 3]
|
||||
elif statusR_y[0, 3]:
|
||||
coreDm[1, 1] = statusR_y[0, 3]
|
||||
|
||||
if not statusL_x[0, 2] and not statusL_x[0, 3]:
|
||||
iscL[0, 0] = rL_x[2] - rL_x[3] + (yk[0, 3] - yk[0, 2])
|
||||
iscL[1, 0] = VALID
|
||||
else:
|
||||
if statusL_x[0, 2]:
|
||||
iscL[1, 0] = statusL_x[0, 2]
|
||||
else:
|
||||
iscL[1, 0] = statusL_x[0, 3]
|
||||
|
||||
if not statusR_x[0, 2] and not statusR_x[0, 3]:
|
||||
iscR[0, 0] = rR_x[2] - rR_x[3] - (yk[0, 3] - yk[0, 2])
|
||||
iscR[1, 0] = VALID
|
||||
else:
|
||||
if statusR_x[0, 2]:
|
||||
iscR[1, 0] = statusR_x[0, 2]
|
||||
else:
|
||||
iscR[1, 0] = statusR_x[0, 3]
|
||||
|
||||
if not statusL_y[0, 2] and not statusL_y[0, 3]:
|
||||
iscL[0, 1] = rL_y[2] - rL_y[3] + (xk[0, 3] - xk[0, 2])
|
||||
iscL[1, 1] = VALID
|
||||
else:
|
||||
if statusL_y[0, 2]:
|
||||
iscL[1, 1] = statusL_y[0, 2]
|
||||
else:
|
||||
iscL[1, 1] = statusL_y[0, 3]
|
||||
|
||||
if not statusR_y[0, 2] and not statusR_y[0, 3]:
|
||||
iscR[0, 1] = rR_y[2] - rR_y[3] - (xk[0, 3] - xk[0, 2])
|
||||
iscR[1, 1] = VALID
|
||||
else:
|
||||
if statusR_y[0, 2]:
|
||||
iscR[1, 1] = statusR_y[0, 2]
|
||||
else:
|
||||
iscR[1, 1] = statusR_y[0, 3]
|
||||
|
||||
if (not wthL[1, 0]) and ((not oscL[1, 0]) or oscL[1, 0] == LAYER_NOT_REQUESTED) and ((not iscL[1, 0]) or iscL[1, 0] == LAYER_NOT_REQUESTED):
|
||||
isoL[0, 0] = wthL[0, 0] - oscL[0, 0] - iscL[0, 0]
|
||||
isoL[1, 0] = VALID
|
||||
elif wthL[1, 0]:
|
||||
isoL[1, 0] = wthL[1, 0]
|
||||
elif oscL[1, 0]:
|
||||
isoL[1, 0] = oscL[1, 0]
|
||||
elif iscL[1, 0]:
|
||||
isoL[1, 0] = iscL[1, 0]
|
||||
|
||||
if (not wthL[1, 1]) and ((not oscL[1, 1]) or oscL[1, 1] == LAYER_NOT_REQUESTED) and ((not iscL[1, 1]) or iscL[1, 1] == LAYER_NOT_REQUESTED):
|
||||
isoL[0, 1] = wthL[0, 1] - oscL[0, 1] - iscL[0, 1]
|
||||
isoL[1, 1] = VALID
|
||||
elif wthL[1, 1]:
|
||||
isoL[1, 1] = wthL[1, 1]
|
||||
elif oscL[1, 1]:
|
||||
isoL[1, 1] = oscL[1, 1]
|
||||
elif iscL[1, 1]:
|
||||
isoL[1, 1] = iscL[1, 1]
|
||||
|
||||
if (not wthR[1, 0]) and ((not oscR[1, 0]) or oscR[1, 0] == LAYER_NOT_REQUESTED) and ((not iscR[1, 0]) or iscR[1, 0] == LAYER_NOT_REQUESTED):
|
||||
isoR[0, 0] = wthR[0, 0] - oscR[0, 0] - iscR[0, 0]
|
||||
isoR[1, 0] = VALID
|
||||
elif wthR[1, 0]:
|
||||
isoR[1, 0] = wthR[1, 0]
|
||||
elif oscR[1, 0]:
|
||||
isoR[1, 0] = oscR[1, 0]
|
||||
elif iscR[1, 0]:
|
||||
isoR[1, 0] = iscR[1, 0]
|
||||
|
||||
if (not wthR[1, 1]) and ((not oscR[1, 1]) or oscR[1, 1] == LAYER_NOT_REQUESTED) and ((not iscR[1, 1]) or iscR[1, 1] == LAYER_NOT_REQUESTED):
|
||||
isoR[0, 1] = wthR[0, 1] - oscR[0, 1] - iscR[0, 1]
|
||||
isoR[1, 1] = wthR[1, 1]
|
||||
elif wthR[1, 1]:
|
||||
isoR[1, 1] = wthR[1, 1]
|
||||
elif oscR[1, 1]:
|
||||
isoR[1, 1] = oscR[1, 1]
|
||||
elif iscR[1, 1]:
|
||||
isoR[1, 1] = iscR[1, 1]
|
||||
|
||||
return dmOut, oscL, oscR, isoL, isoR, iscL, iscR, coreDm, wthL, wthR, xk, yk
|
||||
|
||||
|
||||
def modify_cable_position(baseAngle, orientation, height):
|
||||
delta_xk = 0.0
|
||||
delta_yk = 0.0
|
||||
|
||||
if baseAngle == 0:
|
||||
slope = 0.0
|
||||
orientation = 0
|
||||
elif baseAngle == 1:
|
||||
slope = 0.43
|
||||
elif baseAngle == 2:
|
||||
slope = 0.35
|
||||
elif baseAngle == 3:
|
||||
slope = 0.37
|
||||
elif baseAngle == 4:
|
||||
slope = 0.225
|
||||
else:
|
||||
slope = 0.0
|
||||
|
||||
a = slope * height
|
||||
|
||||
if orientation == 0:
|
||||
delta_xk = 0.0
|
||||
delta_yk = 0.0
|
||||
elif orientation == 1:
|
||||
delta_xk = 0.0
|
||||
delta_yk = (height / 2.0 - a)
|
||||
elif orientation == 2:
|
||||
delta_xk = -(height / 2.0 - a)
|
||||
delta_yk = 0.0
|
||||
elif orientation == 3:
|
||||
delta_xk = 0.0
|
||||
delta_yk = -(height / 2.0 - a)
|
||||
elif orientation == 4:
|
||||
delta_xk = (height / 2.0 - a)
|
||||
delta_yk = 0.0
|
||||
else:
|
||||
delta_xk = 0.0
|
||||
delta_yk = 0.0
|
||||
|
||||
return delta_xk, delta_yk
|
||||
|
||||
|
||||
def axis_result(xL_x, xR_x, status_x, statusL_x, statusR_x, mode, layeruse):
|
||||
xL_x = np.atleast_2d(np.asarray(xL_x, dtype=np.float64))
|
||||
xR_x = np.atleast_2d(np.asarray(xR_x, dtype=np.float64))
|
||||
status_x = np.atleast_2d(np.asarray(status_x, dtype=np.float64))
|
||||
statusL_x = np.atleast_2d(np.asarray(statusL_x, dtype=np.float64))
|
||||
statusR_x = np.atleast_2d(np.asarray(statusR_x, dtype=np.float64))
|
||||
# Ensure at least 2 rows (row 0=error code, row 1=warning code)
|
||||
if status_x.shape[0] < 2:
|
||||
status_x = np.vstack([status_x, np.zeros((2 - status_x.shape[0], status_x.shape[1]))])
|
||||
if statusL_x.shape[0] < 2:
|
||||
statusL_x = np.vstack([statusL_x, np.zeros((2 - statusL_x.shape[0], statusL_x.shape[1]))])
|
||||
if statusR_x.shape[0] < 2:
|
||||
statusR_x = np.vstack([statusR_x, np.zeros((2 - statusR_x.shape[0], statusR_x.shape[1]))])
|
||||
layeruse = np.asarray(layeruse, dtype=np.float64).ravel()
|
||||
|
||||
VALID = 0
|
||||
LOW_LEVEL_ERR = 1
|
||||
XL00_DETECT_ERR = 2
|
||||
XR00_DETECT_ERR = 3
|
||||
XL11_DETECT_ERR = 4
|
||||
XR11_DETECT_ERR = 5
|
||||
NO_CABLE_ERR = 6
|
||||
LOW_RADIATION_ERR = 9
|
||||
DOUBLE_ERR = 10
|
||||
OUTER_DM_ERR = 14
|
||||
CORE_DM_ERR = 15
|
||||
OSC_ERR = 16
|
||||
ISC_ERR = 17
|
||||
SCANNER_DATA_ERR = 18
|
||||
CONF_DATA_ERR = 19
|
||||
CHKSPEED_ERR = 24
|
||||
WINDOW_DIRTY_ERR = 25
|
||||
LAYER_NOT_REQUESTED = 45
|
||||
RIFFLE_MATCH_CONFLICT = 90
|
||||
NO_SCAN_DATA_ERR = 240
|
||||
SCANNER_1_TOO_COLD = 241
|
||||
SCANNER_2_TOO_COLD = 242
|
||||
SCANNER_1_TOO_HOT = 243
|
||||
SCANNER_2_TOO_HOT = 244
|
||||
CAM_SYSERR = 251
|
||||
GV_OFF_SYSERR = 252
|
||||
HV_OFF_SYSERR = 253
|
||||
|
||||
globalfailure = np.array([
|
||||
LOW_LEVEL_ERR, XL00_DETECT_ERR, XR00_DETECT_ERR,
|
||||
XL11_DETECT_ERR, XR11_DETECT_ERR, NO_CABLE_ERR,
|
||||
LOW_RADIATION_ERR, DOUBLE_ERR, SCANNER_DATA_ERR,
|
||||
CONF_DATA_ERR, CHKSPEED_ERR, WINDOW_DIRTY_ERR,
|
||||
CAM_SYSERR, GV_OFF_SYSERR, HV_OFF_SYSERR,
|
||||
NO_SCAN_DATA_ERR, SCANNER_1_TOO_COLD, SCANNER_2_TOO_COLD,
|
||||
SCANNER_1_TOO_HOT, SCANNER_2_TOO_HOT
|
||||
] + list(range(180, 221)) + [RIFFLE_MATCH_CONFLICT])
|
||||
|
||||
dmOut = np.zeros((3, 1))
|
||||
dmOut[1, 0] = 255
|
||||
oscL = np.zeros((3, 1))
|
||||
oscL[1, 0] = 255
|
||||
oscR = np.zeros((3, 1))
|
||||
oscR[1, 0] = 255
|
||||
isoL = np.zeros((3, 1))
|
||||
isoL[1, 0] = 255
|
||||
isoR = np.zeros((3, 1))
|
||||
isoR[1, 0] = 255
|
||||
iscL = np.zeros((3, 1))
|
||||
iscL[1, 0] = 255
|
||||
iscR = np.zeros((3, 1))
|
||||
iscR[1, 0] = 255
|
||||
coreDm = np.zeros((3, 1))
|
||||
coreDm[1, 0] = 255
|
||||
wthL = np.zeros((3, 1))
|
||||
wthL[1, 0] = 255
|
||||
wthR = np.zeros((3, 1))
|
||||
wthR[1, 0] = 255
|
||||
xk = np.zeros((3, 4))
|
||||
xk[1, :] = 255
|
||||
rL_x = np.zeros(4)
|
||||
rR_x = np.zeros(4)
|
||||
|
||||
for n in range(4):
|
||||
xk[0, n] = (xL_x[0, n] + xR_x[0, n]) / 2.0
|
||||
if (not statusL_x[0, n]) and (not statusR_x[0, n]):
|
||||
xk[1, n] = VALID
|
||||
|
||||
if statusL_x[0, 1] or statusR_x[0, 1]:
|
||||
xk[0, 1] = xk[0, 0]
|
||||
if statusL_x[0, 3] or statusR_x[0, 3]:
|
||||
xk[0, 3] = xk[0, 0]
|
||||
if statusL_x[0, 2] or statusR_x[0, 2]:
|
||||
xk[0, 2] = xk[0, 3]
|
||||
|
||||
for n in range(4):
|
||||
rL_x[n] = abs(xL_x[0, n] - xk[0, n])
|
||||
rR_x[n] = abs(xR_x[0, n] - xk[0, n])
|
||||
|
||||
if (not statusL_x[0, 0]) and (not statusR_x[0, 0]):
|
||||
dmOut[0, 0] = rL_x[0] + rR_x[0]
|
||||
dmOut[1, 0] = VALID
|
||||
|
||||
if not statusL_x[0, 1]:
|
||||
oscL[0, 0] = rL_x[0] - rL_x[1] + (xk[0, 1] - xk[0, 0])
|
||||
oscL[1, 0] = VALID
|
||||
else:
|
||||
oscL[1, 0] = statusL_x[0, 1]
|
||||
|
||||
if not statusR_x[0, 1]:
|
||||
oscR[0, 0] = rR_x[0] - rR_x[1] - (xk[0, 1] - xk[0, 0])
|
||||
oscR[1, 0] = VALID
|
||||
else:
|
||||
oscR[1, 0] = statusR_x[0, 1]
|
||||
|
||||
if not statusL_x[0, 3]:
|
||||
wthL[0, 0] = rL_x[0] - rL_x[3] + (xk[0, 3] - xk[0, 0])
|
||||
wthL[1, 0] = VALID
|
||||
else:
|
||||
wthL[1, 0] = statusL_x[0, 3]
|
||||
if not statusR_x[0, 3]:
|
||||
wthR[0, 0] = rR_x[0] - rR_x[3] - (xk[0, 3] - xk[0, 0])
|
||||
wthR[1, 0] = VALID
|
||||
else:
|
||||
wthR[1, 0] = statusR_x[0, 3]
|
||||
|
||||
else:
|
||||
if np.any(np.isin(status_x[0, 0], globalfailure)):
|
||||
dmOut[1, 0] = status_x[0, 0]
|
||||
oscL[1, 0] = status_x[0, 0]
|
||||
oscR[1, 0] = status_x[0, 0]
|
||||
coreDm[1, 0] = status_x[0, 0]
|
||||
wthL[1, 0] = status_x[0, 0]
|
||||
wthR[1, 0] = status_x[0, 0]
|
||||
iscL[1, 0] = status_x[0, 0]
|
||||
iscR[1, 0] = status_x[0, 0]
|
||||
isoL[1, 0] = status_x[0, 0]
|
||||
isoR[1, 0] = status_x[0, 0]
|
||||
else:
|
||||
if statusL_x[0, 0]:
|
||||
dmOut[1, 0] = statusL_x[0, 0]
|
||||
elif statusR_x[0, 0]:
|
||||
dmOut[1, 0] = statusR_x[0, 0]
|
||||
else:
|
||||
dmOut[1, 0] = OUTER_DM_ERR
|
||||
if statusL_x[0, 1]:
|
||||
oscL[1, 0] = statusL_x[0, 1]
|
||||
else:
|
||||
oscL[1, 0] = OUTER_DM_ERR
|
||||
if statusR_x[0, 1]:
|
||||
oscR[1, 0] = statusR_x[0, 1]
|
||||
else:
|
||||
oscR[1, 0] = OUTER_DM_ERR
|
||||
if statusL_x[0, 2]:
|
||||
iscL[1, 0] = statusL_x[0, 2]
|
||||
else:
|
||||
iscL[1, 0] = OUTER_DM_ERR
|
||||
if statusR_x[0, 2]:
|
||||
iscR[1, 0] = statusR_x[0, 2]
|
||||
else:
|
||||
iscR[1, 0] = OUTER_DM_ERR
|
||||
if statusL_x[0, 3]:
|
||||
coreDm[1, 0] = statusL_x[0, 3]
|
||||
elif statusR_x[0, 3]:
|
||||
coreDm[1, 0] = statusR_x[0, 3]
|
||||
else:
|
||||
coreDm[1, 0] = OUTER_DM_ERR
|
||||
wthL[1, 0] = OUTER_DM_ERR
|
||||
wthR[1, 0] = OUTER_DM_ERR
|
||||
isoL[1, 0] = OUTER_DM_ERR
|
||||
isoR[1, 0] = OUTER_DM_ERR
|
||||
|
||||
if ((not statusL_x[0, 3] and not statusR_x[0, 3]) or
|
||||
(not statusL_x[0, 0] and not statusR_x[0, 0])):
|
||||
if not statusL_x[0, 3] and not statusR_x[0, 3]:
|
||||
coreDm[0, 0] = rL_x[3] + rR_x[3]
|
||||
coreDm[1, 0] = VALID
|
||||
elif statusL_x[0, 3]:
|
||||
coreDm[1, 0] = statusL_x[0, 3]
|
||||
elif statusR_x[0, 3]:
|
||||
coreDm[1, 0] = statusR_x[0, 3]
|
||||
|
||||
if not statusL_x[0, 2] and not statusL_x[0, 3]:
|
||||
iscL[0, 0] = rL_x[2] - rL_x[3] + (xk[0, 3] - xk[0, 2])
|
||||
iscL[1, 0] = VALID
|
||||
else:
|
||||
if statusL_x[0, 2]:
|
||||
iscL[1, 0] = statusL_x[0, 2]
|
||||
else:
|
||||
iscL[1, 0] = statusL_x[0, 3]
|
||||
if not statusR_x[0, 2] and not statusR_x[0, 3]:
|
||||
iscR[0, 0] = rR_x[2] - rR_x[3] - (xk[0, 3] - xk[0, 2])
|
||||
iscR[1, 0] = VALID
|
||||
else:
|
||||
if statusR_x[0, 2]:
|
||||
iscR[1, 0] = statusR_x[0, 2]
|
||||
else:
|
||||
iscR[1, 0] = statusR_x[0, 3]
|
||||
|
||||
if (not wthL[1, 0] and ((not oscL[1, 0]) or oscL[1, 0] == LAYER_NOT_REQUESTED)
|
||||
and ((not iscL[1, 0]) or iscL[1, 0] == LAYER_NOT_REQUESTED)):
|
||||
isoL[0, 0] = wthL[0, 0] - oscL[0, 0] - iscL[0, 0]
|
||||
isoL[1, 0] = VALID
|
||||
elif wthL[1, 0]:
|
||||
isoL[1, 0] = wthL[1, 0]
|
||||
elif oscL[1, 0] and (layeruse[0] == 1):
|
||||
isoL[1, 0] = oscL[1, 0]
|
||||
elif iscL[1, 0] and (layeruse[2] == 1):
|
||||
isoL[1, 0] = iscL[1, 0]
|
||||
if (not wthR[1, 0] and ((not oscR[1, 0]) or oscR[1, 0] == LAYER_NOT_REQUESTED)
|
||||
and ((not iscR[1, 0]) or iscR[1, 0] == LAYER_NOT_REQUESTED)):
|
||||
isoR[0, 0] = wthR[0, 0] - oscR[0, 0] - iscR[0, 0]
|
||||
isoR[1, 0] = VALID
|
||||
elif wthR[1, 0]:
|
||||
isoR[1, 0] = wthR[1, 0]
|
||||
elif oscR[1, 0] and (layeruse[0] == 1):
|
||||
isoR[1, 0] = oscR[1, 0]
|
||||
elif iscR[1, 0] and (layeruse[2] == 1):
|
||||
isoR[1, 0] = iscR[1, 0]
|
||||
|
||||
warnvek = np.array([statusL_x[1, 0], statusR_x[1, 0], 0, 0])
|
||||
warnall, warnx, dummy = warnlogic(warnvek)
|
||||
dmOut[2, 0] = warnx
|
||||
|
||||
warncore = np.zeros(1)
|
||||
warnvek = np.array([statusL_x[1, 3], statusR_x[1, 3], 0, 0])
|
||||
warnall, warncore[0], dummy = warnlogic(warnvek)
|
||||
|
||||
warnwth = np.zeros(2)
|
||||
warnvek = np.array([statusL_x[1, 0], statusL_x[1, 3], statusR_x[1, 0], statusR_x[1, 3]])
|
||||
warnall, warnwth[0], warnwth[1] = warnlogic(warnvek)
|
||||
|
||||
warnosc = np.zeros(2)
|
||||
warnvek = np.array([statusL_x[1, 0], statusL_x[1, 1], statusR_x[1, 0], statusR_x[1, 1]])
|
||||
warnall, warnosc[0], warnosc[1] = warnlogic(warnvek)
|
||||
|
||||
warnisc = np.zeros(2)
|
||||
warnvek = np.array([statusL_x[1, 2], statusL_x[1, 3], statusR_x[1, 2], statusR_x[1, 3]])
|
||||
warnall, warnisc[0], warnisc[1] = warnlogic(warnvek)
|
||||
|
||||
warniso = np.zeros(2)
|
||||
warnvek = np.array([warnwth[0], warnosc[0], warnisc[0], warnwth[1], warnosc[1], warnisc[1]])
|
||||
warnall, warniso[0], warniso[1] = warnlogic(warnvek)
|
||||
|
||||
if np.array_equal(layeruse, np.array([0, 0, 0])):
|
||||
wthL[0, :] = 0
|
||||
wthR[0, :] = 0
|
||||
wthL[1, :] = LAYER_NOT_REQUESTED
|
||||
wthR[1, :] = LAYER_NOT_REQUESTED
|
||||
oscL[0, :] = 0
|
||||
oscR[0, :] = 0
|
||||
oscL[1, :] = LAYER_NOT_REQUESTED
|
||||
oscR[1, :] = LAYER_NOT_REQUESTED
|
||||
isoL[0, :] = 0
|
||||
isoR[0, :] = 0
|
||||
isoL[1, :] = LAYER_NOT_REQUESTED
|
||||
isoR[1, :] = LAYER_NOT_REQUESTED
|
||||
iscL[0, :] = 0
|
||||
iscR[0, :] = 0
|
||||
iscL[1, :] = LAYER_NOT_REQUESTED
|
||||
iscR[1, :] = LAYER_NOT_REQUESTED
|
||||
coreDm[0, :] = 0
|
||||
coreDm[1, :] = LAYER_NOT_REQUESTED
|
||||
elif np.array_equal(layeruse, np.array([0, 0, 1])):
|
||||
wthL[2, :] = warnwth[[0, 1]]
|
||||
wthR[2, :] = warnwth[1]
|
||||
oscL[0, :] = 0
|
||||
oscR[0, :] = 0
|
||||
oscL[1, :] = LAYER_NOT_REQUESTED
|
||||
oscR[1, :] = LAYER_NOT_REQUESTED
|
||||
isoL[0, :] = 0
|
||||
isoR[0, :] = 0
|
||||
isoL[1, :] = LAYER_NOT_REQUESTED
|
||||
isoR[1, :] = LAYER_NOT_REQUESTED
|
||||
iscL[2, :] = warnisc[0]
|
||||
iscR[2, :] = warnisc[1]
|
||||
coreDm[2, :] = warncore
|
||||
elif np.array_equal(layeruse, np.array([0, 1, 0])):
|
||||
wthL[2, :] = warnwth[0]
|
||||
wthR[2, :] = warnwth[1]
|
||||
oscL[0, :] = 0
|
||||
oscR[0, :] = 0
|
||||
oscL[1, :] = LAYER_NOT_REQUESTED
|
||||
oscR[1, :] = LAYER_NOT_REQUESTED
|
||||
isoL[2, :] = warniso[0]
|
||||
isoR[2, :] = warniso[1]
|
||||
iscL[0, :] = 0
|
||||
iscR[0, :] = 0
|
||||
iscL[1, :] = LAYER_NOT_REQUESTED
|
||||
iscR[1, :] = LAYER_NOT_REQUESTED
|
||||
coreDm[2, :] = warncore
|
||||
elif np.array_equal(layeruse, np.array([0, 1, 1])):
|
||||
wthL[2, :] = warnwth[0]
|
||||
wthR[2, :] = warnwth[1]
|
||||
oscL[0, :] = 0
|
||||
oscR[0, :] = 0
|
||||
oscL[1, :] = LAYER_NOT_REQUESTED
|
||||
oscR[1, :] = LAYER_NOT_REQUESTED
|
||||
isoL[2, :] = warniso[0]
|
||||
isoR[2, :] = warniso[1]
|
||||
iscL[2, :] = warnisc[0]
|
||||
iscR[2, :] = warnisc[1]
|
||||
coreDm[2, :] = warncore
|
||||
elif np.array_equal(layeruse, np.array([1, 0, 0])):
|
||||
wthL[2, :] = warnwth[0]
|
||||
wthR[2, :] = warnwth[1]
|
||||
oscL[2, :] = warnosc[0]
|
||||
oscR[2, :] = warnosc[1]
|
||||
isoL[0, :] = 0
|
||||
isoR[0, :] = 0
|
||||
isoL[1, :] = LAYER_NOT_REQUESTED
|
||||
isoR[1, :] = LAYER_NOT_REQUESTED
|
||||
iscL[0, :] = 0
|
||||
iscR[0, :] = 0
|
||||
iscL[1, :] = LAYER_NOT_REQUESTED
|
||||
iscR[1, :] = LAYER_NOT_REQUESTED
|
||||
coreDm[2, :] = warncore
|
||||
elif np.array_equal(layeruse, np.array([1, 0, 1])):
|
||||
wthL[2, :] = warnwth[0]
|
||||
wthR[2, :] = warnwth[1]
|
||||
oscL[2, :] = warnosc[0]
|
||||
oscR[2, :] = warnosc[1]
|
||||
isoL[0, :] = 0
|
||||
isoR[0, :] = 0
|
||||
isoL[1, :] = LAYER_NOT_REQUESTED
|
||||
isoR[1, :] = LAYER_NOT_REQUESTED
|
||||
iscL[2, :] = warnisc[0]
|
||||
iscR[2, :] = warnisc[1]
|
||||
coreDm[2, :] = warncore
|
||||
elif np.array_equal(layeruse, np.array([1, 1, 0])):
|
||||
wthL[2, :] = warnwth[0]
|
||||
wthR[2, :] = warnwth[1]
|
||||
oscL[2, :] = warnosc[0]
|
||||
oscR[2, :] = warnosc[1]
|
||||
isoL[2, :] = warniso[0]
|
||||
isoR[2, :] = warniso[1]
|
||||
iscL[0, :] = 0
|
||||
iscR[0, :] = 0
|
||||
iscL[1, :] = LAYER_NOT_REQUESTED
|
||||
iscR[1, :] = LAYER_NOT_REQUESTED
|
||||
coreDm[2, :] = warncore
|
||||
elif np.array_equal(layeruse, np.array([1, 1, 1])):
|
||||
wthL[2, :] = warnwth[0]
|
||||
wthR[2, :] = warnwth[1]
|
||||
oscL[2, :] = warnosc[0]
|
||||
oscR[2, :] = warnosc[1]
|
||||
isoL[2, :] = warniso[0]
|
||||
isoR[2, :] = warniso[1]
|
||||
iscL[2, :] = warnisc[0]
|
||||
iscR[2, :] = warnisc[1]
|
||||
coreDm[2, :] = warncore
|
||||
|
||||
return dmOut, oscL, oscR, isoL, isoR, iscL, iscR, coreDm, wthL, wthR, xk
|
||||
Reference in New Issue
Block a user