- Function CCD_T ''''''''相机拍照并发送数据给控制器
- Print #201, "T1" ''''''' 给相机 1 发送拍照命令
- Input #201, Found_T1$, T1_CX$, T1_CY$ '''''''接收相机 1 的像素坐标
- Print "T1:", Found_T1$, ", ", T1_CX$, ",", T1_CY$ ''''''' 显示接收的数据
- Print #201, "T2" '''''''给相机 2 发送拍照命令
- Input #201, Found_T2$, T2_CX$, T2_CY$ ''''''''''''''接收相机 2 的像素坐标
- Print "T2:", Found_T2$, ", ", T2_CX$, ", ", T2_CY$ ''''''''' 显示接收的数据
- If found_T1$ = "1" And found_T2$ = "1" Then ''' 判断是否拍照成功
- P201 = VxTrans(1, XY(Val(T1_CX$), Val(T1_CY$), 0, 0)) '''''''将相机 1 拍
- 到的点转换为机械坐标,并保存在点 P201 中
- P202 = VxTrans(2, XY(Val(T2_CX$), Val(T2_CY$), 0, 0)) '''''''将相机2拍到
- 的点转换为机械坐标,并保存在点 P202 中
- P205 = XY((CX(P201) + CX(P202)) / 2, (CY(P201) + CY(P202)) / 2, 0, 0, 0,
- 180) '''''''计算 P201 点和 P202 点的中点,并保存在 点 P205 中
- T_agl1 = RadToDeg(Atan((CY(P201) - CY(P202)) / (CX(P201) -
- CX(P202)))) ''''''' 计算角度
- Else
- Print "CCD_T photo failed" '''''''