GAZEBO仿真+offboard模式偏航角控制

已于 2024-05-27 17:15:55 修改
阅读量832 收藏 17
点赞数 3
文章标签： 无人机
于 2023-09-07 15:21:53 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/2301_76165902/article/details/132724665
版权

offboard代码部分

承接上篇博客的代码,只需要开启改变偏航角的参数

setpoint.type_mask =			//使用位置控制
//mavros_msgs::PositionTarget::IGNORE_PX |
//mavros_msgs::PositionTarget::IGNORE_PY |
//mavros_msgs::PositionTarget::IGNORE_PZ |
mavros_msgs::PositionTarget::IGNORE_VX |
mavros_msgs::PositionTarget::IGNORE_VY |
mavros_msgs::PositionTarget::IGNORE_VZ |
mavros_msgs::PositionTarget::IGNORE_AFX |
mavros_msgs::PositionTarget::IGNORE_AFY |
mavros_msgs::PositionTarget::IGNORE_AFZ |
mavros_msgs::PositionTarget::FORCE |
mavros_msgs::PositionTarget::IGNORE_YAW;
mavros_msgs::PositionTarget::IGNORE_YAW_RATE;

最后两个参数为控制偏航角的参数

YAW为设定目标偏航角 (弧度)

YAW_RATE为设定偏航角速度

想要使用哪个就把哪个注释掉就行了.

代码

#include <ros/ros.h>
#include <tf/LinearMath/Quaternion.h>
#include <tf/LinearMath/Vector3.h>
#include <tf/LinearMath/Matrix3x3.h>
#include <geometry_msgs/PoseStamped.h>  
#include <mavros_msgs/CommandBool.h> 
#include <mavros_msgs/SetMode.h>     
#include <mavros_msgs/State.h>
#include <mavros_msgs/PositionTarget.h>
#include <geometry_msgs/TwistStamped.h>
#include <sensor_msgs/Imu.h>

double roll,pitch,yaw = 0, target_yaw = 0, diff_angle = 0, err_yaw = 0,err_yaw0 = 0, err_yaw_err = 0;

typedef struct
{	
	float kp = 0.88;              //比例系数
	float ki = 0.0002;              //积分系数
	float kd = 1.68;              //微分系数
	
	float err_I_lim = 500;		//积分限幅值
	
	float errx_Now,errx_old_Last,errx_old_LLast;           //当前偏差,上一次偏差,上上次偏差
	float erry_Now,erry_old_Last,erry_old_LLast;
	float errz_Now,errz_old_Last,errz_old_LLast;
	float errax_Now,errax_old_Last,errax_old_LLast;           //当前偏差,上一次偏差,上上次偏差
	float erray_Now,erray_old_Last,erray_old_LLast;
	float erraz_Now,erraz_old_Last,erraz_old_LLast;
	

	float errx_p,errx_i,errx_d;
	float erry_p,erry_i,erry_d;
	float errz_p,errz_i,errz_d;
	float errax_p,errax_i,errax_d;
	float erray_p,erray_i,erray_d;
	float erraz_p,erraz_i,erraz_d;		
	
	float CtrOutx,CtrOuty,CtrOutz;          //控制增量输出
 	float CtrOutax,CtrOutay,CtrOutaz; 

        float OUTLIM = 0;		//输出限幅
	
}PID;
PID H;


