【机器人学】7-3.六自由度机器人自干涉检测-圆柱体的旋转变换【附MATLAB代码】
前言
上一章确定了机械臂等效的圆柱体的上下圆心坐标，这篇文章将解决算法三个核心中的第二个核心：
一 根据机械臂的几何数据以及DH参数，确定机械臂等效的圆柱体的上下圆心坐标。
二 将一个圆柱体旋转到与坐标Z轴对齐，另一个圆柱体转到，上下圆在XoY平面的
投影形成的椭圆在y方向上长轴为2r，这一个旋转流程的数学表达。
三 原点与椭圆的关系，求原点是否在椭圆内部，原点到椭圆的最短距离，线段与
线段的最短距离。
之所以要将圆柱体作旋转变换，是为了方便借用投影法分析。
旋转的数学表达
如式(7)所示，L2是围绕L1的下底圆心转动，故无论如何转动都不会改变两圆柱体在空间中的位置关系。