Unity曲柄滑块四杆机构运动计算

一、运动效果

请添加图片描述

二、机构的介绍

在这里插入图片描述
曲柄长度:a,线段AB长度
连杆长度:b,线段BC长度
偏心距离:e,滑块轨迹与曲柄中心点A的垂直距离

三、已知点A点B和e的值,计算C点的位置

1、计算s的值

var h = math.abs(B.transform.position.y - A.transform.position.y - e);
var s1 = math.sqrt(b_BC * b_BC - h * h);
var s = s1 + (B.transform.position.x - A.transform.position.x);

2、计算C点坐标

C.transform.position = A.transform.position + new Vector3((float)s, (float)e, 0);  //摆放C的位置