mavros_msgs::State current_state;
mavros_msgs::PositionTarget setpoint; // 位置速度控制消息类
geometry_msgs::TwistStamped vel_msg;
void state_cb(const mavros_msgs::State::ConstPtr& msg){
    current_state = *msg;
}
// 订阅的无人机当前位置数据
geometry_msgs::PoseStamped local_pos;
void local_pos_cb(const geometry_msgs::PoseStamped::ConstPtr &msg)
{
	local_pos = *msg;
}
void  vel_cb(const geometry_msgs::TwistStamped::ConstPtr &msg)
{
	vel_msg = *msg;
}
void yaw_cb(sensor_msgs::Imu msg)
{
	tf::Quaternion quaternion(
        msg.orientation.x,
        msg.orientation.y,
        msg.orientation.z,
        msg.orientation.w
        );

	
    tf::Matrix3x3(quaternion).getRPY(roll,pitch,yaw);
    roll = roll*180/M_PI;
    pitch = pitch*180/M_PI;
    yaw = yaw*180/M_PI;

    //ROS_INFO("roll: %.0f ,pitch: %.0f  , yaw: %.0f",roll,pitch,yaw);  
}
void vec_pid(float pose_x,float pose_y,float pose_z,float limt)
{
	H.errx_Now = pose_x - local_pos.pose.position.x;
	H.errx_p = H.errx_Now;
	H.errx_i = H.errx_Now + H.errx_i;
	H.errx_d = H.errx_Now - H.errx_old_Last + H.errx_old_Last - H.errx_old_LLast;
	H.erry_Now = pose_y - local_pos.pose.position.y;
	H.erry_p = H.erry_Now;
	H.erry_i = H.erry_Now + H.erry_i;
	H.erry_d = H.erry_Now - H.erry_old_Last + H.erry_old_Last - H.erry_old_LLast;
	H.errz_Now = pose_z - local_pos.pose.position.z;
	H.errz_p = H.errz_Now;
	H.errz_i = H.errz_Now + H.errz_i;
	H.errz_d = H.errz_Now - H.errz_old_Last + H.errz_old_Last - H.errz_old_LLast;

	H.errx_old_LLast = H.errx_old_Last;
	H.errx_old_Last = H.errx_Now;
	H.erry_old_LLast = H.erry_old_Last;
	H.erry_old_Last = H.erry_Now;	
	H.errz_old_LLast = H.errz_old_Last;
	H.errz_old_Last = H.errz_Now;	
	
	//积分限幅
	if(H.errx_i > H.err_I_lim)	H.errx_i = H.err_I_lim;		
	if(H.errx_i < -H.err_I_lim)	H.errx_i = -H.err_I_lim;
	if(H.erry_i > H.err_I_lim)	H.erry_i = H.err_I_lim;		
	if(H.erry_i < -H.err_I_lim)	H.erry_i = -H.err_I_lim;
	if(H.errz_i > H.err_I_lim)	H.errz_i = H.err_I_lim;		
	if(H.errz_i < -H.err_I_lim)	H.errz_i = -H.err_I_lim;

	H.CtrOutx = H.errx_p*H.kp + H.errx_i*H.ki + H.errx_d*H.kd;
	H.CtrOuty = H.erry_p*H.kp + H.erry_i*H.ki + H.erry_d*H.kd;
	H.CtrOutz = H.errz_p*H.kp + H.errz_i*H.ki + H.errz_d*H.kd;	

	
	H.OUTLIM = limt;
	if(H.OUTLIM != 0)
	{
		if(H.CtrOutx > H.OUTLIM)		H.CtrOutx = H.OUTLIM;
		if(H.CtrOutx < -H.OUTLIM)		H.CtrOutx = -H.OUTLIM;
		if(H.CtrOuty > H.OUTLIM)		H.CtrOuty = H.OUTLIM;
		if(H.CtrOuty < -H.OUTLIM)		H.CtrOuty = -H.OUTLIM;
	}	
	
 	//setpoint.velocity.x = H.CtrOutx;
  	//setpoint.velocity.y = H.CtrOuty;
	//setpoint.velocity.z = H.CtrOutz;
}

