自己移植的FreeRTOS+MPU6050姿态测试代码

ID:640600 · 发表于 2021-11-20 17:52

自己学习FreeRTOS和MPU6050时写的一个姿态测试程序,希望有大佬发表相关意见!仅仅是做了一些简单的测试!!! 但是Row角的偏移有点大!!!

单片机源程序如下:

/*
*************************************************************************
* 包含的头文件
*************************************************************************
*/
/* 系统标准头文件 */
#include <string.h> //字符串操作相关函数
#include <stdio.h> //标准输入输出
#include <limits.h> //高等大数据定义
#include <stdlib.h> //内存操作相关函数
/* FreeRTOS头文件 */
#include "FreeRTOS.h" //FreeRTOS系统配置头文件
#include "task.h" //创建任务头文件
#include "queue.h" //内核队列头文件
#include "semphr.h" //信号量头文件
#include "event_groups.h" //事件处理头文件
#include "list.h" //链表头文件
/* 开发板硬件bsp头文件 */
#include "stm32f10x.h"
#include "delay.h"
#include "usart.h"
#include "bsp_usart.h"
#include "bsp_led.h"
#include "bsp_key.h"
//#include "bsp_i2c_ee.h" //软件I2C通讯底层
//#include "bsp_i2c_gpio.h"//软件I2C通讯底层IO口
//#include "bsp_i2c_ee.h" //硬件I2C底层
#include "bsp_TiMbase.h"
#include "bsp_AdvanceTim.h"
#include "mpu6050.h"
#include "mpu6050_app.h"
#include "inv_mpu.h"
#include "inv_mpu_dmp_motion_driver.h"
/**************************** 任务块 ********************************/
/* 仿照正点原子的按照任务的相关性来进行声明和定义所有的类型等变量
*
*/
/* 创建任务函数句柄 */
static TaskHandle_t AppTaskCreate_Handle=NULL;
/* 创建任务函数堆栈大小 */
#define AppTask_STK_SIZE 512
/* 创建任务函数任务优先级 */
#define AppTask_TASK_PRIO 1
/* 创建任务函数声明 */
static void AppTaskCreate(void);/* 用于创建任务 */
/* Work任务函数句柄 */
static TaskHandle_t Work_TaskHandle=NULL;
/* Work任务函数堆栈大小 */
#define Work_STK_SIZE 512
/* Work任务函数任务优先级 */
#define Work_TASK_PRIO 2
/* Work任务函数声明 */
static void Work_Task(void* parameter);/* Work任务相关任务 */
// /* Receive2任务函数句柄 */
//static TaskHandle_t Receive2_TaskHandle=NULL;
// /* Receive2任务函数堆栈大小 */
//#define Receive2_STK_SIZE 512
// /* Receive2任务函数任务优先级 */
//#define Receive2_TASK_PRIO 3
// /* Receive2任务函数声明 */
//static void Receive2_Task(void* parameter);/* Receive2任务相关任务 */
// /* KEY任务函数句柄 */
//static TaskHandle_t KEY_TaskHandle=NULL;
// /* KEY任务函数堆栈大小 */
//#define KEY_STK_SIZE 512
// /* KEY任务函数任务优先级 */
//#define KEY_TASK_PRIO 3
// /* KEY任务函数声明 */
//static void KEY_Task(void* parameter);/* KEY任务 */
/**************************** 任务句柄 ********************************/
/*
* 任务句柄是一个指针，用于指向一个任务，当任务创建好之后，它就具有了一个任务句柄
* 以后我们要想操作这个任务都需要通过这个任务句柄，如果是自身的任务操作自己，那么
* 这个句柄可以为NULL。
*/
/********************************** 内核对象句柄 *********************************/
/*
* 信号量，消息队列，事件标志组，软件定时器这些都属于内核的对象，要想使用这些内核
* 对象，必须先创建，创建成功之后会返回一个相应的句柄。实际上就是一个指针，后续我
* 们就可以通过这个句柄操作这些内核对象。
*
* 内核对象说白了就是一种全局的数据结构，通过这些数据结构我们可以实现任务间的通信，
* 任务间的事件同步等各种功能。至于这些功能的实现我们是通过调用这些内核对象的函数
* 来完成的
*
*/
/******************************* 宏定义 ************************************/
/*
* 当我们在写应用程序的时候，可能需要用到一些宏定义。
*/
/******************************* 全局变量声明 ************************************/
/* 当我们在写应用程序的时候，可能需要用到一些全局变量。
*/
/*
*************************************************************************
* 函数声明
*************************************************************************
*/
static void BSP_Init(void);/* 硬件初始化 */
/* 裸机驱动测试主函数 */
//int main(void)
//{
// delay_init(); //延时函数初始化
// NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4);
// uart_init(115200); //串口初始化为115200
//
// DHT11_Init(); //DHT11初始化
// while(1)
// {
// DHT11_Read_Data(&temperature,&humidity);
// printf("%0.2d℃ %0.2d%%\r\n",temperature,humidity);
// delay_ms(1000);
// }
//}
/*****************************************************************
* @brief 主函数
* @param 无
* @retval 无
* @note 第一步：开发板硬件初始化
第二步：创建APP应用任务
第三步：启动FreeRTOS，开始多任务调度
****************************************************************/
int main(void)
{
BaseType_t xReturn = pdTRUE; /* 定义一个创建信息返回值，默认为pdTRUE */
/* 开发板硬件初始化 */
BSP_Init();
/* 创建AppTaskCreate任务 */
xReturn = xTaskCreate( (TaskFunction_t) AppTaskCreate, /* 任务入口函数 */
(const char * ) "AppTaskCreate", /* 任务名称 */
(uint16_t ) AppTask_STK_SIZE, /* 任务栈大小 */
(void * ) NULL, /* 任务入口函数参数 */
(UBaseType_t ) AppTask_TASK_PRIO, /* 任务优先级 */
(TaskHandle_t *) &AppTaskCreate_Handle);/* 任务控制块指针(句柄) */
if(xReturn == pdTRUE)/* 检测任务是否创建成功 */
{ printf("任务AppTaskCreate创建成功,开启任务调度!\r\n"); }
else{return -1;}
vTaskStartScheduler();/* 启动任务，开启调度 */
while(1); /* 正常不会执行到这里用于判断是否调度出错 */
}
/***********************************************************************
* @ 函数名： AppTaskCreate
* @ 功能说明：为了方便管理，所有的任务创建函数都放在这个函数里面
* @ 参数：无
* @ 返回值：无
**********************************************************************/
static void AppTaskCreate(void)
{
BaseType_t xReturn = pdTRUE; /* 定义一个创建信息返回值，默认为pdTRUE */
taskENTER_CRITICAL(); /* 进入临界段防止创建多个任务被打断 */
xReturn = xTaskCreate( (TaskFunction_t) Work_Task, /* 任务入口函数 */
(const char * ) "Work_Task", /* 任务名称 */
(uint16_t ) Work_STK_SIZE, /* 任务栈大小 */
(void * ) NULL, /* 任务入口函数参数 */
(UBaseType_t ) Work_TASK_PRIO, /* 任务优先级 */
(TaskHandle_t *) &Work_TaskHandle); /* 任务控制块指针(句柄) */
if(xReturn == pdPASS){ printf("创建任务Work_Task成功!\r\n"); }/* 检测任务是否创建成功 */
else{printf("创建任务Work_Task失败!\r\n");}
// xReturn = xTaskCreate( (TaskFunction_t) KEY_Task, /* 任务入口函数 */
// (const char * ) "KEY_Task", /* 任务名称 */
// (uint16_t ) KEY_STK_SIZE, /* 任务栈大小 */
// (void * ) NULL, /* 任务入口函数参数 */
// (UBaseType_t ) KEY_TASK_PRIO, /* 任务优先级 */
// (TaskHandle_t *) &KEY_TaskHandle); /* 任务控制块指针(句柄) */
// if(xReturn == pdPASS){ printf("创建任务KEY_Task成功!\r\n"); }/* 检测任务是否创建成功 */
// else{printf("创建任务KEY_Task失败!\r\n");}
vTaskDelete(AppTaskCreate_Handle);/* 删除AppTaskCreate任务 */
taskEXIT_CRITICAL(); /* 退出临界段开始正常执行程序 */
}
/***********************************************************************
* @ 函数名： Work_Task
* @ 功能说明：任务的相关操作信息调试任务
* @ 参数：无
* @ 返回值：无
**********************************************************************/
static void Work_Task(void* parameter)
{
// BaseType_t xReturn = pdTRUE; /* 定义一个创建信息返回值，默认为pdTRUE */
while(1)
{
MPU6050_AppWork();
vTaskDelay(1); //延时10个Tick 启动调度
}
}
/***********************************************************************
* @ 函数名： EventSet_Task
* @ 功能说明：任务的相关操作信息调试任务
* @ 参数：无
* @ 返回值：无
**********************************************************************/
//static void Receive2_Task(void* parameter)
//{
// BaseType_t xReturn = pdTRUE; /* 定义一个创建信息返回值，默认为pdTRUE */
// while(1)
// {
// LED2_TOGGLE;
// vTaskDelay(10); /* 任务延时10个tick 启动调度器 */
// }
//}
/***********************************************************************
* @ 函数名： KEY_Task
* @ 功能说明：读取按键控制相关任务挂起还是恢复
* @ 参数：无
* @ 返回值：无
**********************************************************************/
//static void KEY_Task(void *parameter)
//{
// BaseType_t xReturn = pdTRUE; /* 定义一个创建信息返回值，默认为pdTRUE */
// while(1)
// {//按键扫描判断
// if( Key_Scan(KEY1_GPIO_PORT,KEY1_GPIO_PIN) == KEY_ON)//KEY1
// {
// printf ( "KEY1被按下\n" );
// LED2_TOGGLE;
// }
//
// if( Key_Scan(KEY2_GPIO_PORT,KEY2_GPIO_PIN) == KEY_ON)//KEY2
// {
// printf ( "KEY2被按下\n" );
// LED3_TOGGLE;
// }
// vTaskDelay(10); /* 任务延时10个tick 启动调度器 */
// }
//}
/***********************************************************************
* @ 函数名： BSP_Init
* @ 功能说明：硬件初始化
* @ 参数：无
* @ 返回值：无
**********************************************************************/
void BSP_Init(void)
{ BaseType_t xReturn = pdTRUE; /* 定义一个创建信息返回值，默认为pdTRUE */
/*
* STM32中断优先级分组为4，即4bit都用来表示抢占优先级，范围为：0~15
* 优先级分组只需要分组一次即可，以后如果有其他的任务需要用到中断，
* 都统一用这个优先级分组，千万不要再分组，切忌。
*/
NVIC_PriorityGroupConfig( NVIC_PriorityGroup_4 );
/* 延时函数初始化 */
delay_init();
/* LED初始化 */
LED_GPIO_Config();
/* KEY按键初始化 */
Key_GPIO_Config();
/* 串口1初始化-->调试打印 */
uart_init(115200);/* 正点原子驱动 */
/* 串口2初始化-->匿名4轴上位机使用 */
USART_Config();/* 野火驱动 */
/* TIM1的PWM输出CH1-CH1N BDT刹车通道初始化 */
ADVANCE_TIM_Init();
/* 初始化MPU6050 GPIO等 */
xReturn = MPU_Init();
printf("MPU6050_Init:%ld\r\n",xReturn);
/* mpu6050,dmp初始化及检测 */
xReturn = mpu_dmp_init();
printf("MPU6050dmp初始化:%ld\r\n",xReturn);
}
/********************************END OF FILE****************************/

复制代码

Keil代码下载:

D3球形机器人(10).7z (371.77 KB, 下载次数: 58)

ID:962202 · 发表于 2024-4-22 09:45

谢分享了,

帐号		自动登录	找回密码
密码			立即注册

自己移植的FreeRTOS+MPU6050姿态测试代码

评分