产品结构中如何绕零件自身局部轴而非全局轴旋转已定位零件？

问题 #

旋转产品结构中的已定位零件时，操作始终基于全局坐标系而非零件自身的局部坐标系，需要实现绕零件局部轴的旋转操作。

当前代码 #

Set move1 = productToMove.Move
Set move1 = move1.MovableObject
Dim arrayOfVariantOfDouble1(11)

arrayOfVariantOfDouble1(0) = XCoord(0)
arrayOfVariantOfDouble1(1) = XCoord(1)
arrayOfVariantOfDouble1(2) = XCoord(2)

arrayOfVariantOfDouble1(3) = YCoord(0)
arrayOfVariantOfDouble1(4) = YCoord(1)
arrayOfVariantOfDouble1(5) = YCoord(2)

arrayOfVariantOfDouble1(6) = ZCoord(0)
arrayOfVariantOfDouble1(7) = ZCoord(1)
arrayOfVariantOfDouble1(8) = ZCoord(2)

arrayOfVariantOfDouble1(9) = Position(0)
arrayOfVariantOfDouble1(10) = Position(1)
arrayOfVariantOfDouble1(11) = Position(2)

Set move1Variant = move1
move1Variant.Apply arrayOfVariantOfDouble1

解决方案 #

要实现绕局部坐标系旋转，核心是基于零件当前的位姿矩阵叠加局部旋转变换，具体步骤如下：

1. 获取零件当前变换矩阵
   通过productToMove.Transformation获取零件的4x4变换矩阵，该矩阵包含零件相对于全局坐标系的旋转和平移信息。

2. 构造局部旋转矩阵
   根据目标旋转轴（X/Y/Z）和角度，生成对应的3D旋转矩阵。例如绕局部Z轴旋转θ弧度的矩阵为：

   [cosθ  -sinθ  0  0]
   [sinθ   cosθ  0  0]
   [0      0     1  0]
   [0      0     0  1]
   

   绕X/Y轴的旋转矩阵可参考标准3D旋转公式调整。

3. 计算新的变换矩阵
   将零件当前的变换矩阵与局部旋转矩阵相乘（顺序为：当前矩阵 × 局部旋转矩阵），得到叠加旋转后的新变换矩阵。这一步确保旋转是基于零件自身坐标系执行的。

4. 分解矩阵并应用变换
   将新矩阵的轴向量和位置向量提取到目标数组中，调用Apply方法完成旋转。

修改后的示例代码 #

' 获取零件当前的4x4变换矩阵
Dim currentTransform As Variant
currentTransform = productToMove.Transformation

' 设置绕局部Z轴的旋转角度（弧度，示例为~28.6度）
Dim rotateAngle As Double
rotateAngle = 0.5

' 构造绕局部Z轴的旋转矩阵
Dim rotateMatrix(15) As Double
rotateMatrix(0) = Cos(rotateAngle)
rotateMatrix(1) = -Sin(rotateAngle)
rotateMatrix(2) = 0
rotateMatrix(3) = 0
rotateMatrix(4) = Sin(rotateAngle)
rotateMatrix(5) = Cos(rotateAngle)
rotateMatrix(6) = 0
rotateMatrix(7) = 0
rotateMatrix(8) = 0
rotateMatrix(9) = 0
rotateMatrix(10) = 1
rotateMatrix(11) = 0
rotateMatrix(12) = 0
rotateMatrix(13) = 0
rotateMatrix(14) = 0
rotateMatrix(15) = 1

' 矩阵乘法：当前变换矩阵 × 局部旋转矩阵，得到新变换矩阵
Dim newTransform(15) As Double
Call MultiplyMatrices(currentTransform, rotateMatrix, newTransform)

' 将新矩阵分解为轴向量和位置向量，填充到目标数组
Dim arrayOfVariantOfDouble1(11) As Double
' X轴向量
arrayOfVariantOfDouble1(0) = newTransform(0)
arrayOfVariantOfDouble1(1) = newTransform(1)
arrayOfVariantOfDouble1(2) = newTransform(2)
' Y轴向量
arrayOfVariantOfDouble1(3) = newTransform(4)
arrayOfVariantOfDouble1(4) = newTransform(5)
arrayOfVariantOfDouble1(5) = newTransform(6)
' Z轴向量
arrayOfVariantOfDouble1(6) = newTransform(8)
arrayOfVariantOfDouble1(7) = newTransform(9)
arrayOfVariantOfDouble1(8) = newTransform(10)
' 位置坐标
arrayOfVariantOfDouble1(9) = newTransform(12)
arrayOfVariantOfDouble1(10) = newTransform(13)
arrayOfVariantOfDouble1(11) = newTransform(14)

' 应用新的变换
Set move1 = productToMove.Move
Set move1Variant = move1.MovableObject
move1Variant.Apply arrayOfVariantOfDouble1

' 4x4矩阵乘法辅助函数
Sub MultiplyMatrices(matA As Variant, matB As Variant, result As Variant)
    Dim i As Integer, j As Integer, k As Integer
    For i = 0 To 3
        For j = 0 To 3
            result(i * 4 + j) = 0
            For k = 0 To 3
                result(i * 4 + j) = result(i * 4 + j) + matA(i * 4 + k) * matB(k * 4 + j)
            Next k
        Next j
    Next i
End Sub

关键注意点 #

• 直接修改轴向量会导致全局坐标系下的旋转，必须通过矩阵乘法叠加局部变换。
• 矩阵乘法顺序不能颠倒，否则会变成绕全局轴旋转。
• 若需绕X/Y局部轴旋转，只需替换旋转矩阵的构造逻辑即可。

内容的提问来源于stack exchange，提问作者balla.zoltan