如何用蓝牙实现无线定位（四）--远程定位显示

最新推荐文章于 2024-09-27 17:58:25 发布
最新推荐文章于 2024-09-27 17:58:25 发布
阅读量718 收藏 4
点赞数 1
文章标签： 人工智能
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/Robotway/article/details/128142430
版权

1. 待救援定位设备

       按照下面的针脚使用杜邦线将待救援定位设备的主蓝牙、从蓝牙连接到主控板上，和本地显示时的连接针脚是一样的，但是由于不需要连接OLED，因此不需要堆叠Bigfish。

参考视频

烧录程序如下（human.ino）：

/*------------------------------------------------------------------------------------

  版权说明：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/

  -------------------------------------------------------------------------------------*/

//待救援主控例程

//配置模块：(模块在配置时与正常工作时TX、RX线序不同，请注意)

//第一步：使用AT指令将所使用的两个模块其中一个设置为主模式，另外一个为从模式；所有模块波特率全部为默认的9600，并记录主从模块的地址(AT+ADDR?);

//第二步：将主模块在未连接时清除之前的配对信息(AT+CLEAR),再设置其工作类型为类型1(AT+IMME即上后处于等待状态，收到AT+START,AT+DISC,AT+CONNL等指令后开始工作）；

//开始工作：

//第三步：将所有模块上电(主从模块按照上面介绍的连接方式连接即可);

//第四步：将本程序下载进MEGA2560中，将从模块分别摆开，观察显示屏数据；

/*********从设备地址********/

//   "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?"

RssiPositionComputer myPositionComputer;

Point2D master_point;

//基站数量

#define SLAVENUMBER 3

//基站地址

String BLUETOOTHADDRESS[3] = {

  "D8A98B788750",

  "D8A98B788732",

  "380B3CFFC5B0"

};

//位置发送蓝牙地址

// F83002253650

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);

  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){

       break;

    }

    if(millis() > t)

      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);

   #endif

   SEND_SERIAL.print(point);

}

       你也可以按照“本地定位显示”实验的方法，为该定位装置安装OLED模块，这样的话，可以实现本地和远程的同时显示。

2. 构建远程中控台

       远程中控台用于远程、无线、实时显示被定位目标的坐标值，主要由1个Arduino Mega2560控制板、2个BLE4.0模块、1个OLED显示屏、1块锂电池构成。其中两个BLE4.0模块都要设置成主设备模式。

（1）蓝牙模块的配置

主蓝牙设备配置命令：

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蓝牙模块进行修改，详细参考：蓝牙配置说明.txt）

信号塔设备MAC地址：

0：D8A98B788750 （从）

1：D8A98B788732 （从）

2：380B3CFFC5B0 （从）

待救援定位设备MAC地址：

B：F83002253178 （从）

主：D8A98B788758 （主）

中控台设备MAC地址：

主1：F8300225362D （主）

主2：F830022538C4 （主）

（2）远程中控台的电路连接

 

参考视频 

