[嵌入式开发模块]JY61姿态角度传感器 驱动模块

最新推荐文章于 2023-01-04 00:09:03 发布
最新推荐文章于 2023-01-04 00:09:03 发布
阅读量5.1k 收藏 65
点赞数 4
分类专栏： c-c++ 嵌入式开发 文章标签： JY61 传感器 智能传感器 嵌入式 c语言
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/lin_strong/article/details/106598559
版权

文章目录

前言

干活中用到了JY61姿态角度传感器，写了相应的驱动程序，放出来。

驱动被设计为拥有指令器和接收机两个部分，完全被动方式运行，与具体的平台解耦，只支持串口通讯。

JY61简介

概述

JY61姿态角度传感器 六轴模块

  • 采用高精度的陀螺加速度计MPU6050，通过处理器读取MPU6050的测量数据然后通过串口输出，免去了用户自己去开发MPU6050复杂的IIC协议，同时精心的PCB布局和工艺保证了MPU6050收到外接的干扰最小，测量的精度最高。
  • 模块内部自带电压稳定电路，可以兼容3.3V/5V的嵌入式系统，连接方便。
  • 采用先进的数字滤波技术，能有效降低测量噪声，提高测量精度。
  • 模块保留了MPU6050的IIC接口，以满足用户访问底层测量数据（加速度、角速度）的需求。
  • 模块内部集成了姿态解算器，配合动态卡尔曼滤波算法，能够在动态环境下准确输出模块的当前姿态，姿态测量精度0.05度，稳定性极高。

通信协议

（1）串口通信参数

  • 电平：TTL
  • 波特率：9600/115200 bps
  • 停止位：1
  • 校验位0

（2）数据包
模块发送至上位机每帧数据分为3个数据包，分别为加速度包、角速度包和角度包，3个数据包顺序输出。波特率115200时每隔10ms输出一帧数据。

加速度包：

角速度包：

角度包：


（3）控制指令


以上都是从数据手册上复制黏贴下来的，很复杂吧。

但是没事！驱动程序已经都帮你搞定了！

驱动文件

JY61Driver.h

/*
*******************************************************************************************
*
*                                    JY61 DRIVER MODULE
*                                       JY61驱动模块
*
* File : JY61Driver.h
* By   : Lin Shijun(https://blog.csdn.net/lin_strong)
* Date : 2020/05/03
* version: V1.0
* History: 2020/05/03 V1.0 the prototype
* Note   : The JY61 driver is divided into two part, i.e. cmder and recver. The cmder is for
*          sending the JY61 command. The recver is for resolving data from the JY61.
********************************************************************************************
*/

#ifndef JY61DRIVER_H
#define JY61DRIVER_H

/*
******************************************************************************************
*                                    INCLUDE
******************************************************************************************
*/

#include <stdint.h>

/*
******************************************************************************************
*                                    DEBUG CONFIGURATION
******************************************************************************************
*/

// to enable debug messages in this module
// #define JY61_DEBUG

/*
******************************************************************************************
*                                       TYPE DEFINE
******************************************************************************************
*/

typedef enum {
  JY61DT_Acc,  // Acceleration
  JY61DT_AgV,  // Angular Velocity
  JY61DT_Ang,  // Angle
} JY61DataType;

typedef struct JY61STRUCT_DATA{
  JY61DataType t;
  // m/s^2  when t = Acc
  // °/s   when t = AgV
  // °     when t = Ang
  float x;
  float y;
  float z;
  float temp;  // ℃
} JY61Data;

typedef void (* JY61FUNC_DATA)(const JY61Data * data);

/*
************************************************************************************
*                                    INTERFACES
************************************************************************************
*/

