为什么不把料盘摆正?因为不能前提假设料盘摆放位置与电机轴坐标系平行同向
如上图所示,这个料盘m行n列,现在需要示教所有料位的取料位置,总不能每一个料位都去手动示教吧!
┭┮﹏┭┮
理想情况下,最多示教3个 边角点位 xy,然后根据已知的行数和 列数 ,就能自动算出所有阵列点位xy。
图形是规则的,每个料位都相同的尺寸大小,料盘是一个m行n列的标准矩形。
要注意的是,料盘的摆放位置不一定与电机坐标系xy平行,如果是平行的那就很好算:
dx = (x3-x1) / (n-1); //列间距
dy = (y3-y1) / (m-1); //行间距
x = dx * (b-1) + x1;
y = dy * (a-1) + y1;
注意正负号