void acc_pid(float vel_x,float vel_y, float vel_z)
{
	H.errax_Now = vel_x - vel_msg.twist.linear.x;
	H.errax_p = H.errax_Now;
	H.errax_i = H.errax_Now + H.errax_i;
	H.errax_d = H.errax_Now - H.errax_old_Last + H.errax_old_Last - H.errax_old_LLast;
	H.erray_Now = vel_y - vel_msg.twist.linear.y;
	H.erray_p = H.erray_Now;
	H.erray_i = H.erray_Now + H.erray_i;
	H.erray_d = H.erray_Now - H.erray_old_Last + H.erray_old_Last - H.erray_old_LLast;
	H.erraz_Now = vel_z - vel_msg.twist.linear.z;
	H.erraz_p = H.erraz_Now;
	H.erraz_i = H.erraz_Now + H.erraz_i;
	H.erraz_d = H.erraz_Now - H.erraz_old_Last + H.erraz_old_Last - H.erraz_old_LLast;

	H.errx_old_LLast = H.errx_old_Last;
	H.errx_old_Last = H.errx_Now;
	H.erry_old_LLast = H.erry_old_Last;
	H.erry_old_Last = H.erry_Now;	
	H.errz_old_LLast = H.errz_old_Last;
	H.errz_old_Last = H.errz_Now;	
	
	H.CtrOutax = H.errax_p*H.kp + H.errax_i*H.ki + H.errax_d*H.kd;
	H.CtrOutay = H.erray_p*H.kp + H.erray_i*H.ki + H.erray_d*H.kd;
	H.CtrOutaz = H.erraz_p*H.kp + H.erraz_i*H.ki + H.erraz_d*H.kd;

	//setpoint.acceleration_or_force.x = H.CtrOutax;
  	//setpoint.acceleration_or_force.y = H.CtrOutay;
	//setpoint.acceleration_or_force.z = H.CtrOutaz;
	
}
int main(int argc, char **argv)
{
setlocale(LC_ALL, "");

ros::init(argc, argv, "offb_node"); //ros初始化，最后一个参数为节点名称
ros::NodeHandle nh;


//订阅。<>里面为模板参数，传入的是订阅的消息体类型，（）里面传入三个参数，分别是该消息体的位置、缓存大小（通常为10）、回调函数
ros::Subscriber state_sub = nh.subscribe<mavros_msgs::State>("mavros/state", 10, state_cb);
ros::Subscriber local_pos_sub = nh.subscribe<geometry_msgs::PoseStamped>("mavros/local_position/pose", 10, local_pos_cb);//订阅位置信息
ros::Subscriber vel_sub = nh.subscribe<geometry_msgs::TwistStamped>("mavros/local_position/velocity_local", 10, vel_cb);//订阅速度信息
ros::Subscriber yaw_sub = nh.subscribe<sensor_msgs::Imu>("mavros/imu/data", 10, yaw_cb);//订阅无人机imu数据

ros::Publisher setpoint_pub = nh.advertise<mavros_msgs::PositionTarget>("mavros/setpoint_raw/local", 10);//控制话题,可以发布位置速度加速度同时控制

ros::ServiceClient arming_client = nh.serviceClient<mavros_msgs::CommandBool>("mavros/cmd/arming");

ros::ServiceClient set_mode_client = nh.serviceClient<mavros_msgs::SetMode>("mavros/set_mode");
 
ros::Rate rate(20.0);
 
while(ros::ok() && !current_state.connected){
    ros::spinOnce();
    rate.sleep();
}
setpoint.header.stamp = ros::Time::now();	//存储ROS中的时间戳信息
setpoint.coordinate_frame = mavros_msgs::PositionTarget::FRAME_LOCAL_NED;
setpoint.type_mask =			//使用位置控制
//mavros_msgs::PositionTarget::IGNORE_PX |
//mavros_msgs::PositionTarget::IGNORE_PY |
//mavros_msgs::PositionTarget::IGNORE_PZ |
mavros_msgs::PositionTarget::IGNORE_VX |
mavros_msgs::PositionTarget::IGNORE_VY |
mavros_msgs::PositionTarget::IGNORE_VZ |
mavros_msgs::PositionTarget::IGNORE_AFX |
mavros_msgs::PositionTarget::IGNORE_AFY |
mavros_msgs::PositionTarget::IGNORE_AFZ |
mavros_msgs::PositionTarget::FORCE |
mavros_msgs::PositionTarget::IGNORE_YAW |
mavros_msgs::PositionTarget::IGNORE_YAW_RATE;
setpoint.position.x = 0;
setpoint.position.y = 0;
setpoint.position.z = 0;

for(int i = 100; ros::ok() && i > 0; --i){
	setpoint_pub.publish(setpoint);
       ros::spinOnce();
       rate.sleep();
}

mavros_msgs::SetMode offb_set_mode;
offb_set_mode.request.custom_mode = "OFFBOARD";

//设定无人机保护模式 POSTION
mavros_msgs::SetMode offb_setPS_mode;
offb_setPS_mode.request.custom_mode = "POSCTL";

mavros_msgs::CommandBool arm_cmd;
arm_cmd.request.value = true;
 
ros::Time last_request = ros::Time::now();

//ROS_INFO("UAV 启动!");
int step = 0;
int sametimes = 0;

while(ros::ok())//进入大循环
{
  if (current_state.mode != "OFFBOARD" && (ros::Time::now() - last_request > ros::Duration(5.0)))
	{
		if (set_mode_client.call(offb_setPS_mode) && offb_setPS_mode.response.mode_sent)
		{
			ROS_INFO("POSTION PROTECTED");
		}
		last_request = ros::Time::now();
	}
	else
	{
        if( !current_state.armed && (ros::Time::now() - last_request > ros::Duration(5.0)))
        {
            if( arming_client.call(arm_cmd) && arm_cmd.response.success)
            {
		ROS_INFO("UAV 启动!");               
            }
            last_request = ros::Time::now();
        }
	else
	{
		switch(step)
		{
			case 0:
				setpoint.position.x = 0;
				setpoint.position.y = 0;
				setpoint.position.z = 2;
				if (local_pos.pose.position.z > 1.9 && local_pos.pose.position.z < 2.1)
                  		{
     		  	                if (sametimes > 20)
              				{
         		                   step = 1;
                        		}
                        		else
                           		sametimes++;
                    			}
                    			else sametimes = 0;
	 	                break;
			case 1:
				//先用角速度控制
				setpoint.type_mask =			
				//mavros_msgs::PositionTarget::IGNORE_PX |
				//mavros_msgs::PositionTarget::IGNORE_PY |
				//mavros_msgs::PositionTarget::IGNORE_PZ |
				mavros_msgs::PositionTarget::IGNORE_VX |
				mavros_msgs::PositionTarget::IGNORE_VY |
				mavros_msgs::PositionTarget::IGNORE_VZ |
				mavros_msgs::PositionTarget::IGNORE_AFX |
				mavros_msgs::PositionTarget::IGNORE_AFY |
				mavros_msgs::PositionTarget::IGNORE_AFZ |
				mavros_msgs::PositionTarget::FORCE |
				mavros_msgs::PositionTarget::IGNORE_YAW;
				//mavros_msgs::PositionTarget::IGNORE_YAW_RATE;
				target_yaw = 90;
				ROS_INFO("target_yaw:%f,yaw:%f",target_yaw,yaw);
				if (yaw > 89.5 && yaw < 90.5)
                  		{
     		  	                if (sametimes > 20)
              				{
         		                   step = 2;
                        		}
                        		else
                           		sametimes++;
                    			}
                    			else sametimes = 0;
	 	                break;
			case 2:
				target_yaw = 180;
				ROS_INFO("target_yaw:%f,yaw:%f",target_yaw,yaw);
				if (yaw > 179.5 && yaw < 180.5)
                  		{
     		  	                if (sametimes > 20)
              				{
         		                   step = 3;
                        		}
                        		else
                           		sametimes++;
                    			}
                    			else sametimes = 0;
	 	                break;
			case 3:
				target_yaw = -90;
				ROS_INFO("target_yaw:%f,yaw:%f",target_yaw,yaw);
				if (yaw > -90.5 && yaw < -89.5)
                  		{
     		  	                if (sametimes > 20)
              				{
         		                   step = 4;
                        		}
                        		else
                           		sametimes++;
                    		}
                    		else sametimes = 0;
	 	                break;
			case 4:
				target_yaw = 0;
				ROS_INFO("target_yaw:%f,yaw:%f",target_yaw,yaw);
				if (yaw > -0.5 && yaw < 0.5)
                  		{
     		  	                if (sametimes > 20)
              				{
         		                   step = 5;
                        		}
                        		else
                           		sametimes++;
                    		}
                    		else sametimes = 0;
	 	                break;
			case 5:
				//改用角度直接控制
				setpoint.type_mask =
				//mavros_msgs::PositionTarget::IGNORE_PX |
				//mavros_msgs::PositionTarget::IGNORE_PY |
				//mavros_msgs::PositionTarget::IGNORE_PZ |
				mavros_msgs::PositionTarget::IGNORE_VX |
				mavros_msgs::PositionTarget::IGNORE_VY |
				mavros_msgs::PositionTarget::IGNORE_VZ |
				mavros_msgs::PositionTarget::IGNORE_AFX |
				mavros_msgs::PositionTarget::IGNORE_AFY |
				mavros_msgs::PositionTarget::IGNORE_AFZ |
				mavros_msgs::PositionTarget::FORCE |
				//mavros_msgs::PositionTarget::IGNORE_YAW;
				mavros_msgs::PositionTarget::IGNORE_YAW_RATE;
				setpoint.yaw = 90*M_PI/180;
				ROS_INFO("target_yaw:%f,yaw:%f",setpoint.yaw,yaw);
				if(yaw > 89.9 && yaw < 90.1)
				{
     		  	                if (sametimes > 20)
              				{
         		                   step = 6;
                        		}
                        		else
                           		sametimes++;
                    		}
                    		else sametimes = 0;
	 	                break;
			case 6:
				setpoint.yaw = 180*M_PI/180;
				ROS_INFO("target_yaw:%f,yaw:%f",setpoint.yaw,yaw);
				if(yaw > 180.1 && yaw < 179.8)
				{
     		  	                if (sametimes > 20)
              				{
         		                   step = 7;
                        		}
                        		else
                           		sametimes++;
                    		}
                    		else sametimes = 0;
	 	                break;
			case 7:
				setpoint.yaw = -90*M_PI/180;
				ROS_INFO("target_yaw:%f,yaw:%f",setpoint.yaw,yaw);
				if(yaw > -90.1 && yaw < -89.9)
				{
     		  	                if (sametimes > 20)
              				{
         		                   step = 8;
                        		}
                        		else
                           		sametimes++;
                    		}
                    		else sametimes = 0;
	 	                break;
			case 8:
				setpoint.yaw = 0;
				ROS_INFO("target_yaw:%f,yaw:%f",setpoint.yaw,yaw);
				if(yaw > -0.1 && yaw < 0.1)
				{
     		  	                if (sametimes > 20)
              				{
         		                   step = 9;
                        		}
                        		else
                           		sametimes++;
                    		}
                    		else sametimes = 0;
	 	                break;
			case 9:
				offb_set_mode.request.custom_mode = "AUTO.LAND";
				if (current_state.mode != "AUTO.LAND" && (ros::Time::now() - last_request > ros::Duration(5.0)))
				{
					if (set_mode_client.call(offb_set_mode) && offb_set_mode.response.mode_sent)
					{
						ROS_INFO("AUTO.LAND enabled");
					}
					last_request = ros::Time::now();
					}
				break;
				default:
					break;
		}
	}
    } 

	 //计算偏航角速度
	err_yaw = target_yaw - yaw;
	err_yaw_err =err_yaw - err_yaw0;
 	err_yaw0 = err_yaw;
	diff_angle = H.kp * err_yaw + H.kd * err_yaw_err;
	setpoint.yaw_rate = diff_angle * 0.01;

    setpoint_pub.publish(setpoint);

    ros::spinOnce();
    rate.sleep();
}

return 0;

}

