台体型并联机构及其位置正解的求解方法与流程

文档序号:11794484阅读:来源:国知局

技术特征:

1.一种台体型并联机构,包括一个实心立方体形状的动平台,一个空心立方体形状的静平台和12条结构相同的支链,所述动平台和12条支链设置在静平台的容置腔内,初始状态下,静平台的几何中心与动平台的几何中心重合;其特征是,所述12条支链中,每两条支链为一组呈一夹角布置于动平台上的6条棱边的中点,所述6条棱边分为三组,每组包括不在同一平面且相互平行的两条棱边,所述支链由一移动副和两球面副串联而成。

2.根据权利要求1所述的台体型并联机构,其特征是,所述支链由一个下球铰链、一个内杆、一个外杆和一个共用球铰链依次串接组成,所述内杆套装在外杆内,并且所述内杆与外杆配合形成一移动副,使得内杆可沿轴向相对外杆移动,进而使支链可压短和拉长;所述下球铰链、共用球铰链为圆球体,所述内杆与下球铰链配合形成第一球面副,所述外杆与共用球铰链配合形成第二球面副。

3.根据权利要求2所述的台体型并联机构,其特征是,所述下球铰链固定在静平台的内壁上。

4.根据权利要求3所述的台体型并联机构,其特征是,所述每组两条支链共用一个共用球铰链,6个共用球铰链分别固定于动平台的上后棱边、上左棱边、右后棱边、下前棱边、下右棱边、左前棱边的中点。

5.根据权利要求4所述的台体型并联机构,其特征是,所述每组两条支链之间的夹角为90°。

6.根据权利要求1至5任一项所述的台体型并联机构位置正解的求解方法,其特征是,包括以下步骤:

第1步、将静平台固定在工作地面上,并在静平台的容置腔内设置动平台和12条支链,在静平台内建立坐标系oxyz,其中坐标系原点o与静平台的几何中心重合,x、y、z轴分别垂直指向静平台的右侧面、顶面、前面,初始状态下,动平台的几何中心与静平台的几何中心重合,动平台的6个外表面与静平台的6个内表面一一对应且平行设置,并且12条支链的长度相同;转至第2步;

第2步、将动平台的中心点标记为P,其笛卡尔坐标为将固定于动平台上的6个共用球铰链的中心点依次标记为B1、B2、B3、B4、B5、B6,,其笛卡尔坐标分别为选取动平台上四个特征点的坐标为未知量,所述四个特征点为动平台的中心点和前3个共用球铰链的中心点,其笛卡尔坐标分别为假设将x0,y0,z0,x1,y1,z1,x2,y2,z2,x3,y3,z3设为待求的未知数,然后根据上述12个未知数列出后3个共用球铰链中心点的笛卡尔坐标的坐标解析式:

转至第3步;

第3步、驱动12条支链的移动副工作,以实现动平台在静平台的容置腔内沿任意方向运动,然后根据12条支链的下球铰链中心点与对应共用球铰链中心点之间的实时距离以及前3个共用球铰链中心点分别与动平台中心点之间的约束距离,建立15个二次相容方程式,将15个二次相容方程式分成三组,其中方程(1)~(5)构成第一组方程,方程(6)~(10)构成第二组方程,方程(11)~(15)构成第三组方程,

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>1</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>1</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>x</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>+</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>1</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>2</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>x</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>+</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>4</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>7</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>4</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>8</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>+</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>8</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>1</mn> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mn>2</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>3</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>+</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>4</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>+</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>5</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>9</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>5</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>10</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>+</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>10</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>2</mn> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mn>2</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>3</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>5</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>+</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>3</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>6</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>+</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>6</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>11</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>-</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>+</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>6</mn> </msub> <mo>-</mo> <msub> <mover> <mi>b</mi> <mi>v</mi> </mover> <mn>12</mn> </msub> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>n</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <msup> <msub> <mi>l</mi> <mn>12</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>|</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>3</mn> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> <msup> <mo>|</mo> <mn>2</mn> </msup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mn>2</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>

其中,设定支链的编号为j(j=1,2,3,…12),并将第j条支链的下球铰链中心点标记为bj,其笛卡尔坐标为将第j条支链的下球铰链中心点与对应共用球铰链中心点之间的实时距离设为lj,同时设定支链的初始长度为L,动平台的边长为2n;转至第4步;

第4步、依次将第一组方程、第二组方程、第三组方程中的同构方程相减,得到12个线性相容方程:

<mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>2</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>=</mo> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>4</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>=</mo> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>8</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>4</mn> <mi>L</mi> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>17</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>3</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>=</mo> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>1</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>1</mn> </msub> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>19</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>7</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>=</mo> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>20</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>9</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>+</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>=</mo> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>10</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>4</mn> <mi>L</mi> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>21</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>8</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>=</mo> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>+</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>22</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>6</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>nx</mi> <mn>2</mn> </msub> <mo>-</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>-</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>-</mo> <msup> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>23</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>12</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>=</mo> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>24</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>14</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>=</mo> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>12</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>4</mn> <mi>L</mi> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>25</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>13</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>=</mo> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>26</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> <mo>-</mo> <mo>(</mo> <mn>11</mn> <mo>)</mo> <mo>&DoubleRightArrow;</mo> <msub> <mi>nx</mi> <mn>3</mn> </msub> <mo>-</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>27</mn> <mo>)</mo> </mrow> </mrow>

转至第5步;

第5步、将上述12个线性相容方程分成四组,其中,方程(17)、(21)、(25)构成关于动平台位置的第Ⅰ组方程,并将第Ⅰ组方程表示成如下矩阵形式:

<mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <mn>4</mn> <mi>L</mi> </mrow> </mfrac> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>8</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>12</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>10</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>28</mn> <mo>)</mo> </mrow> <mo>,</mo> </mrow>

方程(16)、(18)、(19)构成关于第一个共用球铰链中心点坐标的第Ⅱ组方程,并将第Ⅱ组方程表示成如下矩阵形式:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>n</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>1</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>29</mn> <mo>)</mo> </mrow> <mo>,</mo> </mrow>

方程(20)、(22)、(23)构成关于第二个共用球铰链中心点坐标的第Ⅲ组方程,并将第Ⅲ组方程表示成如下矩阵形式:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>+</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>-</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>-</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>-</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>30</mn> <mo>)</mo> </mrow> </mrow>

方程(24)、(26)、(27)构成关于第三个共用球铰链中心点坐标的第Ⅳ组方程,并将第Ⅳ组方程表示成如下矩阵形式:

<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> </mfenced>

<mrow> <mo>(</mo> <mn>31</mn> <mo>)</mo> </mrow>

转至第6步;

第6步、计算得到非齐次线性方程组(28)的系数矩阵的行列式如下:

<mrow> <mo>|</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mo>|</mo> <mo>=</mo> <mn>2</mn> <mo>&NotEqual;</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>32</mn> <mo>)</mo> </mrow> </mrow>

当非齐次线性方程组(28)的系数矩阵非奇异时,该方程的解析解如下:

<mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <mn>4</mn> <mi>L</mi> </mrow> </mfrac> <msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>8</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>12</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>10</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>33</mn> <mo>)</mo> </mrow> </mrow>

转至第7步;

第7步、根据非齐次线性方程组(29)、(30)、(31)计算得到其系数矩阵的行列式,并根据上述行列式分别判断非齐次线性方程组(29)、(30)、(31)的系数矩阵的奇异性,当非齐次线性方程组(29)、(30)、(31)的系数矩阵非奇异时,能够直接获得6个共用球铰链中心点坐标的解析解,当非齐次线性方程组(29)、(30)、(31)的系数矩阵奇异时,需结合对应的共用球铰链中心点坐标的一个二次相容方程获得6个共用球铰链中心点坐标的解析解;转至第8步;

第8步、采用x0,y0,z0,x1,y1,z1,x2,y2,z2,x3,y3,z312个未知数描述动平台的右侧面中心点坐标、顶面中心点坐标、前面中心点坐标,然后利用动平台的右侧面中心点坐标、顶面中心点坐标、前面中心点坐标以及动平台的中心点坐标描述动平台姿态的解析解,最终得到动平台位姿的全解析解。

7.根据权利要求6所述的台体型并联机构位置正解的求解方法,其特征是,所述第7步中判断非齐次线性方程组(29)、(30)、(31)的系数矩阵的奇异性以及获得6个共用球铰链中心点坐标的解析解,包括如下步骤:

S1、首先计算得到非齐次线性方程组(29)的系数矩阵的行列式如下:

<mrow> <mo>|</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>n</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>|</mo> <mo>=</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mn>2</mn> <mi>n</mi> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>34</mn> <mo>)</mo> </mrow> </mrow>

再根据x0是否为0,判断非齐次线性方程组(29)的系数矩阵的奇异性,若x0≠0,非齐次线性方程组(29)的系数矩阵非奇异,该方程的解析解如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>1</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>n</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>35</mn> <mo>)</mo> </mrow> <mo>,</mo> </mrow>

若x0=0,非齐次线性方程组(29)的系数矩阵奇异,需要从非齐次线性方程组(29)中提取新的二元方程组(36):

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>n</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>y</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>1</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>36</mn> <mo>)</mo> </mrow> </mrow>

根据二元方程组(36)计算其系数矩阵的行列式:

