基于手机蓝牙技术的水下机器人控制系统的制作方法
【专利摘要】本实用新型公开一种基于手机蓝牙技术的水下机器人控制系统。该系统包括设于水下机器人载体内的处理系统、封装在浮标内的蓝牙装置、手机上的水下机器人控制端；其中水下机器人控制端通过蓝牙装置与水下机器人通讯，浮标与水下机器人通过零浮力缆连接进行数据传输，处理系统主控板通过深度传感器获取到的水下机器人实际深度以及姿态控制板获取到的实际姿态来控制螺旋桨的转速及转向，最终实现水下悬停、定深等功能。本系统能够很好地克服现有的水下机器人在自治模式下实时性的不足和有缆模式中灵活性上的限制、满足系统的实时通讯需要，并为便携地获取水下机器人信息、保证水下机器人灵活运动提供了很好的硬件支持。
【专利说明】基于手机蓝牙技术的水下机器人控制系统
【技术领域】
[0001] 本实用新型涉及水下机器人领域，具体来说是一种基于手机蓝牙技术的水下机器 人控制系统。
【背景技术】
[0002] 目前，水下机器人大多采用自治或者有缆控制模式。自治模式，多用在无缆机器 人上，机器人按照事先设定或者根据不定时接收到的上位机指令进行水下作业，这样就不 能实时地获取水下信息和控制机器人；而有缆模式，就是机器人通过与水面母船相连的脐 带缆获得动力，并与母船上的上位机进行数据传输和人机交互，它可以实现对机器人的实 时控制，但其活动受到脐带缆的制约，特别是复杂水下环境下容易造成缠绕事故，灵活性不 够。
[0003] Android是一种以Linux内核为基础的开源操作系统，主要用于智能手机、平板电 脑等移动设备。Android开发，以JAVA为主要编程语言，API接口丰富，开发较为便捷灵活。 Android手机，基于Android操作系统，具有强大的运算能力和友好的用户界面，支持语言 通讯、GPS定位、拍照、蓝牙、WIFI、GPRS等功能，满足各种复杂数据处理、实时数据更新、数 据收集保存检索等需求，在工业生产作业中作为新的手持数据终端，它起着不可替代的作 用。
【发明内容】
[0004] 本实用新型针对现有水下机器人在自治模式下实时性的不足和有缆模式中灵活 性上的限制，提供一种基于手机蓝牙技术的水下机器人控制系统，该系统不仅能便携实时 地控制水下机器人和获取水下机器人的信息，而且能保证其灵活性。
[0005] 本实用新型是通过以下技术方案实现的：
[0006] 本实用新型涉及一种基于手机蓝牙技术的水下机器人控制系统，包括：设于水下 机器人载体内的处理系统、封装在浮标内的蓝牙装置、手机上的水下机器人控制端；其中手 机上的水下机器人控制端通过封装在浮标内的蓝牙装置与水下机器人通讯，浮标与水下机 器人通过零浮力缆连接进行数据传输，水下机器人与零浮力缆用水密接插件连接，实现干 插拔；
[0007] 所述的设于水下机器人载体内的处理系统由主控板、姿态控制板、深度传感器、电 源模块以及推进模块等组成；主控板，作为系统的控制中心，由嵌入式微处理器及其外围电 路组成，包括：嵌入式微处理器、串行通信UART、模数转换A/D、输入输出10 口、电源电路等， 其中：串行通信UART分别与浮标内的蓝牙模块、姿态控制板相连，模数转换A/D与深度传感 器相连，输入输出10 口与伺服驱动器相连，电源电路为主控板提供工作电压，并获取电源 的电量信息；姿态控制板将嵌入式微处理器、三轴陀螺仪、三轴加速度计和三轴磁力计集为 一体，用来获取水下机器人载体内温度和姿态信息（横摇、纵倾和航向等）；深度传感器用 来获取水下机器人所处的深度；电源模块包括直流电源、电量检测电路、换压电路、充电电 路、系统开关装置等，为主控板、姿态控制板、深度传感器、推进模块以及蓝牙装置供电；推 进模块包括伺服电机、伺服驱动器和螺旋桨等，分为六个独立舱室，对称分布，实现水下机 器人上升、下潜、横滚、纵倾和转轴五个自由度的运动，其中伺服驱动器内设有编码器电路， 用来反馈螺旋桨的转速和转向；所述的蓝牙装置可采用水晶滴胶将其封装在可由有机玻璃 管制作的浮标内，蓝牙与处理系统主控板采用串口通信方式，其中：手机上的水下机器人控 制端通过蓝牙装置向处理系统主控板传送指令，采用串口中断方式；处理系统主控板通过 蓝牙装置向手机上的水下机器人控制端发送数据，采用定时器中断方式。
[0008] 所述的水下机器人控制端，基于Android2. 3或更高版本的手机，主界面由显示区 和日历、天气、地图、拍照、记录、设置、电池状态以及蓝牙状态等图标组成，其中：显示区实 时显示水下机器人自身姿态、所处深度、载体内温度以及手机所处方位；日历、天气、地图等 图标，用于保存水下机器人的操作日期、当前天气和所处位置；拍照图标，用于调用手机系 统中自带的拍照功能；记录图标，用于保存水下机器人的自身姿态、所处深度等信息；设置 图标，用于设定水下机器人的运动状态，实现遥控功能；电池状态图标，显示水下机器人中 的电源状态以及电量；蓝牙状态图标，显示蓝牙的连接状况和信号强度。
[0009] 本实用新型涉及一种基于上述系统的控制方法：一方面，手机上的水下机器人控 制端通过水面蓝牙向水下机器人发送目标深度、目标姿态等控制指令，处理系统主控板响 应串口中断，接收目标深度、目标姿态等信息，并根据深度传感器获取到的水下机器人实际 深度以及姿态控制板获取到的实际姿态来控制螺旋桨的转速及转向，最终实现水下悬停、 定深等功能；另一方面，处理系统主控板通过水面蓝牙将水下机器人的自身姿态、所处深 度、载体内温度以及电源状态等数据发送到手机上控制端，实时显示。
[0010] 所述的实际深度获取方法是：处理系统主控板用12位单通道模数转换ADC连续采 集深度传感器中的电压信号，直接内存存取控制器DMA传输ADC转换值，并将其保存在ADC 寄存器中，主控板定时将ADC寄存器中的ADC转换值取出并作进一步处理，获取水下机器人 所处的深度值。
[0011] 所述的实际姿态获取方法是：主控板处理器通过串口获取姿态控制板处理器解 算出的姿态信息，其中姿态控制板上的嵌入式微处理器通过I2C总线采集三轴陀螺仪、三 轴加速度计、三轴磁力计寄存器中相对应的三轴角速度、三轴加速度、三轴磁场强度等九轴 数据，并将获取到的九轴数据进行姿态解算，得出水下机器人的航向、俯仰和横摇等姿态信 肩、。
[0012] 控制水下机器人使其自身姿态和所处深度在目标设定值内，就可保证机器人运动 的可控性和稳定性。
[0013] 本实用新型的有益效果是：
[0014] 本实用新型提供的一种基于手机蓝牙技术的水下机器人控制系统，能够很好地克 服现有的水下机器人在自治模式下实时性的不足和有缆模式中灵活性上的限制、满足系统 的实时通讯需要，并为便携地获取水下机器人信息、保证水下机器人灵活运动提供了很好 的硬件支持。该系统使用安装有水下机器人控制端的手机代替传统的上位机，通过水面上 封装在浮标内的蓝牙装置与水下机器人进行通讯。浮标与水下机器人用零浮力缆连接，有 缆的存在，它可以弥补自治模式下实时性的不足，而用仅仅当作传送数据的零浮力缆替换 能够拖曳的脐带缆，可以减少缆的制约，增强水下机器人的运动灵活性。采用手机蓝牙通讯 实现上位机和浮标二者之间的无线数据传输，避免了繁琐的线缆拖曳，将手机作为专门的 上位机，简易便捷，同时该系统采用嵌入式微处理器，并进行层次化设计，姿态控制板处理 器专门负责大量的姿态信号的分析处理和通讯，大为减轻了主控板处理器的工作负荷，提 高了系统的可靠性。
【专利附图】
【附图说明】
[0015] 图1是本实用新型的系统连接示意图；
[0016] 图2是本实用新型的系统结构示意图；
[0017] 图3是本实用新型手机上的水下机器人控制端主界面示意图；
[0018] 图4是本实用新型手机上的水下机器人控制端的主程序流程图；
[0019] 图5是本实用新型手机上的水下机器人控制端触摸设置图标的系统响应程序流 程图；
[0020] 图6是本实用新型手机上的水下机器人控制端触摸日历天气地图拍照记录等图 标的手机响应程序流程图；
[0021] 图1中1.手机，2.浮标，3.水面，4.零浮力缆，5.水下机器人；图3中6.日历图 标，7.天气图标，8.地图图标，9.拍照图标，10.记录图标，11.设置图标，12.电池状态图 标，13.蓝牙状态图标，14.手机所处方位，15.底层，16.水下机器人所处深度与载体内温 度，17.深度标尺，18.水下机器人姿态信息，19.显示区。
【具体实施方式】
[0022] 下面对本实用新型的实施例作详细说明，本实施例在以本实用新型技术方案为前 提下进行实施，给出了详细的实施方式和具体的操作过程，但本实用新型的保护范围不限 于下述的实施例。
[0023] 实施例1
[0024] 如图1所示，本实施例一种基于手机蓝牙技术的水下机器人控制系统包括：设于 水下机器人（5)载体内的处理系统、封装在浮标（2)内的蓝牙装置、手机（1)上的水下机器 人控制端；其中手机（1)上的水下机器人控制端通过封装在浮标（2)内的蓝牙装置与位于 水面（3)下方的水下机器人（5)通讯，水下机器人（5)与浮标（2)用零浮力缆（4)连接，水 下机器人（5)与零浮力缆（4)用水密接插件相连，实现干插拔。浮标（2)与手机（1)的距 离不大于30米，在实际操作中可查看图3中手机（1)上的水下机器人控制端主界面上的蓝 牙状态图标（13)，根据蓝牙连接状况和信号强度调整手机（1)和浮标（2)的距离，使水下机 器人（5)在可控范围内。
[0025] 实施例2
[0026] 如图2所示，设于水下机器人（5)载体内的处理系统包括：主控板、姿态控制板、深 度传感器、电源模块、推进模块等，其中：主控板处理器分别通过串口和模数转换A/D获取 姿态控制板处理器解算出的姿态信息和深度信号。
[0027] 所述的主控板，作为系统的控制中心，由嵌入式微处理器STM32F103VCT6及其外 围电路组成，包括：嵌入式微处理器STM32F103VCT6、串行通信UART、模数转换A/D、输入输 出10 口、电源电路等，其中：串行通信UART分别与浮标（2)内的蓝牙模块、姿态控制板相 连，模数转换A/D与深度传感器相连，输入输出10 口与伺服驱动器相连，电源电路为主控板 提供工作电压，并获取电源的电量信息；
[0028] 所述的姿态控制板，包括：嵌入式微处理器STM32F103VCT6、三轴陀螺仪ITG3205、 三轴加速度计ADXL345、三轴磁力计HMC5883L及其外围电路等，其中：嵌入式微处理器 STM32F103VCT6通过I2C总线采集三轴陀螺仪ITG3205、三轴加速度计ADXL345、三轴磁力 计HMC5883L寄存器中相对应的三轴角速度、三轴加速度、三轴磁场强度等九轴信息的二进 制补码数据，并完成对九轴数据的处理，用来获取水下机器人（5)载体内姿态信息；另外， 三轴陀螺仪中的温度传感器以数字量输出载体内的温度。
[0029] 所述的深度传感器，包括压敏元件和转换元件以及转换电路等，将水压转换成主 控板可测范围内的直流电压，并使水下机器人（5)所处深度和输出电压呈线性关系，用来 获取水下机器人（5)所处的深度。
[0030] 所述的电源模块，为系统的各个模块提供合适的电源，包括：直流电源、换压电路、 电量检测电路、充电电路和系统开关装置等，其中：电源采用DC12V，换压电路实现12V-5V 和12-3. 3V的电压转换，电量检测电路用来获取电源的电量，充电电路为系统所需电源充 电提供保护，系统开关使用磁控方式实现对电源的非接触式控制。
[0031] 所述的推进模块，包括：伺服电机、伺服驱动器和螺旋桨等，分为六个独立舱室，对 称分布，实现水下机器人上升、下潜、横滚、纵倾和转轴等五个自由度的运动，其中：伺服驱 动器内设有编码器电路，用来反馈螺旋桨的转速和转向。
[0032] 所述的蓝牙模块，可用水晶滴胶将其封装在可由有机玻璃管制作的浮标内，蓝牙 与主控板用零浮力缆连接，采用串口通信方式，工作电压3. 3V，串口波特率默认为9600位 每秒，通讯距离不大于30米。
[0033] 所述的手机（1)上的水下机器人控制端，基于Android2. 3或更高版本的手机，主 界面如图3所示，由显示区（19)和日历、天气、地图、拍照、记录、设置、电池状态以及蓝牙状 态等图标组成。其中：显示区（19)实时显示水下机器人（5)的姿态信息（18)、所处深度与 载体内温度（16)以及手机所处方位（14)，深度标尺（17)可自动调节，底层（15)为动态显 示的背景；日历（6)、天气（7)、地图（8)等图标，保存水下机器人（5)的操作日期、当前天气 和所处位置；拍照图标（9)，调用手机系统中自带的拍照功能；记录图标（10)，保存水下机 器人（5)的自身姿态和所处深度等信息；设置图标（11)，设定水下机器人（5)的运动状态， 实现遥控功能；电池状态图标（12)，显示水下机器人（5)中的电源状态以及电量；蓝牙状态 图标（13)，显示蓝牙的连接状况和信号强度。
[0034] 如图4所示，实施例2通过以下方式实现具体控制：
[0035] 步骤S1，打开手机（1)上的水下机器人控制端，手机（1)上的水下机器人控制端初 始化；
[0036] 步骤S2,搜索蓝牙设备，判断有否搜到浮标内的蓝牙设备，若有则执行步骤S3,否 则执行步骤S2 ;
[0037] 步骤S3,点击确认，输入浮标内蓝牙设备的匹配PIN值，判断是否配对成功，若是 则执行步骤S4,否则执行步骤S3 ;
[0038] 步骤S4,确认手机蓝牙与浮标内的蓝牙进行连接；
[0039] 步骤S5,显示手机（1)上的水下机器人控制端主界面，显示区实时显示水下机器 人自身姿态、所处深度、载体内温度以及手机所处方位等信息，判断是否有相关操作，若有 则执行相应的响应动作，否则执行S5。
[0040] 在执行相应的响应动作中，若有按退出键则退出手机控制端；若有触摸图标，则进 行图标响应，其中：图标响应分为设置图标和非设置图标响应两种，其对应的程序流程图分 别如图5和图6所示。
[0041] 若有触摸设置图标，则进入遥控模式，对水下机器人的运动状态进行设置，可依据 获取到的水下机器人信息对机器人作左转、右转、深潜、后退、前进、悬停、定深等指令控制， 主控板收到指令的目标设定值，并根据传感器获取到深度和姿态等数据来控制螺旋桨的转 向及转速，从而使水下机器人的运动状态符合目标设定值。
[0042] 所述的深度获取方法是：主控板用12位单通道模数转换ADC连续采集深度传感器 中的电压信号，直接内存存取控制器DMA传输ADC转换值，并将其保存在ADC寄存器中，主 控板定时将ADC寄存器中的ADC转换值取出并作进一步处理，获取水下机器人所处深度值 的公式如下：
[0043]
【权利要求】
1. 一种基于手机蓝牙技术的水下机器人控制系统，其特征在于包括设于水下机器人载 体内的处理系统、封装在浮标内的蓝牙装置、手机上的水下机器人控制端；其中手机上的水 下机器人控制端通过封装在浮标内的蓝牙装置与水下机器人通讯，浮标与水下机器人通过 零浮力缆连接进行数据传输，水下机器人与零浮力缆用水密接插件连接，实现干插拔；设于 水下机器人载体内的处理系统主控板通过深度传感器获取到的水下机器人实际深度以及 姿态控制板获取到的实际姿态来控制螺旋桨的转速及转向，最终实现水下悬停、定深。
2. 如权利要求1所述的一种基于手机蓝牙技术的水下机器人控制系统，其特征在于所 述的设于水下机器人载体内的处理系统由主控板、姿态控制板、深度传感器、电源模块以及 推进模块组成；所述的主控板由嵌入式微处理器及其外围电路组成，包括嵌入式微处理器、 串行通信UART、模数转换A/D、输入输出10 口、电源电路等，其中串行通信UART分别与封装 在浮标内的蓝牙模块、姿态控制板相连，模数转换A/D与深度传感器相连，输入输出10 口与 伺服驱动器相连，电源电路为主控板提供工作电压，并获取电源的电量信息；所述的姿态控 制板包括嵌入式微处理器、三轴陀螺仪、三轴加速度计和三轴磁力计，用来获取水下机器人 载体内温度和姿态信息；所述的深度传感器用来获取水下机器人所处的深度；所述的推进 模块包括伺服电机、伺服驱动器和螺旋桨等，实现水下机器人上升、下潜、横滚、纵倾和转轴 五个自由度运动；所述的电源模块为主控板、姿态控制板、深度传感器、推进模块以及封装 在浮标内的蓝牙装置供电。
3. 如权利要求1所述的一种基于手机蓝牙技术的水下机器人控制系统，其特征在于所 述的蓝牙装置封装在浮标内，蓝牙装置与水下机器人载体内的处理系统主控板用零浮力缆 连接，采用串口通信方式；其中手机上的水下机器人控制端通过蓝牙装置向处理系统主控 板传送指令，采用串口中断方式；处理系统主控板通过蓝牙装置向手机上的水下机器人控 制端发送数据，采用定时器中断方式。
【文档编号】G05D1/10GK204065836SQ201420471936
【公开日】2014年12月31日 申请日期:2014年8月20日 优先权日:2014年8月20日
【发明者】张志根, 时少辉, 陈瑶, 郦瑞奇, 楼利旋, 余楚盈, 宋宏, 瞿逢重, 陈鹰, 冷建兴 申请人:浙江大学