using System;
using System.Collections.Generic;
using System.Drawing;
using System.Drawing.Imaging;
using System.Runtime.InteropServices;
using System.Text;
using System.Threading;
using System.Threading.Tasks;
using LB_SmartVisionCameraSDK.PHM6000;
using LB_VisionProcesses.Cameras;
using LB_SmartVisionCommon;
using LB_SmartVisionCameraDevice.PHM6000;
namespace LB_VisionProcesses.Cameras.LBCameras
{
public class LBCameraEventArgs : CameraEventArgs
{
public bool IsComplete { get; set; }
public LBCameraEventArgs(string sn, Bitmap bitmap, bool isComplete) : base(sn, bitmap)
{
IsComplete = isComplete;
}
}
///
/// LB3D工业相机实现类
/// 基于PHM6000系列封装
///
public class LBCamera : BaseCamera
{
private IntPtr _cameraHandle = IntPtr.Zero;
private PHM6000SensorConfig _sensorConfig;
// 采集回调
private AcquisitionCallbackZA _acquisitionCallback;
private AcquisitionCompletedCallback _acquisitionCompletedCallback;
private bool _isConnected = false;
private int _frameCount = 0; // 采集帧计数
// 图像缓冲
private byte[] _rawPixelBuffer = null; // 用于存储整张图的像素数据 (8bpp)
private int _currentBitmapHeight = 0;
private int _currentBitmapWidth = 0;
private int _currentLineCount = 0;
private object _bufferLock = new object();
private bool _isBufferReady = false;
// 临时行缓冲,用于接收回调数据
private byte[] _tempLineBuffer = null;
private bool _isContinuous = false;
public LBCamera()
{
Brand = CameraBrand.LBCamera;
_sensorConfig = new PHM6000SensorConfig();
}
#region ICamera Implementation
public override bool InitDevice(string sn, object handle = null)
{
// 如果已连接,直接返回true
if (_isConnected && _cameraHandle != IntPtr.Zero)
{
return true;
}
IntPtr tempHandle = IntPtr.Zero;
try
{
SN = sn;
// 1. 创建临时句柄用于发现设备
tempHandle = PHM6000Profiler.CreateCameraEntry();
if (tempHandle == IntPtr.Zero) return false;
// 2. 发现相机
int cameraCount = PHM6000Profiler.DiscoverCameras(tempHandle);
if (cameraCount <= 0)
{
PHM6000Profiler.DestroyCameraEntry(tempHandle);
return false;
}
string targetIp = string.Empty;
int targetPort = 0;
bool found = false;
// 3. 遍历相机寻找匹配的SN
for (int i = 0; i < cameraCount; i++)
{
byte[] moduleTypeBytes = new byte[64];
byte[] serialNumberBytes = new byte[64];
if (PHM6000Profiler.GetCameraInformation(tempHandle, i, moduleTypeBytes, serialNumberBytes) == 0)
{
string currentSn = Encoding.UTF8.GetString(serialNumberBytes).TrimEnd('\0');
// 匹配SN或IP
if (currentSn == sn || sn.Contains(currentSn))
{
byte[] addressBytes = new byte[64];
int port = 0;
if (PHM6000Profiler.GetCameraAddress(tempHandle, i, addressBytes, ref port) == 0)
{
targetIp = Encoding.UTF8.GetString(addressBytes).TrimEnd('\0');
targetPort = port;
found = true;
break;
}
}
}
}
PHM6000Profiler.DestroyCameraEntry(tempHandle);
tempHandle = IntPtr.Zero;
if (!found)
{
if (System.Net.IPAddress.TryParse(sn, out _))
{
targetIp = sn;
targetPort = 5577;
}
else
{
AsyncLogHelper.Error($"LBCamera: 未找到SN为 {sn} 的相机");
return false;
}
}
// 4. 创建正式相机句柄并连接
_cameraHandle = PHM6000Profiler.CreateCameraEntry();
if (_cameraHandle == IntPtr.Zero) return false;
var addr = Encoding.ASCII.GetBytes(targetIp);
int result = PHM6000Profiler.ConnectToCamera(_cameraHandle, addr, targetPort);
if (result == 0)
{
_isConnected = true;
// 加载相机当前参数到 _sensorConfig
SyncConfigFromCamera();
// 初始化并注册采集回调 (获取数据用)
_acquisitionCallback = new AcquisitionCallbackZA(OnAcquisitionCallbackZA);
PHM6000Profiler.SetAcquisitionCallbackZA(_cameraHandle, _acquisitionCallback, IntPtr.Zero);
// 初始化并注册采集完成回调 (状态通知用)
_acquisitionCompletedCallback = new AcquisitionCompletedCallback(OnAcquisitionCompleted);
PHM6000Profiler.RegisterAcquisitionCompletedCallback(_cameraHandle, _acquisitionCompletedCallback, IntPtr.Zero);
// 强制应用当前配置(确保触发模式等参数正确,避免相机处于未知状态)
UpdateSensorConfig(_sensorConfig);
AsyncLogHelper.Info($"LBCamera[{SN}]: Connected and initialized successfully (Manual Data Mode)");
return true;
}
else
{
AsyncLogHelper.Error($"LBCamera[{SN}]: ConnectToCamera failed, result={result}");
}
}
catch (Exception ex)
{
AsyncLogHelper.Error($"LBCamera: InitDevice异常 - {ex.Message}");
if (tempHandle != IntPtr.Zero) PHM6000Profiler.DestroyCameraEntry(tempHandle);
}
return false;
}
public override bool CloseDevice()
{
if (_isConnected && _cameraHandle != IntPtr.Zero)
{
StopGrabbing();
PHM6000Profiler.DestroyCameraEntry(_cameraHandle);
_cameraHandle = IntPtr.Zero;
_isConnected = false;
AsyncLogHelper.Info($"LBCamera[{SN}]: Closed");
}
return true;
}
public override List GetListEnum()
{
List cameraList = new List();
IntPtr tempHandle = IntPtr.Zero;
try
{
tempHandle = PHM6000Profiler.CreateCameraEntry();
if (tempHandle != IntPtr.Zero)
{
int count = PHM6000Profiler.DiscoverCameras(tempHandle);
for (int i = 0; i < count; i++)
{
byte[] moduleTypeBytes = new byte[64];
byte[] serialNumberBytes = new byte[64];
if (PHM6000Profiler.GetCameraInformation(tempHandle, i, moduleTypeBytes, serialNumberBytes) == 0)
{
string sn = Encoding.UTF8.GetString(serialNumberBytes).TrimEnd('\0');
if (!string.IsNullOrEmpty(sn))
{
cameraList.Add(sn);
}
}
}
}
}
catch (Exception ex)
{
AsyncLogHelper.Error($"LBCamera: 获取设备列表异常 - {ex.Message}");
}
finally
{
if (tempHandle != IntPtr.Zero)
PHM6000Profiler.DestroyCameraEntry(tempHandle);
}
return cameraList;
}
private void InitBuffer()
{
lock (_bufferLock)
{
_currentBitmapHeight = _sensorConfig.ScanLineCount > 0 ? _sensorConfig.ScanLineCount : 5000;
// 宽度在第一行数据到达时确定
_currentBitmapWidth = 0;
_rawPixelBuffer = null;
_currentLineCount = 0;
_isBufferReady = false;
}
}
public override bool StartGrabbing()
{
// 默认连续模式
return StartSingleGrab();
}
public bool StartSingleGrab()
{
if (!_isConnected) return false;
_isContinuous = false;
InitBuffer();
AsyncLogHelper.Info($"LBCamera[{SN}]: 开始单次采集");
// 1=扫描模式, 0=单次
PHM6000Profiler.SetAcquisitionMode(_cameraHandle, 1, 0);
int result = PHM6000Profiler.StartAcquisition(_cameraHandle, 0, 0, 0.0);
if (result == 0)
{
isGrabbing = true;
return true;
}
return false;
}
public override bool StartContinuousGrab()
{
if (!_isConnected) return false;
_isContinuous = true;
InitBuffer();
AsyncLogHelper.Info($"LBCamera[{SN}]:开始连续采集");
// 1=扫描模式, 1=连续
PHM6000Profiler.SetAcquisitionMode(_cameraHandle, 1, 1);
int result = PHM6000Profiler.StartAcquisition(_cameraHandle, 0, 0, 0.0);
if (result == 0)
{
isGrabbing = true;
return true;
}
return false;
}
public override bool StopGrabbing()
{
_isContinuous = false;
if (!_isConnected) return true;
PHM6000Profiler.StopAcquisition(_cameraHandle);
// 停止时如果有未显示的缓存数据,将其显示出来(支持显示不完整的帧)
lock (_bufferLock)
{
if (_currentLineCount > 0)
{
AsyncLogHelper.Info($"LBCamera[{SN}]: Flushing partial buffer ({_currentLineCount} lines) on stop");
CreateAndFireBitmap();
_currentLineCount = 0;
}
}
isGrabbing = false;
return true;
}
public override bool StartWith_SoftTriggerModel() => StartContinuousGrab();
public override bool StartWith_HardTriggerModel(TriggerSource hardtriggeritem = TriggerSource.Line0) => StartSingleGrab();
public override bool SoftTrigger() => true;
#region 参数设置映射
public override bool SetExpouseTime(double value) => SetParam(EnumNameId.ExposureTime, (float)value);
public override bool GetExpouseTime(out double value) { float v; bool r = GetParam(EnumNameId.ExposureTime, out v); value = v; return r; }
public override bool SetGain(double gain) => SetParam(EnumNameId.AnalogGain, (float)gain);
public override bool GetGain(out double gain) { float v; bool r = GetParam(EnumNameId.AnalogGain, out v); gain = v; return r; }
public override bool SetTriggerMode(TriggerMode mode, TriggerSource triggerEnum = TriggerSource.Line0)
{
if (!_isConnected) return false;
if (triggerEnum == TriggerSource.Software)
{
_sensorConfig.LineScanTriggerSource = EnumLineScanTriggerSource.固定频率;
_sensorConfig.DataAcquisitionTriggerSource = EnumDataAcquisitionTriggerSource.软触发;
}
else
{
_sensorConfig.LineScanTriggerSource = EnumLineScanTriggerSource.编码器;
_sensorConfig.DataAcquisitionTriggerSource = EnumDataAcquisitionTriggerSource.外部触发;
}
UpdateSensorConfig(_sensorConfig);
return true;
}
public override bool GetTriggerMode(out TriggerMode mode, out TriggerSource source)
{
mode = TriggerMode.On;
source = _sensorConfig.DataAcquisitionTriggerSource == EnumDataAcquisitionTriggerSource.软触发 ? TriggerSource.Software : TriggerSource.Line0;
return true;
}
public override bool SetTriggerPolarity(TriggerPolarity polarity) => true;
public override bool GetTriggerPolarity(out TriggerPolarity polarity) { polarity = TriggerPolarity.RisingEdge; return true; }
public override bool SetTriggerFliter(double flitertime) => true;
public override bool GetTriggerFliter(out double flitertime) { flitertime = 0; return true; }
public override bool SetTriggerDelay(double delay) => true;
public override bool GetTriggerDelay(out double delay) { delay = 0; return true; }
public override bool SetLineMode(IOLines line, LineMode mode) => true;
public override bool SetLineStatus(IOLines line, LineStatus linestatus) => true;
public override bool GetLineStatus(IOLines line, out LineStatus lineStatus) { lineStatus = LineStatus.Low; return true; }
public override bool AutoBalanceWhite() => true;
public override void SetCamConfig(CameraConfig config) { }
public override void GetCamConfig(out CameraConfig config) { config = new CameraConfig(null); }
public override bool GetImage(out Bitmap bitmap, int outtime = 3000) { bitmap = null; return false; }
public override bool GetImageWithSoftTrigger(out Bitmap bitmap, int outtime = 3000)
{
// 简单实现:软触发等待
bitmap = null;
if(!_isConnected) return false;
// 计算理论最小耗时 (仅当使用固定频率触发时)
int minTime = 0;
if (_sensorConfig.LineScanTriggerSource == EnumLineScanTriggerSource.固定频率)
{
float rate = _sensorConfig.SoftwareTriggerRate > 0 ? _sensorConfig.SoftwareTriggerRate : 1000f;
int lines = _sensorConfig.ScanLineCount > 0 ? _sensorConfig.ScanLineCount : 5000;
minTime = (int)((lines / rate) * 1000);
}
// 如果传入超时时间不够,自动延长
int actualTimeout = outtime;
if (actualTimeout < minTime + 2000)
{
actualTimeout = minTime + 3000; // 预留3秒余量
AsyncLogHelper.Warn($"LBCamera: Provided timeout {outtime}ms is too short for {minTime}ms scan. Extended to {actualTimeout}ms.");
}
using (AutoResetEvent waitHandle = new AutoResetEvent(false))
{
Bitmap res = null;
EventHandler handler = (s, e) => {
if(e.Bitmap != null) {
res = e.Bitmap.Clone() as Bitmap;
waitHandle.Set();
}
};
ImageGrabbed += handler;
if (StartSingleGrab())
{
if (!waitHandle.WaitOne(actualTimeout))
{
AsyncLogHelper.Error($"LBCamera: GetImageWithSoftTrigger timeout after {actualTimeout}ms");
}
}
else
{
AsyncLogHelper.Error("LBCamera: StartSingleGrab failed");
}
ImageGrabbed -= handler;
// 确保停止采集
StopGrabbing();
bitmap = res;
return bitmap != null;
}
}
public PHM6000SensorConfig GetSensorConfig()
{
SyncConfigFromCamera();
return _sensorConfig;
}
public void UpdateSensorConfig(PHM6000SensorConfig config)
{
_sensorConfig = config;
if (!_isConnected) return;
SetParam(EnumNameId.ExposureTime, (float)config.ExposureTime);
SetParam(EnumNameId.AnalogGain, (float)config.AnalogGain);
PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)EnumNameId.ScanLineCount, config.ScanLineCount, 0, 0);
PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)EnumNameId.LineScanTriggerSource, 0, 0, (int)config.LineScanTriggerSource);
PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)EnumNameId.DataAcquisitionTriggerSource, 0, 0, (int)config.DataAcquisitionTriggerSource);
if (config.LineScanTriggerSource == EnumLineScanTriggerSource.固定频率)
{
PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)EnumNameId.SoftwareTriggerRate, 0, config.SoftwareTriggerRate, 0);
}
PHM6000Profiler.SaveAllParametersToDevice(_cameraHandle);
}
#endregion
#endregion
#region Callbacks
private void OnAcquisitionCallbackZA(IntPtr pInstance, IntPtr buffer, int points)
{
if (buffer == IntPtr.Zero || points <= 0) return;
lock (_bufferLock)
{
// 初始化缓冲区
if (_rawPixelBuffer == null)
{
_currentBitmapWidth = points;
if (_currentBitmapHeight <= 0) _currentBitmapHeight = 2000; // 默认防呆
_rawPixelBuffer = new byte[_currentBitmapWidth * _currentBitmapHeight];
_currentLineCount = 0;
}
if (_currentLineCount >= _currentBitmapHeight) return; // 缓冲区满,忽略多余数据
// 准备临时缓冲区接收行数据 (LBPointZA = 8 bytes)
int lineBytes = points * 8;
if (_tempLineBuffer == null || _tempLineBuffer.Length != lineBytes)
{
_tempLineBuffer = new byte[lineBytes];
}
// 拷贝非托管内存到托管数组
Marshal.Copy(buffer, _tempLineBuffer, 0, lineBytes);
// 提取灰度(Intensity/Alpha)数据填充到 _rawPixelBuffer
// LBPointZA结构: float(4) + res(3) + alpha(1). Alpha在偏移7
int bufferOffset = _currentLineCount * _currentBitmapWidth;
for (int i = 0; i < points; i++)
{
if (bufferOffset + i < _rawPixelBuffer.Length)
{
_rawPixelBuffer[bufferOffset + i] = _tempLineBuffer[i * 8 + 7];
}
}
_currentLineCount++;
// 如果达到预定高度,生成图像
if (_currentLineCount >= _currentBitmapHeight)
{
CreateAndFireBitmap();
// 重置,准备下一帧 (如果是连续采集)
_currentLineCount = 0;
// _rawPixelBuffer 可以复用,不需要置空
}
}
}
private void OnAcquisitionCompleted(IntPtr pInstance, int nOption)
{
// nOption: 0=Batch End, 1=All End(Single), 2=Processing End
// 此处主要用于日志或状态监控
// 实际图像生成在 Data Callback 中完成
if (nOption == 1) // 单次采集结束
{
if (_isContinuous && isGrabbing)
{
// 如果在连续模式下收到结束信号,尝试自动重启采集
AsyncLogHelper.Info($"LBCamera[{SN}]: Continuous mode frame ended, restarting...");
Task.Run(() =>
{
if (_isContinuous && _isConnected)
{
PHM6000Profiler.StartAcquisition(_cameraHandle, 0, 0, 0.0);
}
});
}
else
{
isGrabbing = false;
AsyncLogHelper.Info($"LBCamera[{SN}]: Single grab completed by SDK");
// 单次采集结束时,如果有未显示的缓冲数据,立即生成图像
// 防止因数据量不足(小于ScanLineCount)导致GetImageWithSoftTrigger一直等待
lock (_bufferLock)
{
if (_currentLineCount > 0)
{
AsyncLogHelper.Info($"LBCamera[{SN}]: Flushing partial buffer ({_currentLineCount} lines) on completion");
CreateAndFireBitmap();
_currentLineCount = 0;
}
}
}
}
}
private void CreateAndFireBitmap()
{
try
{
int width = _currentBitmapWidth;
int height = _currentLineCount; // 使用实际采集到的行数
if (width <= 0 || height <= 0 || _rawPixelBuffer == null) return;
Bitmap bmp = new Bitmap(width, height, PixelFormat.Format8bppIndexed);
// 设置灰度调色板
ColorPalette palette = bmp.Palette;
for (int i = 0; i < 256; i++)
{
palette.Entries[i] = Color.FromArgb(i, i, i);
}
bmp.Palette = palette;
// 拷贝数据
BitmapData bmpData = bmp.LockBits(new Rectangle(0, 0, width, height), ImageLockMode.WriteOnly, PixelFormat.Format8bppIndexed);
// 注意:Bitmap Stride 可能不等于 Width,需要逐行拷贝
int stride = bmpData.Stride;
IntPtr ptr = bmpData.Scan0;
for (int y = 0; y < height; y++)
{
// 确保不越界
if ((y * width) + width <= _rawPixelBuffer.Length)
{
Marshal.Copy(_rawPixelBuffer, y * width, ptr + y * stride, width);
}
}
bmp.UnlockBits(bmpData);
_frameCount++;
AsyncLogHelper.Info($"LBCamera[{SN}]: Frame {_frameCount} generated ({width}x{height})");
// 异步触发事件,避免阻塞SDK回调线程
Task.Run(() =>
{
try
{
ImageGrabbed?.Invoke(this, new LBCameraEventArgs(SN, bmp, true));
}
catch (Exception ex)
{
AsyncLogHelper.Error($"LBCamera: Event Invoke error - {ex.Message}");
bmp.Dispose(); // 异常时释放资源
}
});
}
catch (Exception ex)
{
AsyncLogHelper.Error($"LBCamera: CreateBitmap error - {ex.Message}");
}
}
private void SyncConfigFromCamera()
{
foreach (EnumNameId id in Enum.GetValues(typeof(EnumNameId)))
{
int iVal = 0; double dVal = 0; int eVal = 0;
if (PHM6000Profiler.GetProfilerParameter(_cameraHandle, (int)id, ref iVal, ref dVal, ref eVal) == 0)
{
// Update _sensorConfig values here if needed
}
}
}
private bool SetParam(EnumNameId id, float value)
{
if (!_isConnected) return false;
return PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)id, 0, value, 0) == 0;
}
private bool GetParam(EnumNameId id, out float value)
{
value = 0;
if (!_isConnected) return false;
int iVal = 0; double dVal = 0; int eVal = 0;
if (PHM6000Profiler.GetProfilerParameter(_cameraHandle, (int)id, ref iVal, ref dVal, ref eVal) == 0)
{
value = (float)dVal;
return true;
}
return false;
}
#endregion
}
}