Matlab FMINCON求解六自由度机械臂运动优化最优解违反约束原因问询

• 求解未完成收敛，提前终止
  你收到的报错已经明确说明求解器触发了默认的MaxFunctionEvaluations=3000上限，迭代过程提前中断，返回的是尚未收敛到可行域的中间解，而非满足约束的最优解。这类带分式项的非线性约束优化迭代开销本来就高于线性约束问题，默认评估次数不足以支撑完成收敛，你可以通过optimoptions调高该参数（比如设置为1e4及以上）再尝试求解。
• 未设置合理的优化变量边界
  你求解的h变量物理意义为轨迹段的时间间隔，本质上必须为正，甚至可以根据你的机械臂控制需求设置合理的上下限（比如最小不低于采样周期，最大不超过总时长上限）。如果调用fmincon时没有传入下界lb和上界ub参数，迭代过程中h可能出现接近0或者过大的数值，不仅会导致约束中的1/h(i)项出现数值奇点，也会让求解器在无意义的参数区间浪费迭代资源，最终停在不可行区域。
• 约束满足容忍度设置不合理
  fmincon默认的ConstraintTolerance为1e-6，而你的约束上限数值量级为200~400，如果你对约束满足的精度要求更高，可以适当调低该容忍度参数，强制求解器更严格地约束解的可行性。
• 算法选型不匹配问题
  你可以尝试切换fmincon的求解算法，比如从默认的内点法切换为SQP（序列二次规划）算法，这类算法针对带非线性约束的小规模优化问题收敛速度更快，处理约束满足的效果也更优。
• 约束定义潜在错误
  检查三个约束的下标对应关系、以及w(i)、q(i)、t(i)、tx等中间变量的取值是否符合你的预期，若约束定义和物理需求存在偏差，求解器得到的结果自然不会满足你实际需要的约束条件。

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