三自由度气动机械手的设计

1、羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁

2、螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅

3、肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿

4、袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃

5、膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈

6、羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂

7、膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿

8、肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃

9、衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇

10、肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂

11、羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆

12、膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀

13、聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇

14、袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁

15、肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆

16、羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀

17、腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄

18、羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈

19、袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃

20、肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀

21、羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄

22、腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈

23、羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂薈袅肇莁蚀蚈羃莀莀袃衿葿蒂蚆膈蒈薄袁肄蒈蚆蚄羀蒇莆袀羆肃薈螂

24、袂肂蚁羈膀肁莀螁肆肁蒃羆羂肀薅蝿袈腿蚇薂膇膈莇螇肃膇蕿薀聿膆蚂袆羅膅莁蚈袁膅蒄袄腿膄薆蚇肅膃蚈袂羁节莈蚅袇芁蒀袁螃芀蚂蚃膂艿莂罿肈艿蒄螂羄芈薇羇袀芇虿螀腿芆荿薃肅莅蒁螈羁莄薃薁袇莄芃螆袃莃蒅虿膁莂 三自由度气动机械手的设计1引言 在机械加工及注塑加工行业，很多工位为物体的拾取操作。这种操作一般动作简单，重复性很大。目前针对这种需求，设计了很多拾取机械，这些拾取机械包括电动的、液动的以及气动的。但是目前种种操作机械或机械手的主要结构形式为直角坐标式的，而在许多场合这种操作需要圆周运动，需要具有旋转功能的操作机械。针对上述现有技术的不足，本设计提供了一种结构简单、操作方便、可实现多种运动形式的三自

25、由度气动机械手1。气动技术是流体控制的一个重要分支，具有成本低廉、工作效率高、较高的功率重量比、无污染、使用维护方便以及对环境要求低等一系列优点，已经在工业生产各部门得到越来越广泛的应用。随着计算机技术、微电子技术及控制理论的不断发展，较高精度的气动伺服系统已经实现，并为在机器人领域进一步应用奠定了基础。机械手是传递机构中的重要部分，通过夹持机构将物料从某一位置和方位，按一定运动轨迹传递到另一位置和方位。近年来，机械手在国内外自动化领域中，特别是在有毒、放射、易燃易爆等恶劣环境内，得到了越来越广泛的应用。其中气动机械手与其它类型的机械手相比，具有结构简单、造价较低、易于控制、维护方便、寿命长等

26、优点，因此气动控制机械手机构被很多场合所采用。迄今为止，国内外学者应用控制理论的研究成果，如自适应控制、模糊与神经网络控制、变结构控制、鲁棒控制等，对气动位置伺服系统进行了大量研究并取得了一定进展。但由于气体的压缩性较大以及气缸摩擦力等不确定因素的影响。对气动位置系统进行高精度控制一直是个难题。bobrow等建立了气动系统模型使用扩展的自适应控制方法对三自由度气动关节机械手进行了力/位置混合控制。杨庆俊等提出了气动系统反馈线性化并实现了较高精度的位置控制。本文采用前馈补偿极点配置自校正控制策略,利用 labview实时模块构造了机械手关节控制系统，通过路径规划、运动学反解及关节控制器,完成了3

27、个运动关节的实时控制。在轨迹跟踪方面的实验取得了满意的效果,为进一步的工业化应用奠定了基础。在工业自动化领域里大量采用传感器，智能元件的拼装式气动机械手克服了传统气动机械手的笨重、无通用性等缺点，具有很强的实用性和通用性。同时，由于采用总线连接集成系统，特别是带集成plc以及总线接口的阀岛，提高了气动控制系统的可靠性，简化了安装和装修。国外发展的带新型智能型电磁阀的气动定位系统，采用反馈控制2。机器人及机械手是机电一体化技术的典型产品，充分了解机器人或机械手的设计及应用对机电专业的学生有很重要的意义。机器人或机械手对应用到的技术在工业自动化生产中占有重要的地位，以机器人或机械手作为机电方面学习

