autoware.universe源码略读(3.16)--perception:object_range_splitter

Overview

这里处理的依旧是检测到的对象消息,不过这里的目的是根据对象到原点的距离,把检测到的对象分成两个消息,根据输入输出我们可以看到,最后就是划分成了近距离的对象和远距离的对象两类

NameTypeDescription
output/long_range_objectautoware_auto_perception_msgs::msg::DetectedObjectslong range detected objects
output/short_range_objectautoware_auto_perception_msgs::msg::DetectedObjectsshort range detected objects

node

(Class Constructor)ObjectRangeSplitterNode::ObjectRangeSplitterNode

非常朴素的一个节点类,甚至没什么好说的

(mFunc)ObjectRangeSplitterNode::objectCallback

检测物体的回调函数,其实就是根据xy坐标算了个距离,然后根据阈值分割成了两部分了,也非常简单

// split
for (const auto & object : input_msg->objects) {
  const auto & position = object.kinematics.pose_with_covariance.pose.position;
  const auto object_sq_dist = position.x * position.x + position.y * position.y;
  if (object_sq_dist < spilt_range_ * spilt_range_) {  // short range
    output_short_range_object_msg.objects.push_back(object);
  } else {  // long range
    output_long_range_object_msg.objects.push_back(object);
  }
}
  • 所以这个小模块真的好简单哈哈哈
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值