发明名称 大运载质心柔性测量方法
摘要 大运载质心柔性测量方法,它涉及一种质心测量方法,本发明的目的是提供一种可实现高精度、自动化、通用性测量的大运载质心柔性测量方法。利用坐标测量系统测量四个称重传感器与工装接触点的坐标;工装空载,通过四个称重传感器1得到四个称重传感器的读数F1′~F4′和两个工装重力Fg1、Fg2;在工装上放置产品,得到四个传感器给工装及产品的支撑力F1~F4;建立产品的坐标系;得到产品坐标系下且经过质心的直线方程L1’;将产品旋转一定的角度,进行产品在第二个状态下的测量,在产品坐标系下得到另一条经过产品质心的直线L2’;两条直线都在产品坐标系中,且都经过产品质心,将两个直线方程联立得到产品质心在产品坐标系下的坐标。本发明适于大运载各个舱段的质心测量。
申请公布号 CN102128704B 申请公布日期 2012.05.30
申请号 CN201010602043.9 申请日期 2010.12.23
申请人 哈尔滨工业大学 发明人 唐文彦;王超;张晓琳;王军
分类号 G01M1/12(2006.01)I 主分类号 G01M1/12(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 杨立超
主权项 一种大运载质心柔性测量方法,其特征在于:所述方法是按照以下步骤实现的:步骤一、假设竖直向上方向与测量坐标系x、y、z轴夹角分别是α、β、γ,将四个称重传感器(1)摆放好,利用坐标测量系统测量四个称重传感器(1)与机械工装(2)接触点的坐标为(xi,yi,zi),i=1~4,这些坐标值将作为称重传感器(1)支撑力的分力臂带入到力矩平衡方程中计算;步骤二、工装空载,称量工装(2)的重量,四个称重传感器(1)分成两对,每对称重传感器(1)在竖直方向上架设有一个工装(2),通过四个称重传感器(1)得到四个称重传感器的读数F1′~F4′和两个工装重力Fg1、Fg2,再将这些力沿测量坐标系x、y、z轴分解,得到: <mrow> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msup> <msub> <mi>F</mi> <mi>ix</mi> </msub> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>F</mi> <mi>i</mi> </msub> <mo>&prime;</mo> </msup> <mi>cos</mi> <mi>&alpha;</mi> </mtd> </mtr> <mtr> <mtd> <msup> <msub> <mi>F</mi> <mi>iy</mi> </msub> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>F</mi> <mi>i</mi> </msub> <mo>&prime;</mo> </msup> <mi>cos</mi> <mi>&beta;</mi> </mtd> </mtr> <mtr> <mtd> <msup> <msub> <mi>F</mi> <mi>iz</mi> </msub> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>F</mi> <mi>i</mi> </msub> <mo>&prime;</mo> </msup> <mi>cos</mi> <mi>&gamma;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> </mrow> <mrow> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>x</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mi>cos</mi> <mi>&alpha;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>y</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mi>cos</mi> <mi>&beta;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>z</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mi>cos</mi> <mi>&gamma;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> </mrow> <mrow> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>x</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mi>cos</mi> <mi>&alpha;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>y</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mi>cos</mi> <mi>&beta;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>z</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mi>cos</mi> <mi>&gamma;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>i=1,2,3,4,由于工装此时处于平衡状态,所受到的各个力相对于测量坐标系下各个坐标轴的力矩为零,即 <mfenced open='{' close=''> <mtable> <mtr> <mtd> <mi>M</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mi>M</mi> <mrow> <mo>(</mo> <mi>y</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mi>M</mi> <mrow> <mo>(</mo> <mi>z</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced>经整理得到下列方程组: <mrow> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>=</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>4</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>4</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>=</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>z</mi> <mn>4</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>z</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>4</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>=</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>+</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>y</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>x</mi> <mn>4</mn> </msub> <mo>-</mo> <msup> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>x</mi> </mrow> </msub> <mo>&prime;</mo> </msup> <msub> <mi>y</mi> <mn>4</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>步骤三、将待测件(5)放置到两个称量工装(2)上,记录四个称重传感器(1)的读数,即为四个传感器给工装及产品的支撑力F1~F4,仍然将这些支撑力沿测量坐标系的x、y、z轴方向分解,得 <mrow> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>F</mi> <mi>ix</mi> </msub> <mo>=</mo> <msub> <mi>F</mi> <mi>i</mi> </msub> <mi>cos</mi> <mi>&alpha;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mi>iy</mi> </msub> <mo>=</mo> <msub> <mi>F</mi> <mi>i</mi> </msub> <mi>cos</mi> <mi>&beta;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>F</mi> <mi>iz</mi> </msub> <mo>=</mo> <msub> <mi>F</mi> <mi>i</mi> </msub> <mi>cos</mi> <mi>&gamma;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>i=1,2,3,4此时工装及产品处于平衡状态,它们所受到的各个力相对于测量坐标系各坐标轴的力矩为零,列力矩平衡方程,整理得到下列方程组: <mrow> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>p</mi> <mi>z</mi> </msub> <mi>y</mi> <mo>-</mo> <msub> <mi>p</mi> <mi>y</mi> </msub> <mi>z</mi> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>4</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>4</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <msub> <mi>p</mi> <mi>x</mi> </msub> <mi>z</mi> <mo>-</mo> <msub> <mi>p</mi> <mi>z</mi> </msub> <mi>x</mi> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mn>4</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>4</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>z</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>z</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <msub> <mi>p</mi> <mi>y</mi> </msub> <mi>x</mi> <mo>-</mo> <msub> <mi>p</mi> <mi>x</mi> </msub> <mi>y</mi> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>1</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>2</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>3</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mn>4</mn> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mn>4</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mn>4</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>1</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>y</mi> </mrow> </msub> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>g</mi> <mn>2</mn> <mi>x</mi> </mrow> </msub> <msub> <mi>y</mi> <mrow> <mi>g</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>其中px、py、pz分别为产品重力P沿测量坐标系x、y、z轴方向的分力: <mrow> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msub> <mi>p</mi> <mi>x</mi> </msub> <mo>=</mo> <mi>P</mi> <mi>cos</mi> <mi>&alpha;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>p</mi> <mi>y</mi> </msub> <mo>=</mo> <mi>P</mi> <mi>cos</mi> <mi>&beta;</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>p</mi> <mi>z</mi> </msub> <mo>=</mo> <mi>P</mi> <mi>cos</mi> <mi>&gamma;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>将传感器与工装接触点坐标(xi,yi,zi)和公式(1)、(2)、(3)、(5)代入式(4)中,求解方程组,经整理,最后可得到一条直线方程L1,该直线在测量坐标系下且经过产品质心; <mrow> <mi>L</mi> <mn>1</mn> <mo>:</mo> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <mi>x</mi> <mo>=</mo> <msub> <mi>f</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mi>y</mi> <mo>=</mo> <msub> <mi>f</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mi>z</mi> <mo>=</mo> <msub> <mi>f</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>步骤四、建立产品的坐标系,并且利用两个坐标系之间的转换矩阵T将直线L1方程从测量坐标系下转换到产品坐标系下;步骤五、直线方程L1经过转换,得到产品坐标系下且经过质心的直线方程L1’; <mrow> <msup> <mrow> <mi>L</mi> <mn>1</mn> </mrow> <mo>'</mo> </msup> <mo>:</mo> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msup> <mi>x</mi> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>f</mi> <mn>1</mn> </msub> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <msup> <mi>y</mi> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>f</mi> <mn>2</mn> </msub> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <msup> <mi>z</mi> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>f</mi> <mn>3</mn> </msub> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>这样就完成了产品在第一个状态下的测量;步骤六、然后将产品旋转一定的角度,进行产品在第二个状态下的测量,与产品在第一个状态时测量及计算方法一样,最后在产品坐标系下得到另一条经过产品质心的直线L2’ <mrow> <msup> <mrow> <mi>L</mi> <mn>2</mn> </mrow> <mo>'</mo> </msup> <mo>:</mo> <mfenced open='{' close=''> <mtable> <mtr> <mtd> <msup> <mi>x</mi> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>g</mi> <mn>1</mn> </msub> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <msup> <mi>y</mi> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>g</mi> <mn>2</mn> </msub> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <msup> <mi>z</mi> <mo>&prime;</mo> </msup> <mo>=</mo> <msup> <msub> <mi>g</mi> <mn>3</mn> </msub> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>两条直线都在产品坐标系中,且都经过产品质心,将两个直线方程联立,求得其交点,即为产品质心在产品坐标系下的坐标。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号