28、的典型实验设备有其不可替代的优点。但是，就目前的发展情况来看，机器人或机械手进入课堂及机电学科相关实验的很少。目前市场上所提供的机器人或机械手一般价格在十几万元左右，且其不具开放性，即用户只能高端应用而无法进行低层次或高层次开发，因此，研制一种低成本开放性的机械手是非常必要的。2三自由度气动机械手的结构设计2.1机械手自由度分析自由度是说“自由运动空间的维数”。譬如一个构件，在空间上完全没有约束，那么它可以在3个正交方向上平动，还可以有三个正交方向的转动，那么就有6个自由度。约束增加，自由度就减少，如果该构件的所有运动都被限制，那自由度就是0（相对惯性坐标系静止的构件）。工件定位的实质就是要限

29、制对加工有不良影响的自由度。设空间有一固定点，工件的底面与该点保持接触，那么工件z轴的位置自由度便被限制了。本设计的3个自由度分别为：腰部有1个自由度，作回转运动；大臂和小臂各有1个自由度，作俯仰运动。它的特点是工作范围大,动作灵活,通用性强,能抓取靠近机座的物体,并能绕过障碍物去抓取物体，所有三个自由度均采用气缸实现。气缸引导活塞在其中进行直线往复运动，工质在发动机气缸中通过膨胀将热能转化为机械能；气体在压缩机气缸中接受活塞压缩而提高压力。据工作所需力的大小来确定活塞杆上的推力和拉力。由此来选择气缸时应使气缸的输出力稍有余量。若缸径选小了，输出力不够，气缸不能正常工作；但缸径过大，不仅使设备

30、笨重、成本高，同时耗气量增大，造成能源浪费。在夹具设计时，应尽量采用增力机构，以减少气缸的尺寸。三自由度气动机械手属于关节串联式机器人，其结构如图1所示,它的运动类似人的手臂,由腰、大臂、小臂3个关节组成,腰部为旋转运动,由流量比例阀驱动摆缸来实现,旋转编码器通过1:4的同步带轮与腰部转动轴相连,以检测角度信号；大、小臂均为俯仰运动,由流量比例阀驱动单出杆双作用气缸来实现,旋转编码器通过1:4的同步带轮与对应的大、小臂关节俯仰运动轴相连,以检测角度信号3。小臂关节大臂关节腰部关节图1 结构图2.2机械手气动分析气动就是以压缩空气为动力源，带动机械完成伸缩或旋转动作。因为是利用空气具有压缩性的特

31、点，吸入空气压缩储存，空气便像弹簧一样具有了弹力，然后用控制元件控制其方向，带动执行元件的旋转与伸缩。从大气中吸入多少空气就会排出多少到大气中，不会产生任何化学反应，也不会消耗污染空气的任何成分，另外气体的粘性较液体要小，流动速度快，所以说主要特点便是节能环保。气动技术的优点：1）气动装置结构简单、轻便、安装维护简单。压力等级低、故使用安全；2）工作介质是取之不尽的空气、空气本身不花钱。排气处理简单，不污染环境，成本低；3)输出力以及工作速度的调节非常容易。气缸的动作速度一般为50500mm/s，比液压和电气方式的动作速度快；4)可靠性高，使用寿命长。电器元件的有效动作次数约为百万次，而一般电

32、磁阀的寿命大于3000万次，小型阀超过2亿次；5)利用空气的压缩性，可贮存能量，实现集中供气。可短时间释放能量，以获得间歇运动中的高速响应。可实现缓冲。对冲击负载和过负载有较强的适应能力。在一定条件下，可使气动装置有自保持能力；6)全气动控制具有防火、防爆、防潮的能力。与液压方式相比，气动方式可在高温场合使用；7)由于空气流动损失小，压缩空气可集中供应，远距离输送。气动技术的缺点：1)由于空气有压缩性，气缸的动作速度易受负载的变化而变化。采用气液联动方式可以克服这一缺陷,气缸速度比液压要快；2)气缸在低速运动时候，由于摩擦力占推力的比例较大，气缸的低速稳定性不如液压缸；3)虽然在许多应用场合，

33、气缸的输出力能满足工作要求，但其输出力比液压缸小。气动回路原理如图2所示。这样实现了单关节的闭环控制,进而通过相关的控制策略完成了机械手末端的空间运动控制4。腰部关节大臂关节小臂关节摆动气缸直线气缸直线气缸流量比例阀流量比例阀流量比例阀气源图2 气动回路2.3气动机械手的结构设计下面结合附图与实施例对本设计作进一步说明。2.3.1结构组成及工作原理 机械手的组成如图3所示，其结构由水平移动气缸、机架、底座、电机、水平移动导杆、气动手爪、垂直升降气缸、垂直升降导杆及齿轮装置所组成5。1.水平移动气缸 2.水平移动导杆 3.垂直气缸连接板 4.垂直升降气缸 5.垂直升降导杆6.电机 7.机架 8.

