求一份平面并联机构（四连杆、五连杆均可）空间搜索代码

最近在做一个平面3自由度6R并联机构的工作空间求解问题，苦于没有代码做参考，特来求教。