专利名称：一种机械臂仿生控制方法及控制系统的制作方法
技术领域：
本发明涉及工程机械操控技术领域，特别涉及一种机械臂仿生控制方法及控制系统。
背景技术：
许多大型工程机械，特别是具有多节臂架或折弯结构机械臂的工程机械，例如混凝土泵车、起重机、挖掘机等，需要对机械臂进行精确控制，满足作业要求。目前，传统机械臂的控制方式采用液压手动和无线遥控的控制方式，由人工控制机械臂的各个臂关节，使受控对象“一步一动”运动到目标位置。参见图1，示出现有机械臂控制系统示意图，包括主控制器11，与主控制器11无线连接，发送控制信息到主控制器11的遥控器12 ；与主控制器11连接，用于显示机械臂15动作过程的显示器13 ；设置在机械臂15各关节处，推动机械臂15动作的臂架多路阀17和液压油缸16 ；设置在机械臂15上，用于获取机械臂运动状态信息的各类传感器14。工作时，遥控器12发送控制信息到主控制器11，主控制器11将该控制信息经相应的计算后，发送控制指令到臂架多路阀17，臂架多路阀17动作，带动液压油缸16同步动作，推动机械臂15相应的动作；各类传感器14将机械臂15当前状态信息发送到主控制器 11，主控制器11依据该当前状态信息判断机械臂的当前位置。上述机械臂控制系统虽然可使机械臂15到达指定位置，但需要操控人员“一步一动”地控制机械臂的各节臂架依次动作，控制过程中机械臂动作不连贯，运动过程不平稳， 机械臂远端动作变化大，准确性较低。并且该控制过程耗时长，耗能大，控制效率较低。
发明内容
本发明的目的是一种机械臂仿生控制方法，该方法有效提高机械臂的控制精度和控制效率。本发明一种机械臂仿生控制方法，模拟人手臂各关节位置制作控制设备，控制设备的各关节对应机械臂各节臂架，该方法包括以下步骤所述控制设备模拟机械臂各节臂架的动作过程，依据动作过程生成各关节角度变化值；根据各关节角度变化值，计算机械臂各节臂架需移动角度值，控制机械臂各节臂架相应转动。优选的，控制机械臂各节臂架相应动作之前，还包括判断机械臂各节臂架需移动角度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角度值，不控制机械臂动作，直至控制设备的下一个控制动作发出。优选的，还包括依据动作过程生成各关节角速度变化值；根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值，控制机械臂各节臂架相应转动角速度。优选的，控制机械臂各节臂架相应动作之前，还包括判断机械臂各节臂架需移动角速度值是否在许可范围之内，如否，以预定的角速度值动作。优选的，所述控制设备设有使能按钮，该方法还包括触动使能按钮，发送预置使能控制信息；依据使能控制信息控制机械臂动作。优选的，所述控制设备设有旋转按钮，该方法还包括触动旋转按钮，发送旋转控制信息；依据旋转控制信息控制机械臂执行相应的旋转动作。本发明还提供一种机械臂仿生控制系统，该系统有效提高机械臂的控制精度和控制效率。本发明一种机械臂仿生控制系统，包括模拟人手臂各关节位置、制作的控制设备， 控制设备的各关节对应机械臂各节臂架，控制设备上的各关节设有倾角传感器；还包括主控制器，主控制器包括角度计算模块和第一控制模块所述控制设备，用于模拟机械臂各节臂架的动作过程；倾角传感器，用于依据动作过程生成各关节角度变化值，发送到角度计算模块；角度计算模块，用于根据各关节角度变化值，计算机械臂各节臂架需移动角度值；第一控制模块，用于控制机械臂各节臂架相应转动。优选的，主控制器还包括第一安全模块，用于判断机械臂各节臂架需移动角度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角度值，不控制机械臂动作，直至控制设备的下一个控制动作发出。优选的，所述控制设备的各关节上还设有角速度传感器，所述主控制器还包括角速度计算模块和第二控制模块角速度传感器，用于依据动作过程生成各关节角速度变化值，发送到角速度计算模块；角速度计算模块，用于根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值；第二控制模块，用于控制机械臂各节臂架相应转动角速度。优选的，主控制器还包括第二安全模块，用于判断机械臂各节臂架需移动角速度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角速度值，不控制机械臂动作， 直至控制设备的下一个控制动作发出。优选的，所述控制设备上设有使能按钮，主控制器还包括使能模块；使能按钮，用于被触动时发送预置使能控制信息到使能模块；使能模块，用于依据使能控制信息控制机械臂实施预设动作。优选的，所述控制设备上设有旋转按钮，主控制器还包括旋转模块；旋转按钮，用于被触动时发送旋转控制信息到旋转模块；旋转模块，用于依据旋转控制信息控制机械臂执行相应的旋转动作。本发明还提供一种机械臂仿生控制方法，该方法有效提高机械臂的控制精度和控制效率。本发明一种机械臂仿生控制方法，模拟人手臂各关节位置制作控制设备，控制设备的各关节对应机械臂各节臂架，该方法包括以下步骤所述控制设备模拟机械臂各节臂架动作，所述控制设备上传感器生成各关节当前角度值；根据各关节当前角度值，控制机械臂各节臂架转动到相应角度。优选的，还包括依据动作过程生成各关节角速度变化值；根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值，控制机械臂各节臂架相应转动角速度。本发明还提供一种机械臂仿生控制系统，该系统有效提高机械臂的控制精度和控制效率。本发明一种机械臂仿生控制系统，模拟人手臂各关节位置制作的控制设备，控制设备的各关节对应机械臂各节臂架，控制设备上的各关节设有倾角传感器所述控制设备，用于模拟机械臂各节臂架动作；所述倾角传感器，用于生成各关节当前角度值，发送到主控制器；所述主控制器，用于根据各关节当前角度值，控制机械臂各节臂架转动到相应角度。优选的，所述控制设备的各关节上还设有角速度传感器，所述主控制器还包括角速度计算模块和第二控制模块角速度传感器，用于依据动作过程生成各关节角速度变化值，发送到角速度计算模块；角速度计算模块，用于根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值；第二控制模块，用于控制机械臂各节臂架相应转动角速度。与现有技术相比，本发明具有以下优点本发明操控者通过仿生动作操作机械臂，使机械臂的各节臂架同时动作，机械臂动作连贯，运动过程平稳，机械臂远端动作变化较小，有效提高机械臂到达指定位置的准确性。且该控制过程操控动作简单易学，耗时短，耗能小，控制效率较高。
图1为现有机械臂控制系统示意图2为机械臂结构示意图3为本发明控制设备结构示意图4为本发明机械臂仿生控制方法第--实施例流程图
图5为本发明机械臂仿生控制方法第二二实施例流程图
图6为本发明机械臂仿生控制方法第三Ξ实施例流程图
图7为本发明机械臂仿生控制系统示意图8为本发明机械臂仿生另一控制方法流程图9为本发明机械臂仿生另一控制系统示意图。
具体实施例方式为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式
对本发明作进一步详细的说明。人的手指到手臂肩部的关节多达18个，在一条直线上的关节达到6个，能够灵活旋转的关节有3个，并且手部大拇指的第三个关节由于特殊的肌肉机理，也能够提供一定的旋转活动，因此通过手部的关节的灵活运用，能够有效完成各类机械臂的仿生动作。本发明模拟人手臂各关节位置，制作可穿戴在手臂上的控制设备，控制设备的各关节对应机械臂各节臂架。控制设备通过仿生动作模拟机械臂的动作，控制机械臂相应动作，同步控制多节臂架到达指定角度或位置，完成相应的动作，使得原本复杂的操作动作变得简单，原本一步一步完成的串行动作，可以很自然的通过仿生控制并行地进行操作，大大优化操作流程， 提高工作效率。举例说明本发明控制设备。参见图2和图3，分别示出机械臂结构示意图和控制设备结构示意图，机械臂包括钻台，依次活动连接的臂架Bi、臂架B2、臂架B3和臂架B4，各节臂架上都设有推动臂架转动的液压油缸。控制设备包括活动连接的关节G1、关节G2、关节G3和关节G4，各关节上均设有传感器，用来感应各关节的转动角度和转动速度。关节G1、关节G2、关节G 3和关节G4依次与臂架Bi、臂架B2、臂架B3和臂架B4相对应，各关节的动作信息通过传感器发送到控制器， 由控制器控制相应的臂架跟随动作。本发明控制设备不仅适用于4节臂架的机械臂，也适用4节臂架以上和4节臂架以下的各种机械臂。本发明机械臂仿生控制方法第一实施例。参见图4，具体步骤如下。步骤S401、控制设备模拟机械臂各节臂架的动作过程，所述控制设备上传感器依据动作过程生成各关节角度变化值，发送到主控制器。本发明控制设备可以设计成能够穿套在拇指或食指上的形状，或通过辅助设备绑接在手部关节上的形状，控制设备的各关节与人手臂各关节相吻合。操控时，操控者通过手臂操控控制设备，因控制设备的各关节的位置和构造与人手臂相适应，控制设备的各关节可灵活随操控者手臂同步动作。控制设备的各关节设有传感器，传感器检测控制设备各关节角度变化信息，并将各关节角度变化信息通过无线或有线方式发送到主控制器。步骤S402、所述主控制器根据各关节角度变化值，计算机械臂各节臂架需移动角度值，控制机械臂各节臂架相应转动。机械臂的各节臂架上设有传感器，传感器将机械臂当前各节臂架角度信息发送到主控制器，主控制器获取到各关节角度变化信息，计算机械臂各节臂架需移动角度值，计算如下θ ‘ = a+b θ式 1θ为某关节角度变化值，θ ‘为该关节对应的机械臂一节臂架需移动角度值，a 为一待定系数，可根据不同模式设置(手动或自动)；b为变化系数。通过该节臂架的待定系数a配置两个坐标系中角度转换的差值，进行相应角度校准，通过变化系数b配置两个坐标系中角度变化的比率。通过式1，主控制器依次计算机械臂各节臂架需移动角度值，控制机械臂的各液压油缸相应的工作，使各节臂架同时动作，让机械臂到达制定位置。本发明操控者通过仿生动作操作机械臂，使机械臂的各节臂架同时动作，机械臂动作连贯，运动过程平稳，机械臂远端动作变化较小，有效提高机械臂到达指定位置的准确性。且该控制过程操控动作简单易学，耗时短，耗能小，控制效率较高。本发明机械臂仿生控制方法第二实施例。该实施例与图4所示实施例主要区别在于增加机械臂角速度控制方案。参见图5，具体步骤如下。步骤S501、控制设备模拟机械臂各节臂架的动作过程，所述控制设备上传感器依据动作过程生成各关节角度变化值和各关节角速度变化值，发送到主控制器。控制设备的各关节不仅设置用于检测角度变化值的倾角传感器，还设置用于检测角速度变化的角速度传感器。当然，本发明也可通过对倾角传感器信号差分序列计算获得角速度变化值。步骤S502、所述主控制器根据各关节角度变化值，计算机械臂各节臂架需移动角度值，根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值，并依据各节臂架需移动角度值和角速度值，控制机械臂各节臂架相应动作。
机械臂各节臂架不仅设置用于检测角度变化值的倾角传感器，还设置用于检测角速度变化的角速度传感器。倾角传感器和角速度传感器将检测值发送到主控制器。主控制器计算如下θ ‘ = a+b θ式 1ω ‘ = c+ ω式 2式1中，θ为某关节角度变化值，Θ'为该关节对应的机械臂一节臂架需移动角度值，a为一待定系数，b为变化系数。式2中，ω为某关节角速度变化值，ω'为该关节对应的机械臂一节臂架需移动角速度值，c为一待定系数，可根据不同模式设置(手动或自动)，d为变化系数。该实施例所示的方案中，依据仿生控制同时控制机械臂各节臂架的移动角度和角速度，可以更方便操控者控制机械臂的移动速度，进一步提高控制效率。本发明机械臂仿生控制方法第三实施例。该实施例与图5所示实施例主要区别在于增加对不安全控制指令的滤除方案。参见图6，具体步骤如下。步骤S601、控制设备模拟机械臂各节臂架的动作过程，所述控制设备上传感器依据动作过程生成各关节角度变化值和各关节角速度变化值，发送到主控制器。步骤S602、所述主控制器根据各关节角度变化值，计算机械臂各节臂架需移动角度值。步骤S603、所述主控制器判断机械臂各节臂架需移动角度是否在许可范围之内， 如否，滤除机械臂各节臂架需移动角度值，滤除后，不控制机械臂动作，直至控制设备的下一个控制动作发出；如是，转到步骤S606。步骤S604、根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值。步骤S605、所述主控制器判断机械臂各节臂架需移动角速度是否在许可范围之内，如否，滤除机械臂各节臂架需移动角速度值，以预定的角速度值动作；如是，转到步骤 S606.步骤S606、依据各节臂架需移动角度值和角速度值，控制机械臂各节臂架相应动作。本发明通过对各节臂架需移动角度值和角速度值进行合理的筛选，滤除可能导致机械臂不安全的控制指令，有效提高操控过程中机械臂动作的安全性。为提高控制设备的使能功能，本发明在控制设备上设有使能按钮，完成暂停等使能功能的操作，具体实现步骤为触动使能按钮，所述控制设备发送预置使能控制信息到主控制器；所述主控制器依据使能控制信息控制机械臂动作。为更好的完成机械臂的旋转功能，如转台的旋转，本发明在控制设备上设有旋转按钮，具体实现步骤为触动旋转按钮，所述控制设备发送旋转控制信息到主控制器；所述主控制器依据旋转控制信息控制机械臂执行相应的旋转动作。依据前述机械臂仿生控制方法，本发明还提供一种机械臂仿生控制系统。见图7， 该系统包括机械臂70，模拟人手臂各关节位置、制作可穿戴在手臂上的控制设备71，控制设备71的各关节对应机械臂各节臂架，控制设备71上的各关节设有倾角传感器711和角速度传感器712，以及使能按钮713和旋转按钮714 ；还包括主控制器72，主控制器72包括角度计算模块721、第一控制模块722、第一安全模块723、角速度计算模块724、第二控制模块725、第二安全模块726、使能模块727和旋转模块728。所述控制设备71模拟机械臂70各节臂架的预动作过程；倾角传感器711依据动作过程生成各关节角度变化值，发送到角度计算模块721， 角度计算模块721根据各关节角度变化值，计算机械臂各节臂架需移动角度值，发送到第一安全模块723，第一安全模块723判断机械臂各节臂架需移动角度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角度值，滤除后，不控制机械臂动作，直至控制设备的下一个控制动作发出；如是，启动第一控制模块722，第一控制模块722控制机械臂70各节臂架相应转动。角速度传感器712依据动作过程生成各关节角速度变化值，发送到角速度计算模块724，角速度计算模块7M根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值，发送到第二安全模块726，第二安全模块7 判断机械臂各节臂架需移动角速度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角速度值，以预定的角速度值动作；如是，启动第二控制模块725，第二控制模块725控制机械臂70各节臂架相应转动角速度。使能按钮713被触动时发送预置使能控制信息到使能模块727，使能模块727依据使能控制信息控制机械臂相应动作。旋转按钮714被触动时发送旋转控制信息到旋转模块728，旋转模块7 依据旋转控制信息控制机械臂执行相应的旋转动作。本发明还可根据控制设备动作后各关节当前角度值，控制机械臂各节臂架转动到相应角度，使机械臂各节臂架的角度与控制设备各关节一致。该控制方式与图4所示实施例都是基于控制设备，属于同一发明构思。参见图8，具体步骤如下。步骤S801、控制设备模拟机械臂各节臂架动作，控制设备上传感器生成各关节当前角度值，发送到主控制器。步骤S802、主控制器根据各关节当前角度值，控制机械臂各节臂架转动到相应角度。该方法控制设备还可依据动作过程生成各关节角速度变化值；主控制器根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值，控制机械臂各节臂架相应转动角速度。本发明操控者通过仿生动作操作机械臂，使机械臂各节臂架的角度与控制设备各关节相同，这样机械臂动作连贯，运动过程平稳，机械臂远端动作变化较小，有效提高机械臂到达指定位置的准确性。且该控制过程操控动作简单易学，耗时短，耗能小，控制效率较
尚ο依据图8所示机械臂仿生控制方法，本发明还提供一种机械臂仿生控制系统。见图9，机械臂70，模拟人手臂各关节位置、制作可穿戴在手臂上的控制设备71，控制设备71 的各关节对应机械臂各节臂架，控制设备71上的各关节设有倾角传感器91 ；还包括主控制
92 ο
控制设备71模拟机械臂各节臂架动作，倾角传感器91生成各关节当前角度值，发送到主控制器92，主控制器92根据各关节当前角度值，控制机械臂各节臂架转动到相应角度。控制设备71的各关节上还可设有角速度传感器，主控制器92还包括角速度计算模块和第二控制模块角速度传感器，用于依据动作过程生成各关节角速度变化值，发送到角速度计算模块；角速度计算模块，用于根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值；第二控制模块，用于控制机械臂各节臂架相应转动角速度。以上所述仅为本发明的优选实施方式，并不构成对本发明保护范围的限定。任何在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的权利要求保护范围之内。
权利要求
1.一种机械臂仿生控制方法，其特征在于，模拟人手臂各关节位置制作控制设备，控制设备的各关节对应机械臂各节臂架，该方法包括以下步骤所述控制设备模拟机械臂各节臂架的动作过程，依据动作过程生成各关节角度变化值；根据各关节角度变化值，计算机械臂各节臂架需移动角度值，控制机械臂各节臂架相应转动。
2.如权利要求1所述的方法，其特征在于，控制机械臂各节臂架相应动作之前，还包括判断机械臂各节臂架需移动角度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角度值，不控制机械臂动作，直至控制设备的下一个控制动作发出。
3.如权利要求1所述的方法，其特征在于，还包括 依据动作过程生成各关节角速度变化值；根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值，控制机械臂各节臂架相应转动角速度。
4.如权利要求3所述的方法，其特征在于，控制机械臂各节臂架相应动作之前，还包括判断机械臂各节臂架需移动角速度值是否在许可范围之内，如否，以预定的角速度值动作。
5.如权利要求1-4任一项所述的方法，其特征在于，所述控制设备设有使能按钮，该方法还包括触动使能按钮，发送预置使能控制信息； 依据使能控制信息控制机械臂动作。
6.如权利要求1-4任一项所述的方法，其特征在于，所述控制设备设有旋转按钮，该方法还包括触动旋转按钮，发送旋转控制信息；依据旋转控制信息控制机械臂执行相应的旋转动作。
7.一种机械臂仿生控制系统，其特征在于，包括模拟人手臂各关节位置、制作的控制设备，控制设备的各关节对应机械臂各节臂架，控制设备上的各关节设有倾角传感器；还包括主控制器，主控制器包括角度计算模块和第一控制模块所述控制设备，用于模拟机械臂各节臂架的动作过程； 倾角传感器，用于依据动作过程生成各关节角度变化值，发送到角度计算模块； 角度计算模块，用于根据各关节角度变化值，计算机械臂各节臂架需移动角度值； 第一控制模块，用于控制机械臂各节臂架相应转动。
8.如权利要求7所述的系统，其特征在于，主控制器还包括第一安全模块，用于判断机械臂各节臂架需移动角度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角度值，不控制机械臂动作，直至控制设备的下一个控制动作发出。
9.如权利要求7所述的系统，其特征在于，所述控制设备的各关节上还设有角速度传感器，所述主控制器还包括角速度计算模块和第二控制模块角速度传感器，用于依据动作过程生成各关节角速度变化值，发送到角速度计算模块；角速度计算模块，用于根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值；第二控制模块，用于控制机械臂各节臂架相应转动角速度。
10.如权利要求7所述的系统，其特征在于，主控制器还包括第二安全模块，用于判断机械臂各节臂架需移动角速度值是否在许可范围之内，如否，滤除机械臂各节臂架需移动角速度值，不控制机械臂动作，直至控制设备的下一个控制动作发出。
11.如权利要求7-10任一项所述的系统，其特征在于，所述控制设备上设有使能按钮， 主控制器还包括使能模块；使能按钮，用于被触动时发送预置使能控制信息到使能模块； 使能模块，用于依据使能控制信息控制机械臂实施预设动作。
12.如权利要求7-10任一项所述的系统，其特征在于，所述控制设备上设有旋转按钮， 主控制器还包括旋转模块；旋转按钮，用于被触动时发送旋转控制信息到旋转模块； 旋转模块，用于依据旋转控制信息控制机械臂执行相应的旋转动作。
13.一种机械臂仿生控制方法，其特征在于，模拟人手臂各关节位置制作控制设备，控制设备的各关节对应机械臂各节臂架，该方法包括以下步骤所述控制设备模拟机械臂各节臂架动作，所述控制设备上传感器生成各关节当前角度值；根据各关节当前角度值，控制机械臂各节臂架转动到相应角度。
14.如权利要求13所述的方法，其特征在于，还包括 依据动作过程生成各关节角速度变化值；根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值，控制机械臂各节臂架相应转动角速度。
15.一种机械臂仿生控制系统，其特征在于，模拟人手臂各关节位置制作的控制设备， 控制设备的各关节对应机械臂各节臂架，控制设备上的各关节设有倾角传感器所述控制设备，用于模拟机械臂各节臂架动作；所述倾角传感器，用于生成各关节当前角度值，发送到主控制器；所述主控制器，用于根据各关节当前角度值，控制机械臂各节臂架转动到相应角度。
16.如权利要求15所述的系统，其特征在于，所述控制设备的各关节上还设有角速度传感器，所述主控制器还包括角速度计算模块和第二控制模块角速度传感器，用于依据动作过程生成各关节角速度变化值，发送到角速度计算模块；角速度计算模块，用于根据各关节角速度变化值，计算机械臂各节臂架需移动角速度值；第二控制模块，用于控制机械臂各节臂架相应转动角速度。
全文摘要
本发明涉及一种机械臂仿生控制方法，模拟人手臂各关节位置制作控制设备，控制设备的各关节对应机械臂各节臂架，该方法包括以下步骤所述控制设备模拟机械臂各节臂架的动作过程，依据动作过程生成各关节角度变化值；根据各关节角度变化值，计算机械臂各节臂架需移动角度值，控制机械臂各节臂架相应转动。本发明还可通过控制设备模拟机械臂各节臂架动作，生成各关节当前角度值；根据各关节当前角度值，控制机械臂各节臂架转动到相应角度。本发明操控者通过仿生动作操作机械臂，使机械臂的各节臂架同时动作，机械臂动作连贯，运动过程平稳，机械臂远端动作变化较小，有效提高机械臂到达指定位置的准确性。
文档编号B25J9/06GK102310407SQ20111010275
公开日2012年1月11日 申请日期2011年4月22日 优先权日2011年4月22日
发明者周翔, 熊俊, 赵聿晴 申请人:三一重工股份有限公司