34、小齿轮 9.大齿轮 10.连接板 11.气动手爪 12.小气缸 13.底座 图3 结构原理示意图所述水平移动气缸设置在水平机架上，水平移动导杆与垂直气缸连接板相连接，垂直升降气缸与垂直升降导杆安装在垂直气缸连接板上，气动手爪通过小气缸安装在垂直升降导杆下端部，电机连接在机架上，电机的上部连接在齿轮装置上，齿轮装置的下端固定地连接在机架上，齿轮装置通过旋转轴与电机相连接。所述齿轮装置由相啮合的小齿轮和大齿轮组成，它们安装在机架顶部的底座上，通过连接与水平移动气缸连接。 本设计三自由度气动机械手，水平移动气缸充气时，在水平导杆的导向下，垂直气缸连接板带动垂直升降气缸及垂直升降导杆所组成的垂直升降组

35、件在水平方向移动。电机旋转带动齿轮转动，带动机械手臂作旋转运动，可以转动360，从而完成手爪绕旋转轴的运动。比单纯用气缸带动机械手臂的旋转自由度更大，方便了加工，提高了工作效率。手爪部分采用齿轮齿条传动，并采用可靠性键连接，使手爪抓紧力增强，可承受大的工作强度的手爪在气体的作用下可开启和闭合，以及电机的旋转，这样产生了手爪的水平移动、垂直移动以及旋转移动。所有的执行件为三个气缸与一个电机。整个机械手通过底座安装在基础上。 在拾取物体时，水平移动气缸1收缩，在水平移动导杆2的导向作用下，垂直气缸连接板3带动垂直升降气缸4及垂直升降导杆5移向图示的机架3的左边，这时在垂直升降气缸4的作用下，垂直升

36、降导杆5伸出，在垂直导杆5的导向下，气动手爪11向下移动，同时在小气缸12的作用下，手爪开启，到手爪到达其极限位置（即应拾取的物体的位置）时，在小气缸12的作用下，手爪闭合，夹持住物体。此时在垂直升降气缸4的作用下，气动手爪11收缩，当气动手爪11移动到上极限位置时，水平移动气缸1舒张，使水平移动导杆2达到其右极限位置，此时在电机6的作用下，通过底座13上的小齿轮8，大齿轮9啮合，连接板10的连接下，整个机械手臂绕机架7转动，直至其所定极限位置，然后垂直升降气缸4伸出，直至气动手爪11达到其下端的极限位置，此时在小气缸12的作用下，手爪开启，物体在重力作用下，自由下落。此为拾取物体的一个循环。

37、同样，物体可从三个气缸的6个极限位置实现的手爪的任一极限位置拾取和放置物体。2.4机械手的特性分析 本设计是通过以下技术方案实现的：一种三自由度气动机械手，主要由平移气缸、平移滑块、机架、底座、摆动气缸、平移导杆、手爪、垂直升降气缸、垂直升降导杆及摆动装置所组成，平移气缸和平移滑块相连接并设置在平移机架上，平移导杆与平移滑块相连接，垂直升降气缸与垂直升降导杆安装在平移滑块上，手爪安装在垂直升降气缸的下端部，摆动气缸的下端部连接在底座上，摆动气缸的上部连接在摆动装置上，摆动装置的下端固定地连接在机架上，摆动装置通过旋转轴与底座相连接。本设计应用时，水平移动气缸充气时，在水平导杆的导向下，滑块带动

38、垂直升降气缸及垂直升降导杆所组成的垂直升降组建在水平方向移动。摆动气缸在电磁阀的控制下可使机架及机架上的构建绕旋转轴旋转，从而完成手爪绕旋转轴的运动。手爪在气体的作用下可开启和闭合。这样产生了手爪的水平移动、垂直移动及旋转移动。所有的执行件皆为气缸。整个机械手通过底座安装在其基础上。本设计具有结构简单、操作方便、可实现多种运动方式等优点。3三自由度气动机械手控制系统的设计3.1控制系统的组成气动机械手的阀控缸动力机构均为流量比例控制。工控机通过研华pci1720卡(adc数模转换)输出控制信号；同时pcl2833(三轴正交编码器计数器卡)将采集到的编码器角度信号送至工控机。作为控制系统的软件部