<mrow> <mo>|</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>n</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>|</mo> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mn>2</mn> <mi>n</mi> <mo>)</mo> </mrow> <mo>&NotEqual;</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>37</mn> <mo>)</mo> </mrow> </mrow>

当二元方程组(36)的系数矩阵非奇异时,该方程组的解析解如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>y</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>1</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>n</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>nz</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>1</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>7</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>38</mn> <mo>)</mo> </mrow> </mrow>

然后根据方程(5),获得x1的两个解析解:

<mrow> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>=</mo> <mo>&PlusMinus;</mo> <msqrt> <mrow> <mn>2</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>39</mn> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

转至S2;

S2、首先计算得到非齐次线性方程组(30)的系数矩阵的行列式如下:

<mrow> <mo>|</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mo>|</mo> <mo>=</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mn>2</mn> <mi>n</mi> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>40</mn> <mo>)</mo> </mrow> </mrow>

再根据z0是否为0,判断非齐次线性方程组(30)的系数矩阵的奇异性,若z0≠0,非齐次线性方程组(30)的系数矩阵非奇异,该方程的解析解如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>+</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>-</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>-</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>-</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>41</mn> <mo>)</mo> </mrow> <mo>,</mo> </mrow>

若z0=0,非齐次线性方程组(30)的系数矩阵奇异,需要从非齐次线性方程组(30)中提取新的二元方程组(42):

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>-</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>-</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>-</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>42</mn> <mo>)</mo> </mrow> </mrow>

根据二元方程组(42)计算其系数矩阵的行列式:

<mrow> <mo>|</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>|</mo> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mn>2</mn> <mi>n</mi> <mo>)</mo> </mrow> <mo>&NotEqual;</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>43</mn> <mo>)</mo> </mrow> </mrow>

当二元方程组(42)的系数矩阵非奇异时,该方程组的解析解如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>4</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>3</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>9</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>-</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>-</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>-</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>44</mn> <mo>)</mo> </mrow> </mrow>

然后根据方程(10),获得z2的两个解析解:

<mrow> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>=</mo> <mo>&PlusMinus;</mo> <msqrt> <mrow> <mn>2</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>45</mn> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

转至S3;

S3、首先计算得到非齐次线性方程组(31)的系数矩阵的行列式如下:

<mrow> <mo>|</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>|</mo> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mn>2</mn> <mi>n</mi> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>46</mn> <mo>)</mo> </mrow> </mrow>

再根据y0是否为0,判断非齐次线性方程组(31)的系数矩阵的奇异性,若y0≠0,非齐次线性方程组(31)的系数矩阵非奇异,该方程的解析解如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>0</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>0</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mo>(</mo> <mn>2</mn> <mi>L</mi> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> <mo>/</mo> <mn>4</mn> <mo>+</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>47</mn> <mo>)</mo> </mrow> <mo>,</mo> </mrow>

若y0=0,非齐次线性方程组(31)的系数矩阵奇异,需要从非齐次线性方程组(31)中提取新的二元方程组(48):

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>48</mn> <mo>)</mo> </mrow> </mrow>

根据二元方程组(48)计算其系数矩阵的行列式:

<mrow> <mo>|</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mi>n</mi> <mo>+</mo> <mi>L</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>|</mo> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mn>2</mn> <mi>n</mi> <mo>)</mo> </mrow> <mo>&NotEqual;</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>49</mn> <mo>)</mo> </mrow> </mrow>

当二元方程组(48)的系数矩阵非奇异时,该方程组的解析解如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msup> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mi>n</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>l</mi> <mn>6</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <mi>L</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>nx</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>l</mi> <mn>5</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>l</mi> <mn>11</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>4</mn> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>z</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> <mo>)</mo> </mrow> <mo>/</mo> <mn>2</mn> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <mi>n</mi> <mo>+</mo> <mi>L</mi> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>50</mn> <mo>)</mo> </mrow> </mrow>

然后根据方程(15),获得y3的两个解析解:

<mrow> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>=</mo> <mo>&PlusMinus;</mo> <msqrt> <mrow> <mn>2</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>51</mn> <mo>)</mo> </mrow> </mrow>

至此获得前3个共用球铰链的中心点坐标

8.根据权利要求7所述的台体型并联机构位置正解的求解方法,其特征是,所述第8步中动平台姿态解析解的获取方法具体如下:

(a)对前3个共用球铰链的中心点坐标(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3)是否为唯一解进行判断,若(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3)是唯一解,则选定前3个共用球铰链的中心点坐标;若(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3)不是唯一解,则根据(52)式筛选出符合要求的前3个共用球铰链的中心点坐标:

<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>+</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>+</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>52</mn> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

(b)根据前3个共用球铰链的中心点坐标获得后3个共用球铰链的中心点坐标;