演示

HHH

添加部分

1.添加了IMU数据话题的订阅

ros::Subscriber yaw_sub = nh.subscribe<sensor_msgs::Imu>("mavros/imu/data", 10, yaw_cb);//订阅无人机imu数据

添加了tf欧拉角与四元数的转化

void yaw_cb(sensor_msgs::Imu msg)
{
	tf::Quaternion quaternion(
        msg.orientation.x,
        msg.orientation.y,
        msg.orientation.z,
        msg.orientation.w
        );

	
    tf::Matrix3x3(quaternion).getRPY(roll,pitch,yaw);
    roll = roll*180/M_PI;
    pitch = pitch*180/M_PI;
    yaw = yaw*180/M_PI;

    //ROS_INFO("roll: %.0f ,pitch: %.0f  , yaw: %.0f",roll,pitch,yaw);  
}

可以实时观测飞行器的偏航角,以及做判断

2.开启了偏航角控制的参数

先是用角速度来控制,通过当前的角度与目标角度的误差计算出角速度,这种方法可以控制速度限制,

可以看到视频中飞机旋转的比较缓慢.

//计算偏航角速度
err_yaw = target_yaw - yaw;
err_yaw_err =err_yaw - err_yaw0;
err_yaw0 = err_yaw;
diff_angle = H.kp * err_yaw + H.kd * err_yaw_err;
setpoint.yaw_rate = diff_angle * 0.01;