39、分采用matlab的rtw工具箱。rtw是matlab图形建模的一个重要的补充功能模块,是一个代码自动生成环境。它能直接产生优化的、可移植的和个性化的代码,并根据目标配置自动生成多种环境下的程序。为了使模型简洁明了、条理清晰,采取了建立子系统并对之封装的方法,如图4所示：生成机械手工具系确定点坐标转换为夹手系坐标运动学逆运算（生成关节空间转角）插值生成各关节三次多项式运动方程关节控制实时计算机械手的实际位置机械手某些固定参数设置图4 机械手控制系统流程(1)轨迹生成模块。其功能是,将给定的迪卡尔空间内路径曲线按照用户的意愿进行有限分段,并给出所有端点的迪卡尔坐标值。(2)工具坐标系转为夹手坐标

40、系。模块给出的空间点是工具系坐标原点所必须经过的,需要把它进行坐标变换,得到夹手系坐标原点所必须经过的空间点。(3)参数设置模块。对机械手的相关参数进行赋值。(4)运动学逆解模块。该模块将迪卡尔空间内点的坐标变换为各个关节坐标系内的关节角度。(5)插值运算求解系数模块。该模块在每一段内按照其计算的结果,对3个关节进行插值运算,求解每个关节的三次多项式插值系数。(6)生成关节运动方程模块。该模块按照计算得出的三次多项式插值系数,对每个关节生成以时间t为自变量；(7)控制模块。控制每个关节的角度变化,使其跟踪模块生成的该关节的运动方程。(8)求解迪卡尔坐标下的末端位置。用实际采样得到的角度,进行运

41、动学正运算,以检验机械手末端的实际位置。3.2系统控制算法设计机械手控制算法的基本流程如图5所示。由轨迹插补模块对途径点分段,采用过四点的3次多项式插值运算,将计算结果输入运动学反解模块,计算出关节坐标下各关节的对应的角度,将各运动关节轨迹送入到关节控制器模块中进行关节运动控制,由编码器的测量值实时计算机械手末端的位置。轨迹插补参数设置运动学反解控制器笛卡尔坐标系下末端位置图5 机械手控制算法流程图前馈补偿极点配置自校正控制器设计：极点配置的主要思想是寻找一个控制律，使得被控系统闭环传递函数的极点位于希望的位置。其基本组成原理如图6所示。在气动位置伺服系统中,二阶和三阶电-气流量比例阀控摆缸气

42、动旋转位置系统的幅频特性在低频段是相近的，且系统模型阶数越低，控制器的设计实现就越容易6。3.3基于labview 的控制系统设计随着测控系统的不断发展，用户对于系统的可靠性、时间确定性等要求越来越高，由此出现了很多实时测控模式及软件，例如美国math works公司的rtw；德国d space公司的control desk；加拿大opal2公司rt2lab；boeing公司的easy2等。其中美国（ni）公司研制开发的labview rt系统由于其简洁的图形化开发环境以及高可靠性和时间确定性等优点得到了广泛的应用。控制器设定输入控制输入被控对象系统输出控制参数计算辨识机构辨识参数图6极点配置

43、自校正控制器结构图labview是一种程序开发环境，由美国国家仪器（ni）公司研制开发的，类似于c和basic开发环境，但是labview与其他计算机语言的显著区别是：其他计算机语言都是采用基于文本的语言产生代码，而labview使用的是图形化编辑语言g编写程序，产生的程序是框图的形式。与c和basic一样，labview也是通用的编程系统，有一个完成任何编程任务的庞大函数库。labview的函数库包括数据采集、gpib、串口控制、数据分析、数据显示及数据存储，等等。labview也有传统的程序调试工具，如设置断点、以动画方式显示数据及其子程序的结果、单步执行等等，便于程序的调试。3.3.1实