(c)将动平台的右侧面中心点坐标设为根据该点与第三个共用球铰链中心点、第5个共用球铰链中心点、动平台中心点的几何关系,获得该点坐标的解析解:

<mrow> <msub> <mover> <mi>P</mi> <mi>v</mi> </mover> <mrow> <mi>r</mi> <mi>i</mi> <mi>g</mi> <mi>h</mi> <mi>t</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>3</mn> </mfrac> <mo>(</mo> <mrow> <mover> <mi>P</mi> <mi>v</mi> </mover> <mo>+</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>3</mn> </msub> <mo>+</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>5</mn> </msub> </mrow> <mo>)</mo> <mo>-</mo> <mfrac> <mn>1</mn> <mrow> <mn>3</mn> <mi>n</mi> </mrow> </mfrac> <mo>(</mo> <mrow> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>5</mn> </msub> <mo>-</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>3</mn> </msub> </mrow> <mo>)</mo> <mo>&times;</mo> <mo>(</mo> <mrow> <mover> <mi>P</mi> <mi>v</mi> </mover> <mo>-</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>3</mn> </msub> </mrow> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>53</mn> <mo>)</mo> </mrow> </mrow>

其中,“×”表示矢量的叉乘运算;

(d)将动平台的顶面中心点坐标设为根据该点与第一个共用球铰链中心点、第二个共用球铰链中心点、动平台中心点的几何关系,获得该点坐标的解析解:

<mrow> <msub> <mover> <mi>P</mi> <mi>v</mi> </mover> <mrow> <mi>t</mi> <mi>o</mi> <mi>p</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>3</mn> </mfrac> <mo>(</mo> <mrow> <mover> <mi>P</mi> <mi>v</mi> </mover> <mo>+</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>1</mn> </msub> <mo>+</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>2</mn> </msub> </mrow> <mo>)</mo> <mo>-</mo> <mfrac> <mn>1</mn> <mrow> <mn>3</mn> <mi>n</mi> </mrow> </mfrac> <mo>(</mo> <mrow> <mover> <mi>P</mi> <mi>v</mi> </mover> <mo>-</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>1</mn> </msub> </mrow> <mo>)</mo> <mo>&times;</mo> <mo>(</mo> <mrow> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>1</mn> </msub> </mrow> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>54</mn> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

(e)将动平台的前面中心点坐标设为根据该点与第四个共用球铰链中心点、第六个共用球铰链中心点、动平台中心点的几何关系,获得该点坐标的解析解:

<mrow> <msub> <mover> <mi>P</mi> <mi>v</mi> </mover> <mrow> <mi>f</mi> <mi>r</mi> <mi>o</mi> <mi>n</mi> <mi>t</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>3</mn> </mfrac> <mo>(</mo> <mrow> <mover> <mi>P</mi> <mi>v</mi> </mover> <mo>+</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>4</mn> </msub> <mo>+</mo> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>6</mn> </msub> </mrow> <mo>)</mo> <mo>-</mo> <mfrac> <mn>1</mn> <mrow> <mn>3</mn> <mi>n</mi> </mrow> </mfrac> <mo>(</mo> <mrow> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>4</mn> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> </mrow> <mo>)</mo> <mo>&times;</mo> <mo>(</mo> <mrow> <msub> <mover> <mi>B</mi> <mi>v</mi> </mover> <mn>6</mn> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> </mrow> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>55</mn> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

(f)设定动平台的姿态矩阵为(R),根据动平台的右侧面中心点坐标顶面中心点坐标前面中心点坐标以及动平台的中心点坐标描述动平台姿态矩阵(R)的解析解如下:

<mrow> <mo>(</mo> <mi>R</mi> <mo>)</mo> <mo>=</mo> <mfrac> <mn>1</mn> <mi>n</mi> </mfrac> <mo>(</mo> <mrow> <msub> <mover> <mi>P</mi> <mi>v</mi> </mover> <mrow> <mi>r</mi> <mi>i</mi> <mi>g</mi> <mi>h</mi> <mi>t</mi> </mrow> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> <mo>,</mo> <msub> <mover> <mi>P</mi> <mi>v</mi> </mover> <mrow> <mi>t</mi> <mi>o</mi> <mi>p</mi> </mrow> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> <mo>,</mo> <msub> <mover> <mi>P</mi> <mi>v</mi> </mover> <mrow> <mi>f</mi> <mi>r</mi> <mi>o</mi> <mi>n</mi> <mi>t</mi> </mrow> </msub> <mo>-</mo> <mover> <mi>P</mi> <mi>v</mi> </mover> </mrow> <mo>)</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>56</mn> <mo>)</mo> </mrow> </mrow>

其中,动平台位置坐标的解析解和动平台姿态矩阵(R)的解析解共同构成了动平台位姿的全解析解。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1