【摘要】 一种差速驱动式移动机器人的操纵杆直接控制方法，由以下具体步骤实现：(1)建立用操纵杆控制移动机器人系统；(2)建立操纵杆输出控制信号与差速驱动式移动机器人驱动器转速的映射关系；此步骤由数字信号处理模块相应的控制软件上完成；(3)将(ωL，ωR)同时输给差速驱动式移动机器人的控制器，作为两侧车轮的驱动器的期望转速，从而控制差速驱动式移动机器人移动。其技术方案克服了这些缺陷，将操纵杆的控制信号直接映射为控制差速驱动式机器人两侧驱动器的转速，从而让操作者可以直接控制底层电机转速，实现转弯半径从0到∞的平滑过渡，并且操纵杆手柄的运动趋势与移动机器人的移动趋势仍保持一致。 【专利类型】发明授权 【申请人】北京航空航天大学 【申请人类型】学校 【申请人地址】100191 北京市海淀区学院路37号北京航空航天大学宇航学院 【申请人地区】中国 【申请人城市】北京市 【申请人区县】海淀区 【申请号】CN200810119636.2 【申请日】2008-09-04 【申请年份】2008 【公开公告号】CN101422903B 【公开公告日】2010-06-02 【公开公告年份】2010 【授权公告号】CN101422903B 【授权公告日】2010-06-02 【授权公告年份】2010.0 【IPC分类号】B25J5/00; B25J13/00; B62D57/02 【发明人】孟偲; 王田苗; 俞炼 【主权项内容】1.一种差速驱动式机器人移动的操纵杆直接控制方法，其特征在于：它是由以下具体步骤实现： (1)建立用操纵杆控制移动机器人系统；具体为：选择预定的操纵杆，该操纵杆在初始位置的电位计1转轴、电位计2转轴、操纵杆手柄轴线三者相互正交，电位计1和电位计2的值代表操纵杆手柄的位置；用模数转换器A/D将操纵杆手柄输出信号量化并与数字信号处理模块相连接，选择差速驱动式移动机器人作为控制对象，并与数字信号处理模块进行通讯； (2)建立操纵杆输出控制信号与差速驱动式移动机器人驱动器转速的映射关系；此步骤由数字信号处理模块相应的控制软件上完成，具体为： i)操控手柄使电位计1和电位计2转动，拨动滑钮改变电位计3位置，从而改变电位计1、电位计2和电位计3的输出电压；电位计1和电位计2的电压经模数转换器A/D转换后的量化值分别假设为u和v，u和v具有相同的转换值范围，设为[0，MAX]，即u，v∈[0，MAX]；电位计3的电压经模数转换器A/D转换后的量化值设为K，电位计3的电压量化值范围与电位计1和电位计2电压量化值范围不同，设其范围为[0，Kmax]，即K∈[0，Kmax]； ii)手柄在初始位置时电位计量化值设为u0、v0， 其中ROUND(x)表示对x按四舍五入法则取最接近整数；操纵杆输出变化范围及初始位置均通过标定获得；以变量u和v为轴建立坐标系，则以坐标点(0，0)和坐标点(MAX，MAX)确定的矩形区域为操纵杆的手柄输出范围，其中左上角为原点(0，0)，初始手柄的位置在(u0，v0)；手柄位置变动时，相当于点在该平面内移动，其坐标值(u，v)即为手柄的量化输出值；u轴与v轴确定的平面与手柄初始位置轴线垂直，并且u轴和v轴分别与初始位置的电位计1和电位计2的轴线平行；iii)在uv轴决定的坐标平面上，设O点坐标为(u0，v0)，以O为原点，建立O-XY坐标系，其中Y轴与v轴平行而方向相反，指向朝向手柄正前方，X轴与u轴平行且方向相同，指向手柄右方；其相当于将uv坐标系原点先平移至O点，再将v轴方向翻转180度；则手柄的任意位置P点在O-XY坐标系中的坐标(x，y)与在uv坐标系中的坐标(u，v)具有如下关系： (式1) iv)将O-XY坐标系绕O点逆时针转动45度获得新坐标系O-X′Y′，则P点在O-X′Y′坐标系中的坐标(x′，y′)与在O-XY坐标系中的坐标(x，y)的转换关系为： (式2) v)将新的X′轴，即原来的y＝x直线，映射为移动机器人左驱动轮的角速度ωL，将Y′轴，即原来的y＝-x直线，映射为移动机器人右驱动轮的角速度ωR，其映射关系为： (式3) 其中：Kω为角速度映射系数，为无量纲单位；取值范围[0，Kmax]； Kω由人工设定，或设为电位计3的输出值； ω0为基准映射转速度，单位为弧度/秒(rad/s)； ω0由移动机器人单侧车轮最大期望转速ωmax、Kmax和操纵杆参数按下式确定： (式4) 由(式1)～(式3)，得操纵杆手柄输出与移动机器人转速之间的关系为： (式5) (3)将(ωL，ωR)同时输给差速驱动式移动机器人的控制器，作为两侧车轮的驱动器的期望转速，从而控制差速驱动式移动机器人移动。 【当前权利人】北京航空航天大学 【当前专利权人地址】北京市海淀区学院路37号北京航空航天大学宇航学院 【统一社会信用代码】12100000400011227Y 【引证次数】4.0 【他引次数】4.0 【家族引证次数】4.0 【家族被引证次数】8