44、时控制系统介绍labview real time模块的开发、运行需要特定的硬件目标支持,以往的rt模块主要支持3类硬件方式:rt系列插入式板卡、rt系列px i、rt系列的field point模块。插入式板卡基于pc i总线方式,将嵌入式的处理器板卡和多功能数据采集卡合并,能提供的i/o通道较少,单通道pid循环速率在1khz左右, 性能一般；field point方式能提供很多的i/o接口，但是循环速率更低；px i控制器方式能够提供较多的i/o接口、具有较高的控制速率(20khz以上),但硬件成本较高。labview rt模块在8.0版本之后,支持将标准的desktop pc转变为rea

45、l2time(实时)目标机，配置通用的pci数据采集卡,实现高的循环控制速率(10khz以上)并提供了丰富的i/o接口，与px i系统相比具有较高的性价比优势。系统的控制程序是通过上位机的labview rt开发系统完成的,包括上位机的人机界面和下位机的实时控制程序。上、下位机工作方式,通过tcp/ ip网络实现通讯,上位机将实时控制程序下载到下位机rt引擎中进行运行和调试。在控制软件的开发中,上位机主要运行的是人机交互界面,接受操作人员的命令输入及显示数据等；下位机主要运行实时控制程序,接受上位机的命令信号,进行相应的数据采集及实时控制。它们之间的通信是靠网络共享变量机制来实现的。网络共享变

46、量是labview新推出的一种变量,它利用ni publish-subscribe pro tocol(ni2psp)通过网络来发送和接收数据。调用网络共享变量时,首先得在网络的sve(shared variable engine)上部署网络共享变量。当向这个共享变量中写入数据时,labview将这个新的值发送给网络上的sve,sve然后将这个值发布出去,使得网络上其它的节点可以得到这个更新的值,其数据传输过程如图7所示 。上位机（运行sve）sve下位机2下位机1ni-pspni-p2pni-p2p图7 共享变量读写过程示意图3.3.2机械手控制系统的硬件部分气动机械手各关节采用流量比例控制

47、,使用pci26229卡(多功能数据采集卡)输出控制信号；同时使用pci26602(8通道正交编码器计数器卡)检测编码器的角度信号和零位信号,其硬件组成如图8所示。本系统的设计,需要要解决的主要问题有2个,即matlab/ xpc与数据采集卡的接口问题和程序实时性的保证问题。关于硬件接口问题,xpc目标提供了各种i/o接口接入计算机的实现途径,支持多种类型的i/o设备板,包括isa、pci、pc104和compact pci硬件。但不支持的pcl2833板卡,根据matlab/xpc提供的接口规范,自行开发了驱动程序,其过程这里不再详述。xpc 的功能与r tw近似,即可用simulink/s

48、tateflow设计出来的控制器直接去控制对象实物。xpc采用上下位机工作方式,通过tcp/ip实现同xpc采用上下位机工作方式,通过 tcp/ip实现通信。在上位机(宿主pc机)上应用matlab生成控制代码然后下载到下位机 (目标工控机)。工作时下位机进行层控制,上位机则显示数据,达到实时控制的效果7。上位机（pc机）下位机（工控机）tcp/ippc16229pc16602pc16229pc16602pc16229pc16602流量比例阀旋转编码器流量比例阀旋转编码器流量比例阀旋转编码器腰部关节大臂关节小臂关节图8 机械手控制系统硬件流程图3.3.3机械手控制系统的软件部分在软件上,上位宿

49、主机安装matlab6.5以及simulink、real 2 time workshop和xpc target工具箱,利用visualc+6.0作为目标语言编译器。下位目标机未装载任何操作系统和软件,仅对bios做了相关更改以节省cpu资源。由于关节在运动过程中负载变化较大,故采用单神经元自适应pid控制,如图9所示。该算法结构相对简单、计算量小、权值学习时间短,明显优于常规pid算法,有较强的自适应性和鲁棒性8。状 态 变 换 器kuf()受控对象学习算法图9 单神经元自适应pid控制器原理示意图3.4实验分析以腰部关节为例。腰部关节的编码器为1000码/周,通过1:4的同步带轮与腰部的摆动

