void ModeStabilize_Run(void) { float target_roll, target_pitch; float target_yaw_rate; float pilot_throttle_scaled; // if not armed set throttle to zero and exit immediately如果没有武装,将油门设置为零并立即退出 if (!ACMotors_armed_state() || tACFlags.throttle_zero) { zero_throttle_and_relax_ac(); return; } // clear landing flag LandDetector_SetLandComplete(false); ACMotors_set_desired_spool_state(DESIRED_THROTTLE_UNLIMITED); // apply SIMPLE mode transform to pilot inputs // update_simple_mode(); // convert pilot input to lean angles将飞行员输入转换为倾斜角度 get_pilot_desired_lean_angles(&target_roll, &target_pitch, tAttitudeContorl.tParam.angle_max, tAttitudeContorl.tParam.angle_max); // get pilot's desired yaw rate target_yaw_rate = get_pilot_desired_yaw_rate(ApmData_GetControlIn_Yaw()); // get pilot's desired throttle pilot_throttle_scaled = get_pilot_desired_throttle(ApmData_GetControlIn_Throttle()); // call attitude controller AttCtrl_input_euler_angle_roll_pitch_euler_rate_yaw(target_roll, target_pitch, target_yaw_rate); // body-frame rate controller is run directly from 100hz loop // output pilot's throttle AttCtrl_set_throttle_out(pilot_throttle_scaled, true, 0.0f); }

时间: 2024-04-21 15:29:15 浏览: 274
ZIP

DCM.zip_IMU_PITCH_roll_dcm_pitch roll

这段代码是一个姿态控制器的函数,主要功能是控制飞行器姿态稳定。具体来看: - target_roll、target_pitch、target_yaw_rate和pilot_throttle_scaled都是float类型的变量,用于存储目标倾斜角、目标偏航速率和飞行员期望油门值。 - 如果飞行器没有武装或者油门值为零,则将油门值设置为零并立即退出函数。 - LandDetector_SetLandComplete(false)用于清除降落标志。 - ACMotors_set_desired_spool_state(DESIRED_THROTTLE_UNLIMITED)将电机的期望油门值设置为不限制。 - get_pilot_desired_lean_angles()函数用于将飞行员的输入转换为目标倾斜角度。 - get_pilot_desired_yaw_rate()函数用于获取飞行员的期望偏航速率。 - get_pilot_desired_throttle()函数用于获取飞行员的期望油门值。 - AttCtrl_input_euler_angle_roll_pitch_euler_rate_yaw()函数用于调用姿态控制器,传入目标倾斜角、目标偏航速率等参数。 - AttCtrl_set_throttle_out()函数用于输出期望的油门值。 总的来说,这段代码实现了飞行器的姿态稳定控制,将飞行员的输入转换为目标倾斜角度、期望偏航速率和期望油门值,并通过姿态控制器控制飞行器姿态,将期望油门值输出。
阅读全文

相关推荐

bool MoveObject::goObject() { //connet to the Server, 5s limit while (!move_base.waitForServer(ros::Duration(5.0))) { ROS_INFO("Waiting for move_base action server..."); } ROS_INFO("Connected to move base server"); /t the targetpose move_base_msgs::MoveBaseGoal goal; goal.target_pose.header.frame_id = "map"; goal.target_pose.header.stamp = ros::Time::now(); target_odom_point.pose.pose.position.x=Obj_pose.pose.position.x; target_odom_point.pose.pose.position.y=Obj_pose.pose.position.y; cout << goal.target_pose.pose.position.x << endl; cout << goal.target_pose.pose.position.y << endl; //goal.target_pose.pose.orientation = tf::createQuaternionMsgFromYaw(g.response.yaw); //goal.target_pose.pose.orientation.z = 0.0; //goal.target_pose.pose.orientation.w = 1.0; double roll,pitch,yaw; tf::quaternionMsgToTF(target_odom_point.pose.orientation, quat); tf::Matrix3x3(quat).getRPY(roll, pitch, yaw);//进行转换 if(yaw>3.14) { yaw -=2*PI;//旋转 target_odom_point.pose.position.x -=keep_distance*cos(yaw); target_odom_point.pose.position.y -=keep_distance*sin(yaw); goal.target_pose.pose.position.x=target_odom_point.pose.pose.position.x goal.target_pose.pose.position.y=target_odom_point.pose.pose.position.y target_odom_point.pose.orientation = tf::createQuaternionMsgFromYaw(yaw); goal.target_pose.pose.orientation.w= target_odom_point.pose.orientation goal.target_pose.pose.orientation.z = 0 //map坐标系下的Z轴 ROS_INFO("Sending goal"); move_base.sendGoal(goal); } move_base.waitForResult(); if (move_base.getState() == actionlib::SimpleClientGoalState::SUCCEEDED) { ROS_INFO("Goal succeeded!"); return true; } else { ROS_INFO("Goal failed"); return false; } }

最新推荐

recommend-type

PCBM_LP_Viewer的使用

慢慢选,查数据手册,例如PIN数量:272个,PIN间距pitch 1.27mm,20行20列,长27.00mm宽27.00mm,高2.54mm,OK就是它,点中【view】按钮。 5. 好的,很直观的显示出此封装的几何信息。 6. OK接近成功,点【Wizard】...
recommend-type

IMX225-Data_Sheet.pdf

* CDS / PGA函数0 dB to 30 dB:模拟增益30 dB(步进pitch 0.1 dB)30.1 dB to 72 dB:模拟增益30 dB + 数字增益0.1 to 42 dB(步进pitch 0.1 dB) * 支持I/O切换CMOS逻辑并行SDR输出低电压LVDS(150 m Vp-p)串行...
recommend-type

IMX327LQR-C_TechnicalDatasheet_E_Rev0.2.pdf

◆ CDS/PGA函数:0 dB到27 dB:模拟增益27 dB(步进pitch 0.3 dB)、27.3 dB到69 dB:模拟增益27 dB + 数字增益0.3到42 dB(步进pitch 0.3 dB) ◆ 支持I/O切换:低电压LVDS(150 m Vp-p)串行(2 ch / 4 ch 切换)...
recommend-type

H22-DTS-014-0.1_Ambarella_H22V75_Datasheet.pdf

6. 小巧的369针WFBGa封装:芯片采用369针WFBGa封装,尺寸为14mm x 14mm,pitch为0.65mm。 7. 低功耗设计:H22V75芯片采用14nm CMOS低功耗技术,能够满足低功耗应用的需求。 8. 广泛的工作温度:芯片的工作温度范围为...
recommend-type

Java毕业设计项目:校园二手交易网站开发指南

资源摘要信息:"Java是一种高性能、跨平台的面向对象编程语言,由Sun Microsystems(现为Oracle Corporation)的James Gosling等人在1995年推出。其设计理念是为了实现简单性、健壮性、可移植性、多线程以及动态性。Java的核心优势包括其跨平台特性,即“一次编写,到处运行”(Write Once, Run Anywhere),这得益于Java虚拟机(JVM)的存在,它提供了一个中介,使得Java程序能够在任何安装了相应JVM的设备上运行,无论操作系统如何。 Java是一种面向对象的编程语言,这意味着它支持面向对象编程(OOP)的三大特性:封装、继承和多态。封装使得代码模块化,提高了安全性;继承允许代码复用,简化了代码的复杂性;多态则增强了代码的灵活性和扩展性。 Java还具有内置的多线程支持能力,允许程序同时处理多个任务,这对于构建服务器端应用程序、网络应用程序等需要高并发处理能力的应用程序尤为重要。 自动内存管理,特别是垃圾回收机制,是Java的另一大特性。它自动回收不再使用的对象所占用的内存资源,这样程序员就无需手动管理内存,从而减轻了编程的负担,并减少了因内存泄漏而导致的错误和性能问题。 Java广泛应用于企业级应用开发、移动应用开发(尤其是Android平台)、大型系统开发等领域,并且有大量的开源库和框架支持,例如Spring、Hibernate、Struts等,这些都极大地提高了Java开发的效率和质量。 标签中提到的Java、毕业设计、课程设计和开发,意味着文件“毕业设计---社区(校园)二手交易网站.zip”中的内容可能涉及到Java语言的编程实践,可能是针对学生的课程设计或毕业设计项目,而开发则指出了这些内容的具体活动。 在文件名称列表中,“SJT-code”可能是指该压缩包中包含的是一个特定的项目代码,即社区(校园)二手交易网站的源代码。这类网站通常需要实现用户注册、登录、商品发布、浏览、交易、评价等功能,并且需要后端服务器支持,如数据库连接和事务处理等。考虑到Java的特性,网站的开发可能使用了Java Web技术栈,如Servlet、JSP、Spring Boot等,以及数据库技术,如MySQL或MongoDB等。"
recommend-type

管理建模和仿真的文件

管理Boualem Benatallah引用此版本:布阿利姆·贝纳塔拉。管理建模和仿真。约瑟夫-傅立叶大学-格勒诺布尔第一大学,1996年。法语。NNT:电话:00345357HAL ID:电话:00345357https://theses.hal.science/tel-003453572008年12月9日提交HAL是一个多学科的开放存取档案馆,用于存放和传播科学研究论文,无论它们是否被公开。论文可以来自法国或国外的教学和研究机构,也可以来自公共或私人研究中心。L’archive ouverte pluridisciplinaire
recommend-type

【MVC标准化:肌电信号处理的终极指南】:提升数据质量的10大关键步骤与工具

![MVC标准化](https://img-blog.csdn.net/20160221141956498) # 摘要 MVC标准化是肌电信号处理中确保数据质量的重要步骤,它对于提高测量结果的准确性和可重复性至关重要。本文首先介绍肌电信号的生理学原理和MVC标准化理论,阐述了数据质量的重要性及影响因素。随后,文章深入探讨了肌电信号预处理的各个环节,包括噪声识别与消除、信号放大与滤波技术、以及基线漂移的校正方法。在提升数据质量的关键步骤部分,本文详细描述了信号特征提取、MVC标准化的实施与评估,并讨论了数据质量评估与优化工具。最后,本文通过实验设计和案例分析,展示了MVC标准化在实践应用中的具
recommend-type

能否提供一个在R语言中执行Framingham数据集判别分析的详细和完整的代码示例?

当然可以。在R语言中,Framingham数据集是一个用于心血管疾病研究的经典数据集。以下是使用`ggfortify`包结合` factoextra`包进行判别分析的一个基本步骤: 首先,你需要安装所需的库,如果尚未安装,可以使用以下命令: ```r install.packages(c("ggfortify", "factoextra")) ``` 然后加载所需的数据集并做预处理。Framingham数据集通常存储在`MASS`包中,你可以通过下面的代码加载: ```r library(MASS) data(Framingham) ``` 接下来,我们假设你已经对数据进行了适当的清洗和转换
recommend-type

Blaseball Plus插件开发与构建教程

资源摘要信息:"Blaseball Plus" Blaseball Plus是一个与游戏Blaseball相关的扩展项目,该项目提供了一系列扩展和改进功能,以增强Blaseball游戏体验。在这个项目中,JavaScript被用作主要开发语言,通过在package.json文件中定义的脚本来完成构建任务。项目说明中提到了开发环境的要求,即在20.09版本上进行开发,并且提供了一个flake.nix文件来复制确切的构建环境。虽然Nix薄片是一项处于工作状态(WIP)的功能且尚未完全记录,但可能需要用户自行安装系统依赖项,其中列出了Node.js和纱(Yarn)的特定版本。 ### 知识点详细说明: #### 1. Blaseball游戏: Blaseball是一个虚构的棒球游戏,它在互联网社区中流行,其特点是独特的规则、随机事件和社区参与的元素。 #### 2. 扩展开发: Blaseball Plus是一个扩展,它可能是为在浏览器中运行的Blaseball游戏提供额外功能和改进的软件。扩展开发通常涉及编写额外的代码来增强现有软件的功能。 #### 3. JavaScript编程语言: JavaScript是一种高级的、解释执行的编程语言,被广泛用于网页和Web应用的客户端脚本编写,是开发Web扩展的关键技术之一。 #### 4. package.json文件: 这是Node.js项目的核心配置文件,用于声明项目的各种配置选项,包括项目名称、版本、依赖关系以及脚本命令等。 #### 5.构建脚本: 描述中提到的脚本,如`build:dev`、`build:prod:unsigned`和`build:prod:signed`,这些脚本用于自动化构建过程,可能包括编译、打包、签名等步骤。`yarn run`命令用于执行这些脚本。 #### 6. yarn包管理器: Yarn是一个快速、可靠和安全的依赖项管理工具,类似于npm(Node.js的包管理器)。它允许开发者和项目管理依赖项,通过简单的命令行界面可以轻松地安装和更新包。 #### 7. Node.js版本管理: 项目要求Node.js的具体版本,这里是14.9.0版本。管理特定的Node.js版本是重要的,因为在不同版本间可能会存在API变化或其他不兼容问题,这可能会影响扩展的构建和运行。 #### 8. 系统依赖项的安装: 文档提到可能需要用户手动安装系统依赖项,这在使用Nix薄片时尤其常见。Nix薄片(Nix flakes)是一个实验性的Nix特性,用于提供可复现的开发环境和构建设置。 #### 9. Web扩展的工件放置: 构建后的工件放置在`addon/web-ext-artifacts/`目录中,表明这可能是一个基于WebExtension的扩展项目。WebExtension是一种跨浏览器的扩展API,用于创建浏览器扩展。 #### 10. 扩展部署: 描述中提到了两种不同类型的构建版本:开发版(dev)和生产版(prod),其中生产版又分为未签名(unsigned)和已签名(signed)版本。这些不同的构建版本用于不同阶段的开发和发布。 通过这份文档,我们能够了解到Blaseball Plus项目的开发环境配置、构建脚本的使用、依赖管理工具的运用以及Web扩展的基本概念和部署流程。这些知识点对于理解JavaScript项目开发和扩展构建具有重要意义。
recommend-type

"互动学习:行动中的多样性与论文攻读经历"

多样性她- 事实上SCI NCES你的时间表ECOLEDO C Tora SC和NCESPOUR l’Ingén学习互动,互动学习以行动为中心的强化学习学会互动,互动学习,以行动为中心的强化学习计算机科学博士论文于2021年9月28日在Villeneuve d'Asq公开支持马修·瑟林评审团主席法布里斯·勒菲弗尔阿维尼翁大学教授论文指导奥利维尔·皮耶昆谷歌研究教授:智囊团论文联合主任菲利普·普雷教授,大学。里尔/CRISTAL/因里亚报告员奥利维耶·西格德索邦大学报告员卢多维奇·德诺耶教授,Facebook /索邦大学审查员越南圣迈IMT Atlantic高级讲师邀请弗洛里安·斯特鲁布博士,Deepmind对于那些及时看到自己错误的人...3谢谢你首先,我要感谢我的两位博士生导师Olivier和Philippe。奥利维尔,"站在巨人的肩膀上"这句话对你来说完全有意义了。从科学上讲,你知道在这篇论文的(许多)错误中,你是我可以依