分类 代码分享 下的文章

使用方法:替换Toolblock的C#完整脚本,遍历输入项做为数据保存为.csv
Toolblock输入:必须包含两个String输入项:

  1. Path:保存文件的目录路径(如:"C:\Data")
  2. Filename:文件名前缀(如:"InspectionData")
#region namespace imports
using System;
using System.Collections;
using System.Collections.Generic;
using System.Drawing;
using System.IO;
using System.Windows.Forms;
using Cognex.VisionPro;
using Cognex.VisionPro.ToolBlock;
using Cognex.VisionPro3D;
using System.Text;
#endregion

public class CogToolBlockAdvancedScript : CogToolBlockAdvancedScriptBase
{
  #region Private Member Variables
  private Cognex.VisionPro.ToolBlock.CogToolBlock mToolBlock;
  #endregion

  /// <summary>
  /// Called when the parent tool is run.
  /// Add code here to customize or replace the normal run behavior.
  /// </summary>
  /// <param name="message">Sets the Message in the tool's RunStatus.</param>
  /// <param name="result">Sets the Result in the tool's RunStatus</param>
  /// <returns>True if the tool should run normally,
  ///          False if GroupRun customizes run behavior</returns>
  public override bool GroupRun(ref string message, ref CogToolResultConstants result)
  {
    // To let the execution stop in this script when a debugger is attached, uncomment the following lines.
//     #if DEBUG
//     if (System.Diagnostics.Debugger.IsAttached) System.Diagnostics.Debugger.Break();
//     #endif


    // Run each tool using the RunTool function
    foreach(ICogTool tool in mToolBlock.Tools)
      mToolBlock.RunTool(tool, ref message, ref result);
    
    SaveToolBlockData.SaveData(mToolBlock);

    return false;
  }

  #region When the Current Run Record is Created
  /// <summary>
  /// Called when the current record may have changed and is being reconstructed
  /// </summary>
  /// <param name="currentRecord">
  /// The new currentRecord is available to be initialized or customized.</param>
  public override void ModifyCurrentRunRecord(Cognex.VisionPro.ICogRecord currentRecord)
  {
  }
  #endregion

  #region When the Last Run Record is Created
  /// <summary>
  /// Called when the last run record may have changed and is being reconstructed
  /// </summary>
  /// <param name="lastRecord">
  /// The new last run record is available to be initialized or customized.</param>
  public override void ModifyLastRunRecord(Cognex.VisionPro.ICogRecord lastRecord)
  {
  }
  #endregion

  #region When the Script is Initialized
  /// <summary>
  /// Perform any initialization required by your script here
  /// </summary>
  /// <param name="host">The host tool</param>
  public override void Initialize(Cognex.VisionPro.ToolGroup.CogToolGroup host)
  {
    // DO NOT REMOVE - Call the base class implementation first - DO NOT REMOVE
    base.Initialize(host);


    // Store a local copy of the script host
    this.mToolBlock = ((Cognex.VisionPro.ToolBlock.CogToolBlock)(host));
  }
  #endregion

}

public class SaveToolBlockData
{
  public static void SaveData(CogToolBlock toolBlock)
  {
    try
    {
      // 1. 获取当前日期时间
      DateTime currentTime = DateTime.Now;
            
      // 2. 获取路径和文件名
      string savePath = Convert.ToString(toolBlock.Inputs["Path"].Value);
      string filenamePrefix = Convert.ToString(toolBlock.Inputs["Filename"].Value);
      string fileName = filenamePrefix + "_" + currentTime.ToString("yyyyMMdd") + ".csv";
      string fullPath = Path.Combine(savePath, fileName);

      // 3. 确保目录存在
      Directory.CreateDirectory(savePath);

      // 4. 准备表头和数据行
      StringBuilder csvLine = new StringBuilder();
      List<string> headers = new List<string> { "Time" };
      List<string> values = new List<string> { currentTime.ToString("HH:mm:ss:fff") };

      // 5. 遍历输入项
      foreach (CogToolBlockTerminal input in toolBlock.Inputs)
      {
        string name = input.Name;
                
        // 跳过路径和文件名参数
        if (name.Equals("Path", StringComparison.OrdinalIgnoreCase) || 
          name.Equals("Filename", StringComparison.OrdinalIgnoreCase))
          continue;

        headers.Add(name);
        values.Add(Convert.ToString(input.Value));
      }

      // 6. 创建或追加文件
      bool isNewFile = !File.Exists(fullPath);
            
      using (StreamWriter sw = new StreamWriter(fullPath, true, Encoding.UTF8))
      {
        // 7. 写入表头(新文件)
        if (isNewFile)
        {
          sw.WriteLine(string.Join(",", headers));
        }
                
        // 8. 写入数据行
        sw.WriteLine(string.Join(",", values));
      }
    }
    catch
    {
      // 错误处理(可选)
    }
  }
}

设物体当前坐标为 (X1, Y1, R1),模组当前坐标为 (X2, Y2, R2),物体目标坐标为 (X3, Y3, R3)。计算旋转差 ΔR = R3 - R1,则模组的新坐标 (X4, Y4, R4) 为:

X4 = X3 + cos(ΔR) (X2 - X1) - sin(ΔR) (Y2 - Y1)
Y4 = Y3 + sin(ΔR) (X2 - X1) + cos(ΔR) (Y2 - Y1)
R4 = R2 + ΔR

其中角度单位需一致(如弧度),必要时可将结果归一化到适当范围(如 [-π, π])。

一个简单的 C# 方法,适用于 .NET Framework 4.5。

using System;

public static class CompensationCalculator
{
    /// <summary>
    /// 根据四个顶点的XY补偿值,通过双线性插值计算指定位置的XY补偿值。
    /// 注意:此方法假设输入参数有效(n>2, m>2, i在0到n*m-1范围内)。
    /// </summary>
    public static Tuple<double, double> GetCompensation(
        int n, int m,
        double topLeftX, double topLeftY,
        double topRightX, double topRightY,
        double bottomLeftX, double bottomLeftY,
        double bottomRightX, double bottomRightY,
        int i)
    {
        int r = i / m; // 行索引
        int c = i % m; // 列索引

        double u = (double)c / (m - 1); // 归一化列位置
        double v = (double)r / (n - 1); // 归一化行位置

        // 双线性插值计算X和Y补偿值
        double xComp = (1 - u) * (1 - v) * topLeftX + u * (1 - v) * topRightX + (1 - u) * v * bottomLeftX + u * v * bottomRightX;
        double yComp = (1 - u) * (1 - v) * topLeftY + u * (1 - v) * topRightY + (1 - u) * v * bottomLeftY + u * v * bottomRightY;

        return Tuple.Create(xComp, yComp);
    }
}

使用示例:

// 示例:3行3列矩阵,计算位置i=4的补偿值
var result = CompensationCalculator.GetCompensation(
    n: 3, m: 3,
    topLeftX: 0.0, topLeftY: 0.0,
    topRightX: 1.0, topRightY: 0.0,
    bottomLeftX: 0.0, bottomLeftY: 1.0,
    bottomRightX: 1.0, bottomRightY: 1.0,
    i: 4);

Console.WriteLine($"X补偿值: {result.Item1}, Y补偿值: {result.Item2}");
// 输出: X补偿值: 0.5, Y补偿值: 0.5

说明:

  • 返回类型:使用 Tuple<double, double>(.NET Framework 4.5 原生支持)。
  • 验证移除:假设调用方确保输入参数有效(n>2, m>2, i在0到n*m-1范围内)。
  • 核心逻辑:使用双线性插值计算 。