50、缸相连,所以腰部关节的分辨率为360/4000=0.09。系统采用单神经元自适应pid方法,由于腰部关节在机械手运动时转动惯量变化较大,使用同一控制参数分别在转动惯量较大(大臂伸出)和较小(大臂收回)时对其进行了两组跟踪方波信号试验来检验参数变化对系统动态特性的影响。其结果如图10a、10b所示,超调量及响应时间满足要求,系统具有一定的鲁棒性9。(a) 大转动惯量下（b） 小转动惯量下图10 腰部关节方波信号响应及误差曲线对机械手的位置在关节空间内进行轨迹跟踪,控制模块的输入信号为轨迹规划模块组的输出信号,采用pid控制算法。图11a,x1、y1、z1分别代表迪卡尔空间内，目标规划路径的x、y

51、、z三个坐标轴方向的分量随时间变化的的曲线；x2、y2、z2分别代表机械手实际位置在迪卡尔空间内三个坐标轴方向的分量随时间变化的曲线。在所有参数均相同的情况下，对气动机械手进行了16组实验，仅对机械手末端在最后时刻的位置进行分析，如图11b,横轴为实验的次数，纵轴分别为x、y、z三个方向上的数据。其中直线段部分为机械手末端的目标位置，标记点为通过旋转编码器测量并计算得到的实际位置。x轴方向上的误差小于6mm，y轴方向的误差小于10mm，z轴方向的误差小于10mm。即机械手的轨迹跟踪是可重复的。三自由度气动机械手控制系统的设计是一项比较复杂的工作。其中包含轨迹规划,运动学反解，关节控制等多个模块

52、，需要比较许多不同的算法并不断地调整相关控制参数。以xpc为架构的快速控制原型构造简单、调整方便，非常适合进行一些控制算法的实验研究，为系统的工业化应用奠定了一个良好的实验平台10。（a） 目标曲线与跟踪曲线比较（b） 末端位置误差曲线图11 机械手参数曲线4结论三自由度气动机械手控制系统的设计是一项比较复杂的工作。其中包含轨迹规划,运动学反解，关节控制等多个模块，需要比较许多不同的算法并不断地调整相关控制参数。本设计通过对自由度以及气动方面的研究，成功的完成对三自由度气动机械手的结构设计，构造了基于labview rt模块的实时控制系统，通过上、下位机的方式实现了实时控制，并具有灵活的扩展性

53、。采用前馈补偿极点配置自校正控制策略，设计了气动机械手关节的控制器。由于该控制器具有实时估计系统参数的能力，所以明显改善了气动机械手控制系统的动态性能，减少了系统的未建模因素对被控系统控制能力的影响。参考文献：1蔡自兴，机器人学m.北京：清华大学出版社，2000.3240.2周远清，等.智能机器人系统m.北京:清华大学出版社,1989.1619.3胡云龙，六自由度机器人轨迹规划的理论研究及软件开发d.哈尔滨工业大学,1997.3376.4王兴贵，多机器人协调动力学,轨迹规划和控制研究d.哈尔滨:哈尔滨工业大学,1994.6971.5凌万胜，气动六自由度机械手关节控制的研究d.哈尔滨：哈尔滨工业

54、大学,2002.3842.6赵大庆，液压泵污染磨损与控制m.北京:煤炭工业出版社,1993.2226.7李枚毅，蔡自兴，结合示例学习的移动机器人免疫进化规划研究j,计算机工程与应用 2005.12.1821.8胡邦喜，液压润滑系统的清洁度控制(第1版)m.北京:冶金工业出版社,2003.1625.9张建峡，杨勇,等.单神经元自适应pid控制交流调速系统j.电机与控制学报,2007.3033.10张乐天，等.基于xpc实时控制的中空液压马达伺服系统的研究j.液压与气动,2005.3759. 膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈

55、蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅

56、莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂

57、芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀葿螀莈膃袈蝿肈蒈螃螈膀芁虿螇节蒆薅螆羂艿蒁螅肄蒅螀袄膆芇蚆袄艿蒃薂袃羈芆薈袂膁薁蒄袁芃莄螃袀羃蕿虿衿肅莂薅袈膇薈蒁羈芀莁蝿羇罿膃蚅羆膂荿蚁羅芄节薇羄羄蒇蒃羃肆芀螂羂膈蒅蚈肂芀芈薄肁羀蒄蒀肀肂芇螈聿芅蒂螄肈莇莅蚀肇肇薀薆蚄腿莃蒂蚃芁蕿螁蚂羁莁蚇螁肃薇薃螀膆莀