void JY61Cmder_Init(void (* outChannel)(uint8_t *buf, uint16_t len));
void JY61Cmder_Destroy(void);
void JY61Cmder_InitializeAngle(void);
void JY61Cmder_CalibrateAccelerometer(void);
void JY61Cmder_SleepOrWakeup(void);
void JY61Cmder_SerialOutput(void);
void JY61Cmder_IICOutput(void);
void JY61Cmder_BaudRate115200(void);
void JY61Cmder_BaudRate9600(void);
void JY61Cmder_HorizontalInstall(void);
void JY61Cmder_VerticalInstall(void);


void JY61Recver_Init(JY61FUNC_DATA onRecvData);
// Call it to modify the call-back function.
void JY61Recver_RegisterCallback(JY61FUNC_DATA onRecvData);
void JY61Recver_CleanupBuffer(void);
// Feed the receiver every byte received so that receiver can notify user
// the resolved data for each frame.
void JY61Recver_Feed(uint8_t nextByte);
void JY61Recver_Destroy(void);

#endif  // of JY61DRIVER_H

JY61Recver.c

/*
*******************************************************************************************
*
*                                   JY61 RECEIVER MODULE
*                                   JY61驱动模块 - 接收机
*
* File : JY61Recver.c
* By   : Lin Shijun(https://blog.csdn.net/lin_strong)
* Date : 2020/05/03
* version: V1.0
* History: 2020/05/03 V1.0 the prototype
* Note   : 
********************************************************************************************
*/

/*
*********************************************************************************************
*                                       INCLUDES
*********************************************************************************************
*/

#include <string.h>
#include <ctype.h>
#include "JY61Driver.h"
#include "RxMac.h"

/*
*********************************************************************************************
*                                        CONSTANT
*********************************************************************************************
*/

#define JY61DF_LEN 11  // length of JY61 data frame

/*
*********************************************************************************************
*                                      TYPE DEFINITION
*********************************************************************************************
*/

typedef struct JY61FRAME_STRUCT{
  uint8_t headByte;  // 0x55
  uint8_t cmdByte;
  uint8_t xL;
  uint8_t xH;
  uint8_t yL;
  uint8_t yH;
  uint8_t zL;
  uint8_t zH;
  uint8_t TL;
  uint8_t TH;
  uint8_t Sum;
} JY61Frame;

typedef struct JY61RS_STRUCT{
  int16_t x;
  int16_t y;
  int16_t z;
  int16_t temp;
} JY61ResolvedInt;

/*
*********************************************************************************************
*                                       LOCAL FUNCTION
*********************************************************************************************
*/

#define ARRAYSIZE(arr)  (sizeof(arr)/ sizeof(arr[0]))
static void _onFlushed(RxMac sender,RxMacPtr buf,uint16_t len,RxState state,
                           RxFlag HorU,RxFlag Ender);

/*
*********************************************************************************************
*                                       LOCAL VARIABLE
*********************************************************************************************
*/

static const char * _str_JY61Recver = "JY61Recver";

static JY61FUNC_DATA _onRecvData;
static const uint8_t _flag_headerAcc[] = {(uint8_t)0x55, (uint8_t)0x51};
static const uint8_t _flag_headerAgV[] = {(uint8_t)0x55, (uint8_t)0x52};
static const uint8_t _flag_headerAng[] = {(uint8_t)0x55, (uint8_t)0x53};
static const RXFLAG_STRUCT _flags[] = {
  {_flag_headerAcc, sizeof(_flag_headerAcc), RXFLAG_OPTION_HEADER},
  {_flag_headerAgV, sizeof(_flag_headerAgV), RXFLAG_OPTION_HEADER},
  {_flag_headerAng, sizeof(_flag_headerAng), RXFLAG_OPTION_HEADER}
};
static RxMac _mac;
static uint8_t _macBuf[JY61DF_LEN];

/*
*********************************************************************************************
*                                 INTERFACE IMPLEMENTATION
*********************************************************************************************
*/

void JY61Recver_Init(JY61FUNC_DATA onRecvData){
  _onRecvData = onRecvData;
  _mac = RxMac_Create(_flags, ARRAYSIZE(_flags), _macBuf, sizeof(_macBuf),
                       NULL, NULL, _onFlushed);
  if(_mac == NULL)
    for(;;)
      ;
}

