如何用蓝牙实现无线定位(三)--本地定位显示
1. 被定位目标
本项目设计有两个定位装置,一个用于固定目标,一个用于可移动设备。在定位系统的帮助下,我们可以操作可移动设备向固定目标移动。假设这是一个救援场景的话,我们就可以把固定的目标看作等待救援的人或物,把可移动的设备看作前来救援的机器人。
2. 构建待救援者的定位设备
定位设备主要由1个Arduino Mega2560控制板、1个Bigfish扩展板、2个BLE4.0模块构成。在本实验中,我们为目标安装1个OLED显示屏,以便在调试时查看坐标值。
两个BLE4.0模块中的一个用于接收3个信号塔的信号(主),在控制板中计算后生成坐标信息。坐标信息可以在OLED显示屏上显示出来,并可以通过另一个BLE4.0模块发送出去(从)。从BLE4.0模块在本功能中暂时用不上,后续的远程定位功能将会用到。
按照上面的针脚使用杜邦线将待救援设备的主蓝牙和从蓝牙连接到主控板上,注意错误的连接会导致模块损坏。
3. 目标的BLE4.0a蓝牙模块配置。
目标的主蓝牙需要接收三个信号发射塔的信号,从而通过三点定位的算法计算出自己当前的位置信息,并发送显示。
使用下面的命令,配置目标的主蓝牙:
AT+RENEW //恢复默认设置 AT -- OK//测试模块正常 AT+ADDR? -- MAC//查询模块MAC地址 AT+BAUD0 -- 9600//设置波特率为9600 AT+CLEAR -- OK//清除设备配对信息 AT+IMME1 -- OK //设置模块工作类型:上电等待触发 AT+ROLE1 -- OK //设置主从模式:主设备 AT+MODE1 -- OK//设置模块工作模式:远控模式 |
各设备主从蓝牙的MAC地址(以下地址可根据自己的BLE4.0a蓝牙模块的实际MAC地址进行修改,详细参考:蓝牙配置说明.txt)
信号塔MAC地址:
0:D8A98B788750 (从) 1:D8A98B788732 (从) 2:380B3CFFC5B0 (从) |
目标1设备地址:
B:F83002253178 (从) 主:D8A98B788758 (主) |
4. 坐标位置的本地显示
将OLED模块按如图所示的方法连接在Bigfish扩展板上
按照上面的针脚使用杜邦线将OLED显示屏连接到主控板上,注意错误的连接会导致模块损坏。
5. 位置的获取与发送
烧录以下程序(human_rssi.ino),移动目标的位置,可观察到OLED模块显示坐标值的变化。
注意:该例程仅作调试使用,后期构建完整系统时会使用新的程序。
/*------------------------------------------------------------------------------------ 版权说明:Copyright 2022 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved. Distributed under MIT license.See file LICENSE for detail or copy at https://opensource.org/licenses/MIT by 机器谱 2022-5-30 https://www.robotway.com/ -------------------------------------------------------------------------------------*/ //蓝牙4.0无线连接定位实验:待救援主控接收例程 //配置模块:(模块在配置时与正常工作时TX、RX线序不同,请注意) //第一步:使用AT指令将所使用的四个模块其中一个设置为主模式,其余三个为从模式;所有模块波特率全部为默认的9600,并记录三个从模块的地址(AT+ADDR?); //第二步:将主模块在未连接时清除之前的配对信息(AT+CLEAR),再设置其工作类型为类型1(AT+IMME即上后处于等待状态,收到AT+START,AT+DISC,AT+CONNL等指令后开始工作); //开始工作: //第三步:将所有模块上电(主模块使用杜邦线接在MEGA2560上,从模块只给两个电源引脚提供3.3或5V电源即可); //第四步:将本程序下载进MEGA2560中,将从模块分别摆开,观察显示屏数据; //按救援机器人的场地在信号塔位置放置3个从模块,主模块放置在中间区域; //本实验使用的3个从模块地址分别为: /*********从设备地址********/ // "D8A98B788750", // "D8A98B788732", // "380B3CFFC5B0" /*********从设备地址********/ /**********头文件***************/ #include <Arduino.h> #include <Wire.h> #include <MultiLCD.h> #include <RssiPositionComputer.h> /***********宏定义**************/ #define DEBUG_SERIAL Serial //打印信息串口 #define CON_SERIAL Serial1 //蓝牙通信串口 #define SEND_SERIAL Serial2 //数据发送串口 #define CMD_CON "AT+CON" #define CMD_DIS_CON "AT" #define CMD_GET_RSSI "AT+RSSI?" LCD_SSD1306 lcd; RssiPositionComputer myPositionComputer; Point2D master_point; //基站数量 #define SLAVENUMBER 3 //基站地址 String BLUETOOTHADDRESS[3] = { "D8A98B788750", "D8A98B788732", "380B3CFFC5B0" }; //位置发送蓝牙地址 // D8A98B788758 String search_result_string[SLAVENUMBER] = {""}; String rssi[SLAVENUMBER] = {""}; float distance[SLAVENUMBER] = {}; void setup() { #if defined(DEBUG_SERIAL) DEBUG_SERIAL.begin(9600); #endif CON_SERIAL.begin(9600); SEND_SERIAL.begin(9600); delay(1000); lcd.begin(); lcd.clear(); lcd.setCursor(25, 3); lcd.print("Hello World!"); delay(1000); init_ble(); } void loop() { read_ble(BLUETOOTHADDRESS); to_axis(distance, &master_point); } //读取串口 String serial_read(int _len) { String data = ""; int len = 0; unsigned long t = millis() + 500; while(1) { while(CON_SERIAL.available()) { char c = CON_SERIAL.read(); data += c; len++; } if(len == _len) { Serial.println("the len"); Serial.println(data); break; } if(millis() > t) { Serial.println("the t"); Serial.println(data); break; } } #if defined(DEBUG_SERIAL) //DEBUG_SERIAL.println(data); #endif return data; } //初始化 void init_ble() { CON_SERIAL.print(CMD_DIS_CON); delay(100); serial_read(2); } //获取设备 RSSI void read_ble(String * address) { for(int i=0;i<SLAVENUMBER;i++) { CON_SERIAL.print(CMD_DIS_CON); delay(100); serial_read(2); CON_SERIAL.print(CMD_CON + address[i]); serial_read(8); delay(500); CON_SERIAL.print(CMD_GET_RSSI); String rssi_str = serial_read(10); String _rssi = rssi_str.substring(7, rssi_str.length()); //rssi rssi[i] = _rssi; //distance distance[i] = rssiToDistance(rssi[i].toFloat()); #if defined(DEBUG_SERIAL) DEBUG_SERIAL.println("BLE_" + String(i) + ": " + rssi[i]); //DEBUG_SERIAL.println("BLE_" + String(i) + ": " + distance[i]); #endif //delay(800); } } //计算距离 float rssiToDistance(float rssi) { float dis = 0; //dis = pow(10.0,((abs(rssi)-56)/10.0/1.05)); dis = pow(10.0,((abs(rssi)-56)/5.0/1.65)); return dis; } //转换为2d坐标x,y void to_axis(float * dis, Point2D* actual_master_point) { //myPositionComputer.distanceToPoint(*dis,*(dis+1),*(dis+2),actual_master_point); myPositionComputer.distanceToPoint(*dis,*(dis+1),random(0,77),actual_master_point); int x = master_point.x*100; int y = master_point.y*100; char point[100]; sprintf(point, "[ax:%3d,ay:%3d]\n",abs(x),abs(y)); #if defined(DEBUG_SERIAL) DEBUG_SERIAL.println(point); lcd.clear(); lcd.setCursor(10, 1); lcd.print("a: human"); lcd.setCursor(25, 5); lcd.print(point); #endif SEND_SERIAL.print(point); } |
6. 待救援定位装置的摆放
使用下图场地进行构建,在信号塔的位置分别放置三个信号发射塔,将待救援定位装置尽量放置在三个信号塔连线构成的三角形内。依次开启3个信号塔、目标的电源,观察目标的OLED屏幕上显示的坐标位置值(注:目标的电源必须最后打开)。
定位效果如下图所示:
7. 资料内容
① 函数库
② 目标定位设备调试例程
③ 蓝牙配置说明.txt
资料内容下载请参考如何用蓝牙实现无线定位
---------------------------------------------------未完待续---------------------------------------------------
如何用蓝牙实现无线定位(三)--本地定位显示相关推荐
- 如何用蓝牙实现无线定位(二)--信号塔设置
1. 配置BLE4.0模块 根据三点定位原理,本项目需要使用3个信号塔.3个信号塔的主体均为BLE4.0模块,需要把BLE4.0模块的AT指令设置为"从设备". 方法为: (1)给 ...
- 如何用蓝牙实现无线定位(一)--系统原理
1. 简介 本项目将利用多个BLE4.0蓝牙模块,配合主控板.OLED显示屏等,构建一个无线定位系统. 本项目的系统构成为:3个信号塔,1个中控台,2个被定位的目标. 无线定位的用途有很多.比如,我们 ...
- 如何用蓝牙实现无线定位(五)--双定位显示
1. 机器人定位装置的构建 按照上面的针脚使用杜邦线将救援机器人定位装置的主从蓝牙连接到主控板上,注意错误的连接会导致模块损坏[参考视频] 2. 机器人位置的获取与发送 (1) 在机器人定位装置的控制 ...
- 无线基站定位服务器,UWB定位技术的三种定位方法
原标题:UWB定位技术的三种定位方法 UWB定位技术也称超宽带技术,与传统的窄带系统相比,具有穿透力强.功耗低.抗多径效果好.安全性高.系统复杂度低.能提供精确定位等优点.因此,超宽带技术可以应用于室 ...
- 无线定位服务器,智慧社区老人蓝牙APP无线定位系统方案物联网GPS定位系统手环接口...
系统主要应用于小区内的儿童.老人及宠物的定位管理,亲属可以随时通过手机查 询他们在小区内实时的位置以及历史运动轨迹,以2D地图的方式呈现,如果离开小区 会自动报警. 系统主要由蓝牙AP定位器.蓝牙标签 ...
- 华三无线控制器配置本地转发
数据通信 - 建设篇 - 无线 第一章 华三无线控制器配置本地转发 数据通信 - 建设篇 - 无线 下章内容 华三无线控制器配置本地转发 背景介绍 实施步骤 连接无线AP的PoE交换机配置Trunk+ ...
- wifi rssi 计算 距离_SKYLAB:蓝牙室内定位与WiFi室内定位的对比分析
一.Wi-Fi室内定位技术 简单来说,Wi-Fi室内定位技术采用的是三点定位的方式,即通过移动接收设备以及三个Wi-Fi网络接入点的无线信号来确定移动接收设备的位置.由于三个Wi-Fi网络接入点距离移 ...
- 三角定位法java代码_GitHub - megagao/IndoorPos: 这是一个采用蓝牙4.0--iBeacon技术的室内定位服务端程序。...
IndoorPos 这是一个采用iBeacon技术的室内定位服务端程序,里面包含了三种定位算法,三边定位算法.加权三边定位算法和三角形加权质心定位算法.程序采用Spring框架,简化了JDBC和RMI ...
- 三友硅业基于Lora+IBeacon定位技术下的化工厂人员定位解决方案-化工厂定位-新导智能
三友硅业因为厂区的发展,目前的安全管理系统存在着整体上的漏洞,达不到上级主管单位以及安全生产监管部门的需要,在员工进出厂区记录与追溯,生产区人员分布与统计,危险区域人员进出控制,外来人员与车辆进出管理 ...
最新文章
- 画布Canvas的使用
- bash编程-循环控制的结构
- 《Java和Android开发学习指南(第2版)》—— 1.5 本章小结
- Quartz.net定时任务的使用及获取正在运行的JOB
- 妙到巅峰的8个简洁数学证明(文科生都能看懂),隐隐触摸到一丝只属于神的智慧气息……...
- ext store 数据修改_Vue 组件数据通信方案总结
- Linux内核学习路线 ,应从入门到深入,学内核就来零声教育
- 如何简单地将工资单发给员工?
- 网站备案 应该找域名商还是空间商备案
- 如何解决农村产权交易难的问题
- 微光二维码对接c#met
- 3.Timing Constraints
- CTP For Python
- [UNR#5]诡异操作
- mavlink协议_MAVLink学习之路03_XML中定义MSG并生成C代码
- 网络舆情总结汇报报告如何撰写的方法技巧
- 通过实例学习Pytorch加载权重.load_state_dict()与保存权重.save()
- 用友GRP-u8 XXE 漏洞复现
- arcgis server认证失败
- 全网最全Python项目体系练习500例(附源代码),练完可就业
热门文章
- SDUT-2245 小学数学
- c语言中鱼贯指针的编程题,泡面吧 IT宅男如何打造编程教学网站
- caffe Segnet 语义分割(一)
- CXL协议的认知记录
- 狗日的腾讯与骡子日的360
- es html标签,Elasticsearch如何使用同义词搜索富文本html标签过滤以及分权限过滤搜索结果...
- linux scp涉及到权限,linux系统中scp命令的用法(Permission denied排错二例)
- android-控件之Textview属性
- 微软官方原版win7(64位/32位)旗舰版系统下载
- java web电子商务网站_电子商务 javaweb b2b b2c o2o 平台