6 , observer_mask_(std::bitset<3>(0))
20 if ((std::floor(sum*1000)/1000.f) <= full_area) {
return false; }
24 std::regex rx(
"panda_arm([0-9]+)");
26 std::regex_match(str, match, rx);
28 ss <<
"base_" << match[1];
36 if ((std::floor(sum*1000)/1000.f) <= full_area){
37 ROS_INFO(
"%f %f, %f", std::floor(sum*1000)/1000.f, full_area, sum);
44 for(std::size_t i = 0; i <
observers_.size(); i++){
53 if ((std::floor(sum*1000)/1000.f) <= full_area) {
65 tf_ = tf2::Transform(tf2::Quaternion(0,0,0,1), tf2::Vector3(0,0,
tf().getOrigin().getZ()));
81 if ((std::floor(sum*100)/100.f) <= full_area)
return true;