void JY61Recver_Destroy(){
  _onRecvData = NULL;
  RxMac_Destroy(_mac);
}

void JY61Recver_RegisterCallback(JY61FUNC_DATA onRecvData){
  _onRecvData = onRecvData;
}

void JY61Recver_CleanupBuffer(void){
  RxMac_ResetState(_mac);
}

void JY61Recver_Feed(uint8_t nextByte){
  RxMac_FeedData(_mac, nextByte);
}

/*
*********************************************************************************************
*                               LOCAL FUNCTION IMPLEMENTATION
*********************************************************************************************
*/

static int _frameSumRight(const uint8_t * frame){
  uint8_t sum = 0;
  int i;
  for(i = 0; i < 10; i++)
    sum += frame[i];
  return sum == frame[10];
}

static void _frameResolve(JY61ResolvedInt *rst, const JY61Frame *frame){
  rst->x = (((int16_t)frame->xH) << 8) | frame->xL;
  rst->y = (((int16_t)frame->yH) << 8) | frame->yL;
  rst->z = (((int16_t)frame->zH) << 8) | frame->zL;
  rst->temp = (((int16_t)frame->TH) << 8) | frame->TL;
}

static void _onFlushed(RxMac sender,RxMacPtr buf,uint16_t len,RxState state,
                       RxFlag HorU,RxFlag Ender){
  JY61Data data;
  JY61ResolvedInt rData;
  if(_onRecvData == NULL || !state.headerFound)
    return;
  if(!_frameSumRight((const uint8_t *)buf))
    return;

  _frameResolve(&rData, (const JY61Frame *)buf);

  data.x = rData.x / 32768.0f;
  data.y = rData.y / 32768.0f;
  data.z = rData.z / 32768.0f;
  switch (buf[1]){
  case 0x51:
    data.t = JY61DT_Acc;
    data.x *= 16;
    data.y *= 16;
    data.z *= 16;
    break;
  case 0x52:
    data.t = JY61DT_AgV;
    data.x *= 2000;
    data.y *= 2000;
    data.z *= 2000;
    break;
  case 0x53:
    data.t = JY61DT_Ang;
    data.x *= 180;
    data.y *= 180;
    data.z *= 180;
    break;
  default:
    // will never hit here
    return;
  }
  data.temp = (float)rData.temp / 340.0f + 36.53f;
  _onRecvData(&data);
}

JY61Cmder.c

/*
*******************************************************************************************
*
*                                    JY61 COMMANDER MODULE
*                                    JY61驱动模块 - 指令器
*
* File : JY61Cmder.c
* By   : Lin Shijun(https://blog.csdn.net/lin_strong)
* Date : 2020/05/03
* version: V1.0
* History: 2020/05/03 V1.0 the prototype
* Note   : 
********************************************************************************************
*/

/*
*********************************************************************************************
*                                       INCLUDES
*********************************************************************************************
*/

#include <stdio.h>
#include "JY61Driver.h"

/*
*********************************************************************************************
*                                       LOCAL VARIABLE
*********************************************************************************************
*/
static void (* _out)(uint8_t *buf, uint16_t len) = NULL;

/*
*********************************************************************************************
*                                       CONSTANT
*********************************************************************************************
*/

#define JY61CMDBYTE_INITANGLE      0x52
#define JY61CMDBYTE_CALIACCMETER   0x67
#define JY61CMDBYTE_SLEEPORWAKE    0x60
#define JY61CMDBYTE_OUTPUTSERIAL   0x61
#define JY61CMDBYTE_OUTPUTIIC      0x62
#define JY61CMDBYTE_BAUDRATE115200 0x63
#define JY61CMDBYTE_BAUDRATE9600   0x64
#define JY61CMDBYTE_HORINSTALL     0x65
#define JY61CMDBYTE_VERINSTALL     0x66

