基于圆弧插补获得写字机器人圆弧行走线段的方法

摘要

本发明公开了圆弧插补获得写字机器人圆弧行走线段的方法，具体步骤为，获取圆心坐标、圆心到起始点和终止点的向量坐标，利用余弦公式计算两向量的夹角，通过夹角判断移动方向，计算圆弧分为线段的数目，利用泰勒公式计算每一小线段的sin,cos值，利用圆的极坐标方程计算小线段的起始点和终止点坐标，进行直线插补。利用本方法，对给出的圆弧线段进行分段获得更小的线段，并获得线段的起始坐标和终点坐标，从而便于进行直线插补，以控制写字机器写出更为精确的对应圆弧。