之后是用角度直接控制的,可以看到旋转的十分迅速.(个人不推荐这种方法,因为在实战中有很多弊端)

分析

1.对于一些实战中对偏航角的要求还是挺高的,比如识别需要锁定摄像头的角度,或者动态捕捉等

所以可以添加偏航角控制让飞机更加稳定.

2.个人非常不推荐使用角度直接控制的方法,建议用角速度来实现'锁机头'的效果

因为一旦在实际中飞机的IMU数据失效,则飞机会猛的转向,然后速度会转化失效,飞机就会失控.

归根结底还是旋转速度太快,用PID计算的角速度可以限制速度

 

 

&黄昏的乐师
关注
无人机 PX4 飞控 | Offboard 模式详解与gazebo仿真测试
月照银海似蛟龙的博客
07-30 1826
在该模式下，飞行器根据飞行控制栈外部（如机载计算机）提供的设定值控制位置、速度、加速度、姿态以及推力/力矩。设定值可以通过MAVLink协议提供给飞控PX4要求外部控制器提供2Hz连续的“有效存在”信号，该信号可由任意支持的 MAVLink 设置点消息提供。PX4只有在收到该种信号超过1秒后才有效，如果该种信号停止飞行控制栈将重新获得控制权（脱离Offboard模式）。此模式需要位置或位姿信息的提供 - 例如GPS、光流、视觉惯性里程计、mocap等。
Gazebo仿真+单次指点飞行
weixin_43914923的博客
05-26 845
1、开启QGC地面站与gazebo仿真 cd PX4-Autopilot/ make px4_sitl gazebo_iris 2、在catkin_ws下src目录创建offboard_pkg catkin_create_pkg offboard_pkg roscpp std_msgs geometry_msgs mavros_msgs 3、新建offboard_node.cpp /** * @file offb_node.cpp * @brief Offboard control
常用MAVROS话题和服务
z1872385的博客
10-21 5054
https://zhuanlan.zhihu.com/p/364872655 一、常用接收的话题 1.1 系统状态 消息名称：mavros/state 类型：mavros_msgs::State 头文件：mavros_msgs/State.h 成员变量: string MODE_PX4_MANUAL=MANUAL //这里只列PX4的，APM的用rosmsg show mavros_msgs/State查看 string MODE_PX4_ACRO=ACRO string MODE_PX4_ALTITUDE
PX4无人机控制
weixin_39171982的博客
01-05 1378
PX4无人机控制 向话题/mavros/setpoint_raw/local发布无人机目标位置+偏航，或者目标速度+偏航，或者目标加速度+偏航。 发布目标位置+偏航： mission.positionTarget.type_mask = // mavros_msgs::PositionTarget::IGNORE_PX | // mavros_msgs::Posi
mavros消息使用纪录
weixin_45438628的博客
09-10 575
mavros常用消息数据含义与使用方法
PX4代码学习系列博客(6)——offboard模式位置控制代码分析
千人斩的博客
09-22 5219
offboard模式位置控制代码分析
小白PX4无人机仿真—OFFBOARD控制资料汇总
weixin_41097249的博客
10-30 1883
基于PX4的无人机仿真环境搭建与基础控制节点实现，本文更多的是新学过程中对所学知识整体实现流程的顺序资料整理，另加入了一些个人理解，如有问题欢迎大家指正
【PX4-AutoPilot教程-Offboard】MAVROS功能包控制无人机进入offboard模式飞行官方例程（C++实现）
在后厂村路努力科研搬砖的无人机控制方向练习生一名～
12-21 7819
主要介绍如何通过MAVROS功能包使用PX4飞控中的offboard模式控制gazebo中的飞机起飞到高度两米，代码用C++实现。在运行过程中，可能会出现一个BUG，就是无人机无法起飞，文章中简述了解决方法。
基于PX4、ROS和Gazebo的无人机通用仿真平台
最新发布
03-07
通过解压并编译这个项目，开发者可以了解如何将PX4、ROS和Gazebo整合到一个统一的仿真环境中，进行无人机的飞行控制实验。 在实际应用中，这样的仿真平台对于无人机研发有着重大意义。它可以减少实飞测试的风险和...
Simulink程序：使用ROS2控制无人机进入Offboard模式起飞悬停并在Gazebo中可视化
02-22
文章【PX4&Simulink&Gazebo联合仿真】在Simulink中使用ROS2控制无人机进入Offboard模式起飞悬停并在Gazebo中可视化对应的源程序。 https://blog.csdn.net/weixin_45031928/article/details/136213665 microRTPS桥接...
px4的gazebo仿真教程
11-01
【PX4的Gazebo仿真教程】 在无人机和机器人领域，仿真环境的使用至关重要，它允许开发者在不涉及实际硬件的情况下测试和优化控制系统。在PX4开源飞控系统中，Gazebo是一个强大的仿真工具，提供了丰富的场景和多种...
px4+vins+ego单机鲁棒飞行一（px4+mavros篇）
qq_35616298的博客
07-17 5064
px4+vins+ego单机鲁棒飞行一（mavros篇）一、mavors安装二、mavros中的重要topic三、mavros中使用的部分重要msg 一、mavors安装 参考教程 添加用户权限 sudo usermod -a -G dialout $USER 二进制安装mavros sudo apt-get install ros-melodic-mavros ros-melodic-mavros-extras ros-melodic-control-toolbox 安装Geographic
mavros操作飞机时方向位置改为机体坐标系下指令
渡之的博客
05-17 1397
前面试了很多，看官网里的说明 用 /mavros/setpoint_raw/local"里的frame_id改为"base_link" 不行 又直接发mavros_msgs/PositionTarget 修改里面的type_mask把忽略的都加上，但还是没用，飞机依然按照全局位置飞行 最后搞了好几天，才弄懂，只需要一行代码就搞定了。 节点声明ros::NodeHandle node; node.setParam("mav_frame", 8);//Frame_body_ned=8这个参数从很多消息
pycharm开发Prometheus
Q_L_Y的博客
04-13 595
1.先打开一个文件夹作为项目的根目录 2 引入Prometheus的包 如果最后一个import报错，那么打开Settings里面的Python Interpreter 点击Python 3.6旁边的倒三角，点击“Show All” 点击左侧栏的第四个图标 把最后一个路径加进去。然后点击OK 下一个框要点Apply之后再点OK 然后就发现不报错啦 以上步骤是为了添加python包，也就是site-packages或者dist-packages的文件夹。这里添加了
PX4从放弃到精通（十六）：控制接口
超维空间科技的博客
11-23 5863
PX4固件版本1.12.3
mavros操作飞机时方向位置改为机体坐标系下指令(转载）
诗筱涵的博客
10-30 1146
转载自：mavros操作飞机时方向位置改为机体坐标系下指令_渡之的博客-CSDN博客 前面试了很多，看官网里的说明 用 /mavros/setpoint_raw/local"里的frame_id改为"base_link" 不行 又直接发mavros_msgs/PositionTarget 修改里面的type_mask把忽略的都加上，但还是没用，飞机依然按照全局位置飞行 最后搞了好几天，才弄懂，只需要一行代码就搞定了。 节点声明ros::NodeHandle node; node.setParam
T265定点指点基本原理与极简代码实现
诗筱涵的博客
02-21 1602
对应掩码位置为1为不使用，为0为使用，所以想通过/mavros/setpoint_raw/local话题给无人机发送期望位置与偏航，type_mask赋值为0b100111111000，即可实现，注意coordinate_frame 需要赋值，一般为1，即为本地系。//启动服务2，设置客户端（Client）名称为set_mode_client，客户端的类型为ros::ServiceClient，//发布之前需要公告，并获取句柄，发布的消息体的类型为：geometry_msgs::PoseStamped。
超维小课堂 | 4、MAVROS常用话题简介
qq_35598561的博客
06-19 3994
超维小课堂 | 4、MAVROS常用话题简介
PX4学习笔记3: 速度控制
诗筱涵的博客
03-24 1058
转载自：https://blog.csdn.net/wbzhang233/article/details/106727276 PX4学习笔记3: 速度控制 wbzhang233 2020-06-13 07:58:28 878 收藏 6 分类专栏： 自主避障 文章标签： 人工智能 版权 记录一下PX4在offboard板外模式下用速度控制四旋翼的过程. 参考资料如下: PX4板外模式教程 youtube速度控制小实验 PX4飞行模式 offboard模式 offboard模式控制例子
评论 3
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值