/*
*********************************************************************************************
*                                 INTERFACE IMPLEMENTATION
*********************************************************************************************
*/

void JY61Cmder_Init(void (* outChannel)(uint8_t *buf, uint16_t len)){
  _out = outChannel;
}

void JY61Cmder_Destroy(){
  _out = NULL;
}

static void _sendCmd(uint8_t cmdByte){
  static uint8_t frame[3] = {0xFF, 0xAA};
  if(_out == NULL)
    return;
  frame[2] = cmdByte;
  _out(frame, sizeof(frame));
}

void JY61Cmder_InitializeAngle(){
  _sendCmd(JY61CMDBYTE_INITANGLE);
}

void JY61Cmder_CalibrateAccelerometer(void){
  _sendCmd(JY61CMDBYTE_CALIACCMETER);
}

void JY61Cmder_SleepOrWakeup(void){
  _sendCmd(JY61CMDBYTE_SLEEPORWAKE);
}

void JY61Cmder_SerialOutput(void){
  _sendCmd(JY61CMDBYTE_OUTPUTSERIAL);
}

void JY61Cmder_IICOutput(void){
  _sendCmd(JY61CMDBYTE_OUTPUTIIC);
}

void JY61Cmder_BaudRate115200(void){
  _sendCmd(JY61CMDBYTE_BAUDRATE115200);
}

void JY61Cmder_BaudRate9600(void){
  _sendCmd(JY61CMDBYTE_BAUDRATE9600);
}

void JY61Cmder_HorizontalInstall(void){
  _sendCmd(JY61CMDBYTE_HORINSTALL);
}

void JY61Cmder_VerticalInstall(void){
  _sendCmd(JY61CMDBYTE_VERINSTALL);
}

依赖

接收器的实现依赖于我写的通用接收机：
通用接收状态机模块

使用示例

使用此模块基本分几步：

  1. 初始化模块
  2. 如需要发送指令则实现并注册信道给指令器；注册回调函数给接收器，这样接收器在发现完整的数据帧时就会通过回调函数进行通知。
  3. 不断接收数据，并喂(Feed)给接收器；如需要发指令，随时调用指令器的接口。

以下代码示例了在上电后发送校准指令，然后进入自动模式，之后不断读取数据并进行解析(假设使用标准输入输出上的串口和JY61通信)：


#include "JY61Driver.h"
#include <stdio.h>
#include <stdint.h>
……
// 收到数据的回调函数
static void onDataResolved(const JY61Data * data);
// 发送信道
static void sendChannel(uint8_t *buf, uint16_t len);

void main(){
  uint8_t b;
  ……
  JY61Recver_Init(onDataResolved);
  JY61Cmder_Init(sendChannel);
  
  // 可以发送各种命令，比如
  // JY61Cmder_HorizontalInstall();
  
  for(;;){
    // 不断得到下一个字节并喂给接收机
    // 接收机会通过回调函数实时传递解析出来的值
    b = (uint8_t)getchar();
    JY61Recver_Feed(b);
  }
}

static void onDataResolved(const JY61Data * data){
  // 这里会得到实时解析到的各个包的数据
  switch(data->t){
    case JY61DT_Acc:
      // 加速度包的处理
    break;
    case JY61DT_AgV:
      // 角速度包的处理
    break;
    case JY61DT_Ang:
      // 角度包的处理
    break;
    default:
      // 不应该会到这
    break;
  }
}

static void sendChannel(uint8_t *buf, uint16_t len){
  // 往标准输出输出这个字节
  while(len-- > 0)
    putchar((char)*buf++);
}

更新历史

2020/06/07 放出V1.0

夏日白云
关注
  • 4
    点赞
  • 踩
  • 65
    收藏
    觉得还不错? 一键收藏
  • 10
    评论
