四连杆机构输出角fi4的角-时曲线异常问题咨询

你遇到的两个问题（fi2波动异常、fi4曲线不符合预期），主要是代码里的角度计算和细节处理有问题，咱们一步步拆解分析：

一、为什么fi2随时间波动？ #

你用np.arctan(y/x)计算输入角fi2，这个函数有个致命局限：它只能返回**[-π/2, π/2]**范围内的角度，没法根据x和y的正负判断实际所在的象限。比如当曲柄转到第二、第三象限（x为负）时，arctan(y/x)会错误地把角度映射到第一或第四象限，直接导致fi2出现跳变和无规律波动。

正确的做法是用np.arctan2(y, x)，这个函数会同时参考y和x的符号，返回**[-π, π]**范围内的连续角度，完美匹配曲柄匀速旋转的运动规律。甚至更简单的方式：因为曲柄是匀速旋转，输入角直接可以用fi2 = omega * t计算，不需要绕坐标转换的弯路。

二、为什么fi4不是预期的类正弦曲线？ #

首先是fi2的错误计算导致后续所有推导参数（A、B、C）全部出错，修正fi2后，fi4的曲线会立刻趋近于预期的形态。另外还要注意两个细节：

1. 浮点精度问题：计算判别式B²-4AC时，可能会出现极小的负数（比如-1e-10），直接开根号会报错，需要加个阈值把这类值置0；
2. 构型选择：fi4_1和fi4_2对应四连杆机构的两种构型（比如“伸直型”和“折叠型”），你需要根据实际机构的初始安装状态选择正确的解。

修正后的完整代码 #

from __future__ import division
import math
import numpy as np
import matplotlib.pyplot as plt

# 四连杆机构实际参数
a = 45.5  # 曲柄长度 mm
b = 250   # 连杆长度 mm
c = 140   # 摇杆长度 mm
d = 244.244  # 机架长度 mm

# 输入角fi2的正确计算
f = 16.7/60  # 转速 r/s
omega = 2 * np.pi * f  # 角速度 rad/s
t = np.linspace(0, 50, 1000)  # 增加采样点让曲线更平滑
# 方式1：直接用角速度计算（最准确高效）
fi2 = omega * t
# 方式2：用arctan2获取连续角度（如果需要坐标转换的场景）
# fi2 = np.arctan2(a * np.sin(omega * t), a * np.cos(omega * t))

# 矢量环方程求解fi4
K1 = d/a
K2 = d/c
K3 = (a**2 - b**2 + c**2 + d**2)/(2*a*c)
A = np.cos(fi2) - K1 - K2*np.cos(fi2) + K3
B = -2*np.sin(fi2)
C = K1 - (K2+1)*np.cos(fi2) + K3

# 处理浮点精度问题，避免根号内出现负数
discriminant = B**2 - 4*A*C
discriminant[discriminant < 0] = 0  # 把极小负数值置0

# 计算两种构型的输出角
fi4_1 = 2*np.arctan((-B + np.sqrt(discriminant))/(2*A))
fi4_2 = 2*np.arctan((-B - np.sqrt(discriminant))/(2*A))

# 绘图优化
plt.figure(figsize=(10,6))
plt.plot(t, np.degrees(fi2), color='blue', label='输入角fi2')
plt.plot(t, np.degrees(fi4_2), color='red', label='输出角fi4')
plt.xlabel('时间 t (s)')
plt.ylabel('角度 (°)')
plt.legend()
plt.grid(True)
plt.show()

额外验证 #

你的机构参数满足格拉肖夫定理（最短杆+最长杆 ≤ 其余两杆之和：45.5+250=295.5 ≤ 140+244.244=384.244），所以机构可以实现连续的曲柄旋转，修正后fi4会呈现符合预期的周期性曲线。

内容的提问来源于stack exchange，提问作者user2882635