点击图片查看原图
1747-PT1CC
1747-PT1CC
当大臂处于OG1与OJ1之间时，小臂可能与圆K1发生碰撞。仅考虑右手关节坐标系时，这一区间内的任一q1值均有两个q2值：q20与q21与之对应。其中q20为碰撞开始时的关节2角度，q21为碰撞结束时的关节2角度。两者相差为类似于角Q1G1F1的两倍的某个角度值。采用几何学方法，设位姿OG1F1为小臂末端与圆K1发生碰撞的一个极限状态，而OG1Q1为小臂延长线与圆K1相切时的位姿，切点为Q1。由图中所示的几何关系，可求出角Q1G1F1的角度值，同时在q20的基础上加上两倍的Q1G1F1的角度值，即为q21。
左手关节坐标系下的情况完全相似，不再骜述。据此可求出在q1在可能碰撞区间内的每个q2的最大最小值，从而确定障碍物K1在关节空间中的边界值。
同法也可求出圆形障碍物K2在关节空间中的边界值。
根据连通性原理，直角坐标中连通闭合的圆形区域在关节空间中必然也是连通闭合的区域。只要将求出的边界值连接起来，闭合的范围就是关节坐标系下的障碍区域，而这些区域覆盖到的小方块群即为圆形障碍区域映射到关节空间内的障碍区域。
在算法中需设定一个可达矩阵，其维数为1600*1600，各元素取0或1，0表示两个小方块之间不可达，1表示可达。将障碍区域编号群中的每个编号值在可达矩阵中对应的行和列均取为0。同时为了保证每个小方块只能与其紧邻的八个小方块相通(关节空间四角的小方块只与其紧邻的三个小方块相通，四边的小方块只与其紧邻的五个小方块相通)，而不出现跳步，还应在可达矩阵的相应位置赋0值。
1747-ACN15
1747-ACNR15
1747-AIC
1747-ASB
1747-BA
1747-BSN
1747-C10
1747-C11
1747-C13
1747-C20
1747-CHORAD
1747-CHORAD1
1747-CHORADC1B
1747-CP3
1747-DCM
1747-DTAM-E
1747-KE
1747-KFC15
1747-L20A
1747-L20B
1747-L20C
1747-L20D
1747-L20E
1747-L20F
1747-L20G
1747-L20L
1747-L20R
1747-L20P
1747-L20R
1747-L30A
1747-L30B
1747-L40B
1747-L40B
1747-L40C
1747-L40E
1747-L40F
1747-L40L
1747-L40P
1747-L511 SLC 5/01
1747-L514 SLC 5/01
1747-L524 SLC 5/02
1747-L531 SLC 5/03
1747-L532 SLC 5/03
1747-L541
1747-L542
1747-L542P
1747-L543
1747-L551
1747-L552
1747-L553
1747-M1
1747-M11
1747-M12
1747-M15
1747-M2
1747-M3
1747-M4
1747-M5
1747-NP1
1747-NP2
1747-OCAPINT
1747-OCDPDE
1747-OCDPES
1747-OCDPFR
1747-OCDPIT
1747-OCDR16
1747-OCDR32
1747-OCDR4
1747-OCENET
1747-OCF 266
1747-OCFAN1
1747-OCIDE1
1747-OCIDE25
1747-OCKTX
1747-OCKTXD
1747-OCP252
1747-OCPCI2
1747-OCPCI3
1747-OCPCI4
1747-OCPCI5
1747-OCPCI6
1747-OCPCM1
1747-OCPCM2
1747-OCS92
1747-OCSBC
1747-OCSDCK
1747-OCTS
1747-OCUS
1747-OCVGA1
1747-OCVGAE
1747-PCIAA
1747-PCIAB
1747-PCIBA
1747-PCIBB
1747-PCIC
1747-PCIC2
1747-PCIL
1747-PCINT
1747-PCIS
1747-PCIS2
1747-PIC
1747-PLXCLNTCBS
1747-PSD
1747-PT1
1747-PT1CC
1747-PTA1E
1747-PTA1F
1747-PTA1G
1747-PTA1I
1747-R21
1747-R21F
1747-R5
1747-R7
1747-RL302
1747-RL401
1747-SCNR
1747-SDN
1747-SN
