using LB_SmartVisionCameraDevice.PHM6000; using LB_SmartVisionCameraSDK.PHM6000; using LB_SmartVisionCommon; using LB_VisionProcesses.Cameras; using Sunny.UI.Win32; using System; using System.Collections.Generic; using System.Drawing; using System.Drawing.Imaging; using System.Reflection; using System.Runtime.InteropServices; using System.Text; using System.Threading; using System.Threading.Tasks; 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; // 新增:CollectedImages操作锁,保证线程安全 private readonly object _collectedImagesLock = new object(); 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, (int)gain); public override bool GetGain(out double gain) { int 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})"); //空值校验:转换失败则直接返回 if (bmp == null) { AsyncLogHelper.Warn(SN + "帧转换为Bitmap失败,跳过处理"); return; } // 线程安全地将Bitmap添加到CollectedImages字典 lock (_collectedImagesLock) { // 确保当前相机SN对应的列表存在 if (!CollectedImages.ContainsKey(SN)) { CollectedImages[SN] = new List(); } CollectedImages[SN].Add(bmp); AsyncLogHelper.Info(SN + $"图像已加入缓存,当前缓存数量:{CollectedImages[SN].Count}"); } // 处理CollectedImages中的图像:遍历消费列表第一个元素直到为空 ProcessCollectedImages(); //// 异步触发事件,避免阻塞SDK回调线程 //Task.Factory.StartNew(() => //{ // try // { // ImageGrabbed?.Invoke(this, new LBCameraEventArgs(SN, bmp, true)); // CallBackImg = (Bitmap)bmp.Clone(); // if (CallBackImg == null) // { // return; // } // if (GetTriggerMode(out TriggerMode mode, out TriggerSource source)) // { // if (mode == TriggerMode.On && source != TriggerSource.Software) // TriggerRunMessageReceived?.Invoke(SN, source.ToString()); // 触发运行事件 // } // bmp.Dispose(); // } // catch (Exception ex) // { // AsyncLogHelper.Error($"LBCamera: Event Invoke error - {ex.Message}"); // bmp.Dispose(); // 异常时释放资源 // } //}); } catch (Exception ex) { AsyncLogHelper.Error($"LBCamera: CreateBitmap error - {ex.Message}"); } } /// /// 处理CollectedImages中的缓存图像 /// 核心逻辑:遍历取第一个图像 -> 赋值给CallBackImg -> 触发事件 -> 释放并移除 /// private void ProcessCollectedImages() { Task.Factory.StartNew(() => { // 加锁保证线程安全,防止多线程同时操作列表 lock (_collectedImagesLock) { // 校验当前相机的图像列表是否存在且有数据 if (!CollectedImages.ContainsKey(SN) || CollectedImages[SN].Count == 0) { AsyncLogHelper.Info(SN + "当前无缓存图像,跳过处理"); return; } // 循环处理:直到列表为空 while (CollectedImages[SN].Count > 0) { try { // 1 取列表第一个索引的图像赋值给CallBackImg Bitmap firstBitmap = CollectedImages[SN][0]; ImageGrabbed?.Invoke(this, new LBCameraEventArgs(SN, firstBitmap, true)); CallBackImg = (Bitmap)firstBitmap.Clone(); // 克隆避免原对象被释放后引用失效 // 2 获取触发模式并判断是否触发运行事件 if (GetTriggerMode(out TriggerMode mode, out TriggerSource source)) { // 硬触发模式下触发运行事件 if (mode == TriggerMode.On && source != TriggerSource.Software) { AsyncLogHelper.Info(SN + $"触发硬触发事件,触发源:{source}"); TriggerRunMessageReceived?.Invoke(SN, source.ToString()); } } else { AsyncLogHelper.Warn(SN + "获取触发模式失败,跳过事件触发"); } // 3 释放第一个图像资源并从列表移除 // 先释放Bitmap内存,再移除列表元素 firstBitmap.Dispose(); CollectedImages[SN].RemoveAt(0); AsyncLogHelper.Info(SN + $"已消费缓存图像,剩余缓存数量:{CollectedImages[SN].Count}"); } catch (Exception ex) { AsyncLogHelper.Error(SN + $"处理缓存图像异常:{ex.Message}", ex); // 单个图像处理失败时,移除该图像避免阻塞后续处理 if (CollectedImages[SN].Count > 0) { try { CollectedImages[SN][0]?.Dispose(); // 尝试释放 CollectedImages[SN].RemoveAt(0); } catch (Exception innerEx) { AsyncLogHelper.Error(SN + $"清理异常图像失败:{innerEx.Message}", innerEx); } } // 单个图像处理失败不终止循环,继续处理下一个 // 4. 所有图像处理完成后,清空CallBackImg if (CallBackImg != null) { CallBackImg.Dispose(); CallBackImg = null; } continue; } // 4. 所有图像处理完成后,清空CallBackImg if (CallBackImg != null) { CallBackImg.Dispose(); CallBackImg = null; } } } }); } private void SyncConfigFromCamera() { try { if (!_isConnected) return; PropertyInfo[] props = _sensorConfig.GetType().GetProperties(); foreach (PropertyInfo p in props) { // 跳过自定义参数 var iscustomAttr = p.GetCustomAttribute(); if (iscustomAttr != null) continue; if (Enum.TryParse(typeof(EnumNameId), p.Name, out object nameIdObj)) { EnumNameId nameId = (EnumNameId)nameIdObj; int intValue = 0; double doubleValue = 0; int enumValue = 0; if (PHM6000Profiler.GetProfilerParameter(_cameraHandle, (int)nameId, ref intValue, ref doubleValue, ref enumValue) == 0) { if (p.PropertyType == typeof(int)) { p.SetValue(_sensorConfig, intValue); } else if (p.PropertyType == typeof(float)) { p.SetValue(_sensorConfig, (float)doubleValue); } else if (p.PropertyType == typeof(double)) { p.SetValue(_sensorConfig, doubleValue); } else // Enum or other types { p.SetValue(_sensorConfig, enumValue); } } } } } catch (Exception ex) { AsyncLogHelper.Error($"LBCamera: SyncConfigFromCamera error - {ex.Message}"); } } private bool SetParam(EnumNameId id, float value) { if (!_isConnected) return false; return PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)id, 0, value, 0) == 0; } private bool SetParam(EnumNameId id, int value) { if (!_isConnected) return false; // 对于枚举类型,通常通过 enumValue (最后一个参数) 传递 return PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)id, 0, 0, value) == 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; } private bool GetParam(EnumNameId id, out int 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 = eVal; // Assuming it returns in enumValue return true; } return false; } #endregion } }