| | |
| | | using OpenCvSharp; |
| | | using System; |
| | | using System.Collections.Generic; |
| | | using System.Linq; |
| | | using System.Drawing; |
| | | using System.Drawing.Imaging; |
| | | using System.Reflection; |
| | | 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; |
| | | } |
| | | } |
| | | |
| | | /// <summary> |
| | | /// LB3D工业相机实现类 |
| | | /// 基于PHM6000系列封装 |
| | | /// </summary> |
| | | internal class LBCamera : BaseCamera |
| | | public class LBCamera : BaseCamera |
| | | { |
| | | public override bool AutoBalanceWhite() |
| | | 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() |
| | | { |
| | | return true; |
| | | 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() |
| | | { |
| | | return true; |
| | | } |
| | | |
| | | public override bool GetExpouseTime(out double value) |
| | | { |
| | | value = 0; |
| | | return true; |
| | | } |
| | | |
| | | public override bool GetGain(out double gain) |
| | | { |
| | | gain = 0; |
| | | return true; |
| | | } |
| | | |
| | | public override bool GetLineStatus(IOLines line, out LineStatus lineStatus) |
| | | { |
| | | lineStatus = LineStatus.Hight; |
| | | if (_isConnected && _cameraHandle != IntPtr.Zero) |
| | | { |
| | | StopGrabbing(); |
| | | PHM6000Profiler.DestroyCameraEntry(_cameraHandle); |
| | | _cameraHandle = IntPtr.Zero; |
| | | _isConnected = false; |
| | | AsyncLogHelper.Info($"LBCamera[{SN}]: Closed"); |
| | | } |
| | | return true; |
| | | } |
| | | |
| | | public override List<string> GetListEnum() |
| | | { |
| | | return new List<string>(); |
| | | List<string> cameraList = new List<string>(); |
| | | 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; |
| | | } |
| | | |
| | | public override bool GetTriggerDelay(out double delay) |
| | | private void InitBuffer() |
| | | { |
| | | delay = 0; |
| | | 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 GetTriggerFliter(out double flitertime) |
| | | 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) |
| | | { |
| | | flitertime = 0; |
| | | 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 = TriggerSource.Line0; |
| | | 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<CameraEventArgs> 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 override bool GetTriggerPolarity(out TriggerPolarity polarity) |
| | | public PHM6000SensorConfig GetSensorConfig() |
| | | { |
| | | polarity = TriggerPolarity.RisingEdge; |
| | | return true; |
| | | SyncConfigFromCamera(); |
| | | return _sensorConfig; |
| | | } |
| | | |
| | | public override bool InitDevice(string SN, object Handle = null) |
| | | public void UpdateSensorConfig(PHM6000SensorConfig config) |
| | | { |
| | | return true; |
| | | _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); |
| | | } |
| | | |
| | | public override bool SetExpouseTime(double value) |
| | | #endregion |
| | | |
| | | #endregion |
| | | |
| | | #region Callbacks |
| | | |
| | | private void OnAcquisitionCallbackZA(IntPtr pInstance, IntPtr buffer, int points) |
| | | { |
| | | return true; |
| | | 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 可以复用,不需要置空 |
| | | } |
| | | } |
| | | } |
| | | |
| | | public override bool SetGain(double gain) |
| | | private void OnAcquisitionCompleted(IntPtr pInstance, int nOption) |
| | | { |
| | | return true; |
| | | // 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; |
| | | } |
| | | } |
| | | } |
| | | } |
| | | } |
| | | |
| | | public override bool SetLineMode(IOLines line, LineMode mode) |
| | | private void CreateAndFireBitmap() |
| | | { |
| | | return true; |
| | | 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}"); |
| | | } |
| | | } |
| | | |
| | | public override bool SetLineStatus(IOLines line, LineStatus linestatus) |
| | | private void SyncConfigFromCamera() |
| | | { |
| | | return true; |
| | | try |
| | | { |
| | | if (!_isConnected) return; |
| | | |
| | | PropertyInfo[] props = _sensorConfig.GetType().GetProperties(); |
| | | foreach (PropertyInfo p in props) |
| | | { |
| | | // 跳过自定义参数 |
| | | var iscustomAttr = p.GetCustomAttribute<IsCustomAttribute>(); |
| | | 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}"); |
| | | } |
| | | } |
| | | |
| | | public override bool SetTriggerDelay(double delay) |
| | | private bool SetParam(EnumNameId id, float value) |
| | | { |
| | | return true; |
| | | if (!_isConnected) return false; |
| | | return PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)id, 0, value, 0) == 0; |
| | | } |
| | | |
| | | public override bool SetTriggerFliter(double flitertime) |
| | | private bool SetParam(EnumNameId id, int value) |
| | | { |
| | | return true; |
| | | if (!_isConnected) return false; |
| | | // 对于枚举类型,通常通过 enumValue (最后一个参数) 传递 |
| | | return PHM6000Profiler.SetProfilerParameter(_cameraHandle, (int)id, 0, 0, value) == 0; |
| | | } |
| | | |
| | | public override bool SetTriggerMode(TriggerMode mode, TriggerSource triggerEnum = TriggerSource.Line0) |
| | | private bool GetParam(EnumNameId id, out float value) |
| | | { |
| | | return true; |
| | | 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; |
| | | } |
| | | |
| | | public override bool SetTriggerPolarity(TriggerPolarity polarity) |
| | | private bool GetParam(EnumNameId id, out int value) |
| | | { |
| | | return true; |
| | | 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; |
| | | } |
| | | |
| | | public override bool SoftTrigger() |
| | | { |
| | | return true; |
| | | } |
| | | |
| | | public override bool StartGrabbing() |
| | | { |
| | | return true; |
| | | } |
| | | |
| | | public override bool StopGrabbing() |
| | | { |
| | | return true; |
| | | } |
| | | #endregion |
| | | } |
| | | } |
| | | } |