[发明专利]一种空间万向旋转磁场人机交互控制方法

摘要

本发明属于自动化工程技术领域，公开了一种空间万向旋转磁场人机交互控制方法，分别向三轴正交嵌套的亥姆霍兹线圈装置施加以磁场轴线在经纬坐标系内的侧摆与俯仰角为输入变量的相关幅值和相位的同频率正弦信号电流形式的空间万向旋转磁场叠加公式，并通过两个操纵杆分别将侧摆与俯仰角分离控制，在三轴相互正交嵌套的亥姆霍兹线圈装置包围的均匀区域内叠加形成轴线可分别沿侧摆与俯仰角方向单独扫描的旋转磁场，参照胶囊机器人前端摄像头无线传输图像分别调整磁场轴线侧摆与俯仰方位角，实现空间万向磁场旋转轴线方位的人机交互控制。本发明实现机器人侧摆与俯仰两个方向的独立扫描，人机交互操作简单、快捷，提高机器人在弯曲环境内姿态调整与滚动的可操作性。

主权项

一种空间万向旋转磁场人机交互控制方法，其特征在于：(1)采用磁场轴线在经纬坐标系的侧摆、俯仰角度为输入变量的空间万向旋转磁场电流形式叠加公式，姿态角度控制变量由磁场轴线与空间笛卡尔坐标系三个方向角减少为经纬坐标系内侧摆与俯仰两个姿态角，通过侧摆操纵杆与俯仰操纵杆分别将侧摆与俯仰角度分离控制，并分别输出侧摆角与俯仰角的模拟电压角度信号，经过信号处理器中的A/D转换器后转换为侧摆与俯仰角数字量信号并输入到信号处理器中的电流参数计算模块，经过分析计算后，外磁场驱动器接受信号处理器发送的数据，产生相应的正弦谐波电流去驱动三轴正交嵌套亥姆霍兹线圈磁场叠加装置，在其中心区域叠加形成轴线与侧摆操纵杆输入的侧摆角和俯仰操纵杆输入的俯仰角所确定方位一致的旋转磁场；(2)分别调节侧摆操纵杆与俯仰操纵杆，改变外加旋转磁场轴线在经纬坐标系的侧摆与俯仰角，根据磁力矩随动效应，主被动双半球形胶囊机器人的轴线与旋转磁场轴线重合，借助人机交互界面h显示机器人的摄像头与图像传输装置所传输的实时图像，实现与视觉相融合的人机交互控制过程如下：将侧摆操纵杆固定，单独调整俯仰操纵杆控制俯仰角变化，或将俯仰操纵杆固定，单独调整侧摆操纵杆控制侧摆角变化，分别实现磁场轴线沿着侧摆与俯仰两个方向的独立扫描，最后，再通过两个操纵杆分别微调磁场轴线侧摆与俯仰角，使机器人轴线姿态对准细长管道待测区域，或者与各段细长管道弯曲方向基本一致。