专栏目录
STM32HAL库实现JY61P陀螺仪
2201_75475731的博客
10-01 1119
JY61P可以通过串口进行数据通信，这使得它可以与各种设备和控制器进行连接和交互。下面是关于JY61P串口使用的简要介绍：硬件连接：将JY61P的串口引脚（TX和RX）连接到要使用的设备的串口引脚（如STM32的TX和RX引脚）。同时，确保连接共地（GND）引脚以建立电气连接。通信协议：JY61P使用标准的串口通信协议，通常是UART或USART。要与JY61P进行通信，需要设置相同的波特率（数据传输速率）、数据位、停止位和奇偶校验位等参数。通常，JY61P的默认波特率是115200。
成功配置JY61模块，实现串口监视角度的功能
YANGCHEN144的博客
10-23 1601
联动了多个模组，尝试了多种数据接收格式，包括32与arduino、蓝牙模块的通信，遇到了各种坑，不过终究是解决了。 有点累，先记一下代码。 主函数： /** ****************************************************************************** * @author YCHEN * @version V1.3 * @date 2021-10-23 * @brief 备战电赛 ...
JY61资料包
12-02
陀螺仪资料
jy61模块+stm32+3D演示+串口输出
04-12
jy61模块+stm32，通过串口4输出角度数据，可以连接HC06蓝牙模块等读取角度数据，同时还可以连接上位机通过电脑观察角度和3D模型演示
陀螺仪加速度计 JY61（MPU6050） 原理简述及缺陷分析
热门推荐
追求。
03-31 2万+
该模块工作原理较为复杂，且涉及到数字信号处理，本文只是简单的描述其工作原理，并捎带上一些基础理论。 —— JY61（MPU6050）简介 MPU6050由四部分组成：加速度计、陀螺仪、DMP、温度传感器（检测温度，通过算法优化来减少温漂）。JY61和MPU6050为从属关系。六轴模块jy61自带稳压电路，包含陀螺仪加速度计MPU6050和STM8单片机，STM8通过IIC读取 MPU6050 中DM...
JY61使用说明书V1.21
08-03
1、电压：3.3V~5V 2、电流：<10mA 5、测量维度：加速度：3 维，角速度：3 维，角度：3 维 6、量程：加速度:±16g，角速度：±2000deg
JY61说明书
hyjicon的博客
03-03 3925
产品规格书 :SPECIFICATION 型 号：JY61 描 述：六轴姿态角度传感器 生产执行标准参考 企业质量体系标准： ISO9001:2016标准 倾角仪生产标准：GB/T191SJ 20873-2016 产品试验检测标准：GB/T191SJ 20873-2016 文档目录 文章目录1. 产品概述2. 性能参数3. 引脚说明4. 轴向说明5. 硬件连接方法5.1串口（TTL）连接5.2 连单片机6. 上位机使用方法6.1 使用方法6.2 模块校准6.2.1 Z轴归06.2.2 加计校准6.3 设.
JY61输出的角度数据滞后于实际角度
养牛青年的博客
12-18 533
问题描述： 程序从JY61模块读取到的角度滞后于实际角度
JY61P姿态传感器的调试
wotaifuzao的博客
01-02 7492
1 熟悉JY-61P 模块的基本参数 1、电压： 3.3V~5V 2、电流： <25mA 3、体积： 15.24mm X 15.24mm X 2mm 4、焊盘间距：上下 100mil(2.54mm)，左右 600mil(15.24mm) 5、测量维度：加速度： 3 维，角速度： 3 维， 角度： 3 维， 气压:1 维（JY-901B）， GPS： 3 维（接 GPS 模块） 6、量程：加速...
JY61模块在单向转动时角度数值突然变小
养牛青年的博客
12-18 377
问题描述： 在使用JY61模块测试角度的过程中，实际运动角度在增大，但模块输出的测量角度有时却在减小
JY61陀螺仪（stm32，arduino，51通用）
04-14
jy61陀螺仪，上位机+程序+操作说明书+驱动
JY61资料包 -.zip
03-01
GY61型号的陀螺仪内有详细的stm32F1的详细代码和上位机，三维展示能更加直接的展示出陀螺仪的特性。
MPU60506轴JY61
01-07
MPU60506 轴JY61 惯性传感器的详细资料、说明上位机例程等资源汇总
JY61陀螺仪STM32F1测试代码
11-03
JY61陀螺仪STM32测试代码 0.96寸OLED显示 使用串口通信
维特智能六轴姿态传感器JY61P_stm32f1xx驱动代码解析
最新发布
zyc18700766982的博客
01-04 3349
前面说过只需要加速度、角速度和角度这三个数据，说全了其实是三轴加速度、三轴角速度和三轴角度，WIT私有协议中关于读取寄存器返回值说的很清楚，一个数据包一共返回11个字节，四个寄存器的值。如下图所示，假如读取三轴加速度，则返回X轴加速度、Y轴加速度、Z轴加速度、温度一个数据包11个字节，三个数据包33个字节，处理数据一定要求是一个完整的数据包。JY61P是循环发送需要输出的数据的（需要输出什么可以自行设置）下面讨论两种极限情况：运气好。
大胜利！JY61的通信格式适用于总线电机，实现自动调节电机PID的功能。
YANGCHEN144的博客
10-25 587
今天又摸索了一下串行总线电机的控制协议，在之前JY61通信格式上稍作修改，发现竟然轻而易举的成功了！ 功能一：串口控制灯的亮灭 功能二：串口控制电机速度，实现自动调节PID 通信协议如下： 针对此协议，写了几个新函数： void sendcmd10(char cmd[]) { char i; for(i=0;i<10;i++) UART1_Put_Char(cmd[i]); } //有以下伪代码函数 sendcmd10(...
用arduino uno的串口读取JY61角度传感器的角速度、加速度、角度数据MPU6050
Fred_1986的博客
09-15 3934
1 介绍 大家从标题中来看呢，大家可能会有些困惑，MPU6050只输出加速度、陀螺仪。没有角度。这个也是我今天想和大家说的。最近我做了一个倾角项目。老板基于成本考虑希望我能用MPU6050去算出来角度。说实话自己没接触这个东西，去搞的时候才知道挺难的，很地方看不懂。然后我去看过了正电原子的MPU6050的解算。但是那个角度的结果和我想要精度有点差别。无意中呢在淘宝上搜到了一个维特智能的JY61模块。这个模块的内置的就是MPU6050模块。这个商家说它的静态角度的精度为0.05度、动态0.1度。这个精度是很符
51单片机连接维特智能JY61串口6轴加速度陀螺仪（通过串口中断实现数据的现实）
qq_32945473的博客
04-13 4130
51单片机连接维特智能JY61串口6轴加速度陀螺仪（通过串口中断实现数据的现实） 1.JY61的初始化 利用USB转TTL模块连接只需要连接： 打开厂家赠送的上位机软件，模块出厂默认设置使用串口，波特率 115200，帧率 100Hz。配置可通过上位机软件配置， 因为所有配置都是掉电保存的，所以只需配置一次就行。由于51单片机不能产生115200的波特率，因此我们先利用上位机将模块的默认波特率设置...
用STM32读取6轴角度传感器JY61的陀螺仪、加速度、角度数据MPU6050
Fred_1986的博客
08-29 1万+
1 介绍 大家从标题中来看呢，大家可能会有些困惑，MPU6050只输出加速度、陀螺仪。没有角度。这个也是我今天想和大家说的。最近我做了一个倾角项目。老板基于成本考虑希望我能用MPU6050去算出来角度。说实话自己没接触这个东西，去搞的时候才知道挺难的，很地方看不懂。然后我去看过了正电原子的MPU6050的解算。但是那个角度的结果和我想要精度有点差别。无意中呢在淘宝上搜到了一个维特智能的JY61模块。这个模块的内置的就是MPU6050模块。这个商家说它的静态角度的精度为0.05度、动态0.1度。这个精度是很符
评论 10
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值