3. 中控台接收待救援者的坐标位置

       在中控台的控制板中烧录以下程序(master.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/

  -------------------------------------------------------------------------------------*/

//救援指挥中心例程

//配置模块：(模块在配置时与正常工作时TX、RX线序不同，请注意)

//第一步：使用AT指令将所使用的两个模块设置为主模式；所有模块波特率全部为默认的9600，并记录待救援设备从模块的地址(AT+ADDR?);

//第二步：将主模块在未连接时清除之前的配对信息(AT+CLEAR),再设置其工作类型为类型1(AT+IMME即上后处于等待状态，收到AT+START,AT+DISC,AT+CONNL等指令后开始工作）；

//开始工作：

//第三步：将所有模块上电(主模块参考控制中心的连接进行接线，待救援设备从模块参考相应的连接);

//第四步：将本程序下载进MEGA2560中，将从模块分别摆开，观察显示屏数据；

#include <Arduino.h>

#include <Wire.h>

#include <MultiLCD.h>

#define DATA_SERIAL Serial //信息打印串口

#define HUMAN_SERIAL Serial1 //待救援数据

#define ROBOT_SERIAL Serial2 //救援机器人数据

#define CMD_CON "AT+CON"

#define CMD_DIS_CON "AT"

#define CMD_START "AT+START"

LCD_SSD1306 lcd;

String human_address = "F83002253650"; //待救援设备地址

String robot_address = "F83002253178"; //救援机器人设备地址

String human_point = "[ax: 0 , ay: 0]";

String robot_point = "[bx: 0 , by: 0]";

void setup()

{

DATA_SERIAL.begin(9600);

HUMAN_SERIAL.begin(9600);

ROBOT_SERIAL.begin(9600);

lcd.begin();

master_init();

}

void loop()

{

read_human_point();

read_robot_point();

point_display();

}

void connect_ble()

{

//连接待救援设备地址

// HUMAN_SERIAL.print(CMD_START);delay(1000);

HUMAN_SERIAL.print(CMD_DIS_CON);delay(200);

HUMAN_SERIAL.print(CMD_CON + human_address);

//连接救援机器人设备地址

ROBOT_SERIAL.print(CMD_DIS_CON);delay(200);

ROBOT_SERIAL.print(CMD_CON + robot_address);

}

//读取待救援位置

void read_human_point()

{

while(1)

{

String str;

while(HUMAN_SERIAL.available() > 0)

{

str = HUMAN_SERIAL.readStringUntil('\n');

str.trim();

}

if(!str.equals(""))

{

Serial.println(str);

human_point = str; break;

}

}

}

//读取救援机器人位置

void read_robot_point()

{

while(1)

{

String str;

while(ROBOT_SERIAL.available() > 0)

{

str = ROBOT_SERIAL.readStringUntil('\n');

str.trim();

}

if(!str.equals(""))

{

Serial.println(str);

robot_point = str;

break;

}

}

}

void point_display()

{

lcd.clear();

lcd.setCursor(10, 1);

lcd.print("a: human b: robot");

lcd.setCursor(20, 3);

lcd.print(human_point);

lcd.setCursor(20, 5);

lcd.print(robot_point);

}

void master_init()

{

lcd.clear();

lcd.setCursor(25, 3);

lcd.print("Hello World!");

delay(1000);

point_display();

connect_ble();

while(true)

{

if(HUMAN_SERIAL.available() > 0 || ROBOT_SERIAL.available() > 0)

break;

}

}

       烧录了例程后，依次开启信号塔、待救援定位装置、中控台的电源，中控台的OLED屏幕上即可显示待救援者的坐标值（注：中控台的电源必须最后打开）。

定位效果如下图所示:

4. 资料内容

① 远程定位显示-例程

② 蓝牙配置说明.txt 

资料内容下载请参考如何用蓝牙实现无线定位

---------------------------------------------------未完待续---------------------------------------------------

Robotway
关注
蓝牙定位那点事！
qq_40342174的博客
03-27 3664
    过完年来公司，公司接了个项目，跟公司定位相结合的蓝牙定位的实现。本来小牧不负责这块的，但由于当时做这块的同事用的小程序开发的。无法做到息屏处理。故而这事就落到小牧这点了。大致就这麽个需求吧。好了，话不多时，直接上码。    实现部分就先说下蓝牙定位吧，毕竟得贴题啊，虽然主要想分享的是息屏处理（主要蓝牙定位的文章太多了）。 iBeacon iBeacon = new iBeacon(); ...
蓝牙定位精度浅析
LADDIS的博客
04-28 2496
蓝牙定位精度一般在2-5米左右，具体精度除了跟部署密度有关，还跟定位算法、内部环境结构、硬件设备本身等有关系。
蓝牙定位功能：
weixin_30435261的博客
08-23 865
蓝牙BLE最大的特点就是成本和功耗的降低，且适用于实时性要求比较高的领域。除了在传输速率上要慢一些之外，还支持1对多广播，通过Mesh技术，还能做到多对多; 蓝牙历史上的四大创新应用:音频传输、低功耗数据传输、定位、设备网络. 蓝牙4.2：有一定得定位功能 蓝牙5.0：定位精度小于1米，精度高于V4.2；速率*2；距离达300米；功耗更低 蓝牙5.1：对通用属性配置文件（GATT...
蓝牙定位导航系统深度解析：技术原理、实现步骤与实战应用
最新发布
维小帮定位导航的博客
09-27 1034
蓝牙定位技术利用蓝牙信号的特性，通过测量信号强度、到达时间差或到达角度等参数，实现对目标位置的估算。BLE技术的引入，进一步降低了功耗，延长了设备使用寿命，使得蓝牙定位系统在更多场景下得以应用。
蓝牙定位技术原理--蓝牙人员定位--蓝牙定位--新导智能
Xindoo2020的博客
05-22 5154
众所周知，蓝牙通讯技能被广泛用于手的机、智能家居、智能穿戴等通讯中。随着物联网生态链逐渐走向成熟，对定位的需求也大大增加，这给蓝牙在该范畴又发明了一番宽广的六合。接下来首要剖析一下蓝牙定位技能的作业原理与首要使用场景。 一、蓝牙人员定位原理: 蓝牙人员定位根据RSSI（Received Signal Strength Indication，信号场强指示）定位原理。根据定位端的不同，蓝牙定位方法分为网络侧定位和终端侧定位。网络侧定位体系由终端（手机等带低功耗蓝牙的终端）、蓝牙beacon...
蓝牙定位技术的原理和应用
Xindoo2020的博客
12-08 1454
蓝牙（Bluetooth）是一种短距离的无线通信技术，可以通过一个短距离的通讯网络，让计算机或移动设备与另一台计算机或智能设备建立通讯连接。8.更多产品研发应用情况：手机上的蓝牙定位功能可以实现实时监控、电子围栏、位置共享等功能；1.自动定位：通过在每一个蓝牙节点上安装专用的无线设备，当蓝牙设备发现网络节点存在时，将它与已知的其他蓝牙节点连接，从而实现对该节点的位置信息的采集和获取。2.安全定位：用户使用智能手机或 PDA通过蓝牙可以与其它智能系统连接来实现对目标位置的实时监控，并将信息反馈到用户端。
行业文档-设计装置-一种远程隧道施工人员实时定位系统.zip
08-17
- 监控界面：提供给管理人员使用的可视化界面，显示人员位置、移动轨迹等信息。 4. 功能特点： - 实时定位：系统能实时更新人员位置，便于紧急情况下的快速响应。 - 安全预警：当人员进入危险区域或发生事故时，...
蓝牙技术对无线通信的影响-综合文档
05-20
例如，通过蓝牙智能锁、蓝牙温控器等设备，用户可以远程控制家庭设施，实现智能化管理。此外，蓝牙Beacon技术更是为室内定位服务提供了可能，进一步推动了零售、交通等领域的创新。 再者，蓝牙技术在健康与健身领域...
SiliconLabs_使用蓝牙 5 增强信标-综合文档
05-22
蓝牙5是蓝牙技术联盟（SIG）推出的一种低功耗无线通信标准，旨在提供更远的传输距离、更高的数据速率以及更大的广播数据容量，从而极大地扩展了物联网（IoT）的应用范围。 首先，我们来看一下蓝牙5相对于前代版本的...
电信设备-一种基于无线通信的四轮定位智能终端.zip
09-19
标题中的“电信设备-一种基于无线通信的四轮定位智能终端”揭示了这个主题的核心，它涉及到了电信技术、无线通信以及智能终端在四轮定位系统中的应用。在这个压缩包中，我们主要会探讨以下几个关键知识点： 1. **...
搭建简易蓝牙定位系统的实现方法
08-31
下面小编就为大家带来一篇搭建简易蓝牙定位系统的实现方法。小编觉得挺不错的，现在就分享给大家，也给大家做个参考。一起跟随小编过来看看吧
BLE室内定位：使用蓝牙信标进行多边定位
02-03
BLE室内定位 此仓库包含一个，该能够根据从蓝牙信标接收到的广告包来估计位置。 它还包含一个，该使用此库来可视化信标和位置数据。 用法 积分 Gradle 释放文物可通过。 dependencies { compile ' com.nexenio.bleindoorpositioning:core:0.4.0 ' } 如果要使用分支快照或特定的提交，请使用 。 allprojects { repositories { maven { url ' https://jitpack.io ' } } } dependencies { compile ' com.github.neXenio:BLE-Indoor-Positioning:dev-SNAPSHOT ' } Maven < dependency> < groupId>com.nexenio.bleindoorpositioning</ groupId> < artifactId>core</ artifactId> < version>0.4.0</ v
Arduino mega与AS3992 RFID通信读RSSI值代码
09-08
Arduino mega与Eleckits AS3992 UHF RFID读写模块通信读RSSI值代码
三点定位法原理及实现——蓝牙定位
热门推荐
jjwwwww的博客
02-19 3万+
三点定位法原理及C语言实现前言原理两圆相交两圆不相交代码实现 前言 最近在做蓝牙室内定位，蓝牙定位用到的一个非常经典的算法就是三点定位法。 原理 三点定位法，顾名思义首先有三个圆点，同时我们也知道这三个圆的半径，最终求得三圆的交点，达到定位效果。如图： 我们的目的是求得O点，利用毕达哥拉斯定理我们可以快速求得O点坐标。不过事与愿违，现实情况并不总是如人意，而是这样： 甚至有的情况其中两个圆或者...
android 定位蓝牙,蓝牙如何定位，简易蓝牙定位系统的实现方法
weixin_39685674的博客
05-26 5775
蓝牙如何定位，简易蓝牙定位系统的实现方法1.准备设备所需硬件设备：(1)低功率蓝牙定位器若干(如：10个)，网上有卖(单价从几十到几百都有)(2)android设备一台，系统版本4.2以上(SDK版本大于17)(3)iOS设备一台，支持蓝牙4.0 BLE2.设置蓝牙定位器移动设备扫描周边低功率蓝牙设备，可以获得蓝牙设备对应的Proximity UUID、Major、Minor等属性信息。而刚采购来...
android+定位跟踪,android实现远程定位追踪(UC+XSS)
weixin_35671110的博客
05-26 1231
前言当PC时代的辉光逐渐隐入了暮霭，一轮更加炫目的红日正在缓缓升起，时至今日，移动互联网已经成为引领时代发展与前沿技术不断革新的中流砥柱，短短十数年 间，手机的兴盛就超出了所有人的预料，大海淘沙，洗尽多少红尘铅华，新的思想，新的技术如雨后春笋般，让人目不暇接。智能化网络、云计算大存储服务、大数 据交互技术、3G/4G乃至5G网络等等新技术层出不穷，然而与此同时，一个个新的问题开始逐渐显露出了它的冰...
如何用蓝牙实现无线定位（五）--双定位显示
Robotway的博客
12-06 362
本项目将利用多个BLE4.0蓝牙模块，配合主控板、OLED显示屏等，构建一个无线定位系统。本项目的系统构成为：3个信号塔，1个中控台，2个被定位的目标。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值