我是靠谱客的博主 还单身小鸭子,最近开发中收集的这篇文章主要介绍(8/10)stabilizerTask; /*姿态处理任务*/(未完成)前言一、stabilizerTask二、使用步骤总结,觉得挺不错的,现在分享给大家,希望可以做个参考。
概述
文章目录
前言
对MiniFly的 xTaskCreate(stabilizerTask, "STABILIZER", 450, NULL, 5, NULL) 姿态管理任务进行理解。
一、stabilizerTask
void stabilizerTask(void* param)
{
u32 tick = 0;
u32 lastWakeTime = getSysTickCnt();
ledseqRun(SYS_LED, seq_alive);
while(!sensorsAreCalibrated())
{
vTaskDelayUntil(&lastWakeTime, MAIN_LOOP_DT);//实现1ms周期运行
}
while(1)
{
vTaskDelayUntil(&lastWakeTime, MAIN_LOOP_DT); /**/
//»ñÈ¡6ÖáºÍÆøѹÊý¾Ý£¨500Hz£©
if (RATE_DO_EXECUTE(RATE_500_HZ, tick))
{
sensorsAcquire(&sensorData, tick); /*»ñÈ¡6ÖáºÍÆøѹÊý¾Ý*/
}
//ËÄÔªÊýºÍÅ·À½Ç¼ÆË㣨250Hz£©
if (RATE_DO_EXECUTE(ATTITUDE_ESTIMAT_RATE, tick))
{
imuUpdate(sensorData.acc, sensorData.gyro, &state, ATTITUDE_ESTIMAT_DT);
}
//λÖÃÔ¤¹À¼ÆË㣨250Hz£©
if (RATE_DO_EXECUTE(POSITION_ESTIMAT_RATE, tick))
{
positionEstimate(&sensorData, &state, POSITION_ESTIMAT_DT);
}
//Ä¿±ê×Ë̬ºÍ·ÉÐÐģʽÉ趨£¨100Hz£©
if (RATE_DO_EXECUTE(RATE_100_HZ, tick))
{
commanderGetSetpoint(&setpoint, &state); /*Ä¿±êÊý¾ÝºÍ·ÉÐÐģʽÉ趨*/
}
if (RATE_DO_EXECUTE(RATE_250_HZ, tick))
{
fastAdjustPosZ(); /*¿ìËÙµ÷Õû¸ß¶È*/
}
/*¶ÁÈ¡¹âÁ÷Êý¾Ý(100Hz)*/
if (RATE_DO_EXECUTE(RATE_100_HZ, tick))
{
getFlowData(&state);
}
/*·¹ö¼ì²â(500Hz) ·Ç¶¨µãģʽ*/
if (RATE_DO_EXECUTE(RATE_500_HZ, tick) && (getCommanderCtrlMode() != 0x03))
{
flyerFlipCheck(&setpoint, &control, &state);
}
/*Òì³£¼ì²â*/
anomalDetec(&sensorData, &state, &control);
/*PID¿ØÖÆ*/
stateControl(&control, &sensorData, &state, &setpoint, tick);
//¿ØÖƵç»úÊä³ö£¨500Hz£©
if (RATE_DO_EXECUTE(RATE_500_HZ, tick))
{
powerControl(&control);
}
tick++;
}
}
二、使用步骤
1.引入库
代码如下(示例):
import numpy as np import pandas as pd import matplotlib.pyplot as plt import seaborn as sns import warnings warnings.filterwarnings('ignore') import ssl ssl._create_default_https_context = ssl._create_unverified_context
2.读入数据
代码如下(示例):
data = pd.read_csv( 'https://labfile.oss.aliyuncs.com/courses/1283/adult.data.csv') print(data.head())
该处使用的url网络请求的数据。
总结
提示:这里对文章进行总结:
例如:以上就是今天要讲的内容,本文仅仅简单介绍了pandas的使用,而pandas提供了大量能使我们快速便捷地处理数据的函数和方法。
最后
以上就是还单身小鸭子为你收集整理的(8/10)stabilizerTask; /*姿态处理任务*/(未完成)前言一、stabilizerTask二、使用步骤总结的全部内容,希望文章能够帮你解决(8/10)stabilizerTask; /*姿态处理任务*/(未完成)前言一、stabilizerTask二、使用步骤总结所遇到的程序开发问题。
如果觉得靠谱客网站的内容还不错,欢迎将靠谱客网站推荐给程序员好友。
本图文内容来源于网友提供,作为学习参考使用,或来自网络收集整理,版权属于原作者所有。
发表评论 取消回复