ROS无人机机械爪使用

引言:使用飞控的主通道5-8作为舵机控制输出,需要提前设置好飞控参数,否则无效。本节资料文件尚未整理完毕,整理完毕后会在B站进行视频讲解,并进行开源

1、启动mavros通信,用于订阅遥控器的按键信息,添加机械爪是否使用的安全开关

roslaunch robot_bringup px4.launch

2、启动D435深度摄像头,启动深度与彩图对齐文件

注:先查看深度摄像头是否工作正常,采用USB3.0线

roslaunch realsense2_camera rs_aligned_depth.launch 

3、启动yolov8物体识别节点

roslaunch yolov8_ros yolo_v8_d435.launch

4、启动坐标转换节点

roslaunch object_position object_position.launch 

5、启动机械爪控制节点

rosrun arm_grasp arm_grasp

机械爪控制代码如下:

//说明:舵机方向根据实际调整,这里用的占空比0%表示闭合,100%表示打开
#include <api_library.h>
#include <lib_library.h>
#include <arm_grasp/ctrl.h>
#include <mavros_msgs/RCIn.h>int arm_first  = 0;
int arm_second = 0;
int arm_third  = 0;	
int arm_fourth = 0;
bool target_locked_flag = false;
int  target_locked_area = 100;
arm_grasp::ctrl ctrl_msg;
//无人机遥控器订阅
mavros_msgs::RCIn global_rc_in;
void rc_in_cb(const mavros_msgs::RCIn::ConstPtr& msg)
{global_rc_in = *msg;    	if(global_rc_in.channels[6]>=1250&&global_rc_in.channels[6]<=2050){ctrl_msg.data = true;}else{ctrl_msg.data = false;}    
}/**************************************************
//此处添加计数器防止误识别判断
//补充说明,此处采用摄像头的左上前坐标系,解释如下:
//X为负,表示物体在摄像头的左方,反之右方,正中间为0;
//Y为负,表示物体在摄像头的前方,反之后 方,正中间为0;
//Z表示距离,始终为正
***************************************************/
int last_count    = 0;
int current_count = 0;
int last_diff     = 0;
int current_diff  = 0;
int sum = 0;
int visual_position(string str)
{if(object_pos.header.frame_id == str){position_detec_x = object_pos.point.x;position_detec_y = object_pos.point.y;position_detec_z = object_pos.point.z;}if((fabs(position_detec_x)<=0.03)&&position_detec_y<=-0.03){current_count= current_count + 1;//	cout<<"目标在正前方"<<endl;}else if((fabs(position_detec_x)<=0.03)&&position_detec_y>=0.03){current_count= current_count + 2;//	cout<<"目标在正后方"<<endl;}else if((fabs(position_detec_y)<=0.03)&&position_detec_x<=-0.03){current_count= current_count + 3;//	cout<<"目标在正左方"<<endl;}else if((fabs(position_detec_y)<=0.03)&&position_detec_x>=0.03){	current_count= current_count + 4;//	cout<<"目标在正右方"<<endl;}else if((position_detec_x<-0.03)&&position_detec_y<-0.03){current_count= current_count + 5;//	cout<<"目标在左前方"<<endl;}else if((position_detec_x<-0.03)&&position_detec_y>0.03){current_count= current_count + 6;//	cout<<"目标在左后方"<<endl;}else if((position_detec_x>0.03)&&position_detec_y<-0.03){current_count= current_count + 7;//	cout<<"目标在右前方"<<endl;}else if((position_detec_x>0.03)&&position_detec_y>0.03){current_count= current_count + 8;	//	cout<<"目标在右后方"<<endl;}else if((fabs(position_detec_x)<=0.03)&&fabs(position_detec_y)<=0.03&&position_detec_x!=0&&position_detec_y!=0){current_count= current_count + 9;//	cout<<"目标在正中间"<<endl;}else{}//cout<<current_count<<endl;//cout<<last_count<<endl;if(current_count ==last_count&&last_count!=0){sum++;if(sum>=100){cout<<"目标锁定"<<endl;target_locked_area = current_count;cout<<target_locked_area<<endl;target_locked_flag = true;}}else{sum = 0;}last_count=current_count;current_count = 0;
}int main(int argc, char** argv)
{setlocale(LC_ALL, "");ros::init(argc, argv, "complete_mission");ros::NodeHandle nh; ros::Subscriber object_pos_sub = nh.subscribe<geometry_msgs::PointStamped>("object_position", 100, object_pos_cb); ros::Subscriber rc_in_sub = nh.subscribe<mavros_msgs::RCIn>("/mavros/rc/in", 100, rc_in_cb); ros::ServiceClient ctrl_pwm_client = nh.serviceClient<mavros_msgs::CommandLong>("mavros/cmd/command");ros::Time last_request = ros::Time::now();lib_pwm_control(50,50,50,50);ctrl_pwm_client.call(lib_ctrl_pwm);ctrl_msg.data = false;ros::Rate rate(20);  while(ros::ok()){visual_position("cylinder");//cout<<ctrl_msg.data<<endl;if(ctrl_msg.data){cout<<target_locked_area<<endl;//正前方if(target_locked_area==1||target_locked_area==5||target_locked_area==7){arm_first   = 100;arm_second	= 0;}else if(target_locked_area==2||target_locked_area==6||target_locked_area==8){arm_first   = 0;arm_second	= 100;}//中间else{arm_first   = 50; arm_second	= 50;  		}		lib_pwm_control(arm_first,arm_second,arm_third,arm_fourth);ctrl_pwm_client.call(lib_ctrl_pwm);if(lib_time_record_func(5.0,ros::Time::now())){arm_fourth = 100;ROS_INFO("执行抓取");	  	}}else{lib_pwm_control(100,50,50,50);ctrl_pwm_client.call(lib_ctrl_pwm);ROS_INFO("机械爪还原");}ros::spinOnce();rate.sleep();}return 0;
}

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/pingmian/55435.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

harbor https配置

安装docker compose curl -o /etc/yum.repos.d/epel.repo http://mirrors.aliyun.com/repo/epel-7.repo yum -y install docker-compose docker-compose version生成自建CA证书 生成CA私钥&#xff1a; openssl genrsa -out /path/ca/ca.key 4096生成ca的自签名证书: open…

【力扣 | SQL题 | 每日四题】力扣1783,1757,1747,1623,1468,1661

昨天晚上睡着了&#xff0c;今天把昨天的每日一题给补上。 1. 力扣1783&#xff1a;大满贯数量 1.1 题目&#xff1a; 表&#xff1a;Players ------------------------- | Column Name | Type | ------------------------- | player_id | int | | player_na…

【AI知识点】词嵌入(Word Embedding)

词嵌入&#xff08;Word Embedding&#xff09;是自然语言处理&#xff08;NLP&#xff09;中的一种技术&#xff0c;用于将词语或短语映射为具有固定维度的实数向量。这些向量&#xff08;嵌入向量&#xff09;能够捕捉词语之间的语义相似性&#xff0c;即将语义相近的词映射到…

oracle 新建用户,用户插入数据报错:ORA-01950: 对表空间 ‘USERS‘ 无权限

oracle 新建用户&#xff0c;用户插入数据报错:ORA-01950: 对表空间 ‘USERS’ 无权限 根据业务需求创建了一个新的表空间和一个新的用户&#xff0c;当用这个新用户创建表时&#xff0c;报错&#xff1a;ORA-01950: 表空 间’USERS’中无权限。我已经把创建表的权限赋给了此用…

使用SpringBoot自定义注解+拦截器+token机制,实现接口的幂等性

1 整合springboot和redis环境的集成2 配置请求的方法体和枚举类 import lombok.AllArgsConstructor; import lombok.Data; import lombok.NoArgsConstructor;Data AllArgsConstructor NoArgsConstructor public class Response {private int status;private String msg;privat…

LeetCode hot100---链表专题(C++语言)

1、相交链表 &#xff08;1&#xff09;题目描述以及输入输出 (1)题目描述: 给你两个单链表的头节点 headA 和 headB &#xff0c;请你找出并返回两个单链表相交的起始节点。如果两个链表不存在相交点&#xff0c;返回 null 。 (2)输入输出描述&#xff1a; 输入&#xff1a;…

【游戏模组】重返德军总部2009高清重置MOD,建模和材质全部重置,并且支持光追效果,游戏画质大提升

各位好&#xff0c;今天小编给大家带来一款新的高清重置MOD&#xff0c;本次高清重置的游戏叫《重返德军总部2009》2009年发布&#xff0c;我相信很多玩家已经玩过了&#xff0c;如果你还没有玩过我也可以和你简单介绍一下剧情&#xff0c;这款游戏故事背景接续在《重返德军总部…

【Python】Dejavu:Python 音频指纹识别库详解

Dejavu 是一个基于 Python 实现的开源音频指纹识别库&#xff0c;主要用于音频文件的识别和匹配。它通过生成音频文件的唯一“指纹”并将其存储在数据库中&#xff0c;来实现音频的快速匹配。Dejavu 的主要应用场景包括识别音乐、歌曲匹配、版权管理等。 ⭕️宇宙起点 &#x1…

golang web笔记-3.响应ResponseWriter

简介 从服务器向客户端返回响应需要使用 ResponseWriter&#xff0c;ResponseWriter是一个接口&#xff0c;handler用它来返回响应。 ResponseWriter常用方法 Write&#xff1a;接收一个byte切片作为参数&#xff0c;然后把它写入到响应的body中。如果Write被调用时&a…

828华为云征文|部署在线论坛网站 Flarum

828华为云征文&#xff5c;部署在线论坛网站 Flarum 一、Flexus云服务器X实例介绍二、Flexus云服务器X实例配置2.1 重置密码2.2 服务器连接2.3 安全组配置2.4 Docker 环境搭建 三、Flexus云服务器X实例部署 Flarum3.1 Flarum 介绍3.2 Flarum 部署3.3 Flarum 使用 四、总结 一、…

【GeekBand】C++设计模式笔记5_Observer_观察者模式

1. “组件协作”模式 现代软件专业分工之后的第一个结果是“框架与应用程序的划分”&#xff0c;“组件协作”模式通过晚期绑定&#xff0c;来实现框架与应用程序之间的松耦合&#xff0c;是二者之间协作时常用的模式。典型模式 Template MethodStrategyObserver / Event 2.…

【Linux】第一个小程序——进度条实现

&#x1f525; 个人主页&#xff1a;大耳朵土土垚 &#x1f525; 所属专栏&#xff1a;Linux系统编程 这里将会不定期更新有关Linux的内容&#xff0c;欢迎大家点赞&#xff0c;收藏&#xff0c;评论&#x1f973;&#x1f973;&#x1f389;&#x1f389;&#x1f389; 文章目…

【Linux进程间通信】Linux匿名管道详解:构建进程间通信的隐形桥梁

&#x1f4dd;个人主页&#x1f339;&#xff1a;Eternity._ ⏩收录专栏⏪&#xff1a;Linux “ 登神长阶 ” &#x1f339;&#x1f339;期待您的关注 &#x1f339;&#x1f339; ❀Linux进程间通信 &#x1f4d2;1. 进程间通信介绍&#x1f4da;2. 什么是管道&#x1f4dc;3…

08.useInterval

在 React 应用中,实现定时器功能通常需要使用 setInterval() 和 clearInterval(),这可能会导致代码复杂和难以维护。useInterval 钩子提供了一种声明式的方法来实现定时器功能,使得定时器的管理更加简单和直观。这个自定义钩子不仅简化了定时器的使用,还解决了一些常见的定…

Java - MyBatis(上)

Mybatis&#xff08;上&#xff09; 简介 Mybatis是一款优秀的持久层框架。 Mybatis支持定制化SQL、存储过程以及高级映射。 MyBatis避免了几乎所有的JDBC代码和手动设置参数以及获取结果集。 持久化 持久化就是将程序的数据在持久状态和瞬时状态转化的过程 内存因为断电即失…

传感器模块编程实践(三)舵机+超声波模块融合DIY智能垃圾桶模型

文章目录 一.概要二.实验模型原理1.硬件连接原理框图2.控制原理 三.实验模型控制流程四.智能感应垃圾桶模型程序五.实验效果视频六.小结 一.概要 随着科技的飞速发展和环保意识的日益增强&#xff0c;智能垃圾桶成为了城市生活的新宠&#xff0c;智能垃圾桶人们无需接触垃圾桶…

灵足时代:具身智能核心部件的新秀崛起——解析数千万元天使轮融资

在智能科技日新月异的今天,具身智能作为连接物理世界与数字世界的重要桥梁,正逐步成为科技创新的前沿阵地。近日,具身智能核心部件领域的新锐公司——“灵足时代”宣布完成数千万元天使轮融资,这一消息无疑为行业内外带来了强烈的震撼与期待。本轮融资由雅瑞智友科学家基金…

计算机组成原理(笔记6阵列乘法器、补码阵列乘法器)

手算阵列乘法器 平时我们计算乘法的时候是手算的 平时手算过程中我们是进行平行移位&#xff0c;可是在计算机里平行移位&#xff0c;会带来更大的开销&#xff0c;如下图我们可以看到&#xff0c;为此聪明的人&#xff0c;设计了斜移位的计算机 值得注意的是最后一行用的是平…

wsl中git difftool調用beyond compare

發現有兩種方案&#xff0c;鏈接如下&#xff1a; 1&#xff0c;https://blog.csdn.net/u014175785/article/details/121558365 2&#xff0c;https://www.jianshu.com/p/3a72e2e1260b 下面的鏈接供參考&#xff1a; https://sep.com/blog/20170607wsl-git-and-beyond-compare…

学籍管理平台|在线学籍管理平台系统|基于Springboot+VUE的在线学籍管理平台系统设计与实现(源码+数据库+文档)

在线学籍管理平台系统 目录 基于SpringbootVUE的在线学籍管理平台系统设计与实现 一、前言 二、系统功能设计 三、系统实现 四、数据库设计 1、实体ER图 五、核心代码 六、论文参考 七、最新计算机毕设选题推荐 八、源码获取&#xff1a; 博主介绍&#xff1a;✌️大…