collision_detection
src
src/collision_common.cpp
Go to the documentation of this file.
1
/*********************************************************************
2
* Software License Agreement (BSD License)
3
*
4
* Copyright (c) 2011, Willow Garage, Inc.
5
* All rights reserved.
6
*
7
* Redistribution and use in source and binary forms, with or without
8
* modification, are permitted provided that the following conditions
9
* are met:
10
*
11
* * Redistributions of source code must retain the above copyright
12
* notice, this list of conditions and the following disclaimer.
13
* * Redistributions in binary form must reproduce the above
14
* copyright notice, this list of conditions and the following
15
* disclaimer in the documentation and/or other materials provided
16
* with the distribution.
17
* * Neither the name of the copyright holder nor the names of its
18
* contributors may be used to endorse or promote products derived
19
* from this software without specific prior written permission.
20
*
21
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
25
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
27
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
29
* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32
* POSSIBILITY OF SUCH DAMAGE.
33
*********************************************************************/
34
35
#include <
moveit/collision_detection/collision_common.h
>
36
37
static
const
char
LOGNAME
[] =
"collision_common"
;
38
constexpr
size_t
LOG_THROTTLE_PERIOD
= 5;
39
40
namespace
collision_detection
41
{
42
void
CollisionResult::print
()
const
43
{
44
if
(!
contacts
.empty())
45
{
46
ROS_WARN_STREAM_THROTTLE_NAMED
(
LOG_THROTTLE_PERIOD
,
LOGNAME
,
47
"Objects in collision (printing 1st of "
48
<<
contacts
.size() <<
" pairs): "
<<
contacts
.begin()->first.first <<
", "
49
<<
contacts
.begin()->first.second);
50
51
// Log all collisions at the debug level
52
ROS_DEBUG_STREAM_THROTTLE_NAMED
(
LOG_THROTTLE_PERIOD
,
LOGNAME
,
"Objects in collision:"
);
53
for
(
const
auto
& contact :
contacts
)
54
{
55
ROS_DEBUG_STREAM_THROTTLE_NAMED
(
LOG_THROTTLE_PERIOD
,
LOGNAME
,
56
"\t"
<< contact.first.first <<
", "
<< contact.first.second);
57
}
58
}
59
}
60
61
}
// namespace collision_detection
ROS_WARN_STREAM_THROTTLE_NAMED
#define ROS_WARN_STREAM_THROTTLE_NAMED(period, name, args)
LOG_THROTTLE_PERIOD
constexpr size_t LOG_THROTTLE_PERIOD
Definition:
src/collision_common.cpp:38
ROS_DEBUG_STREAM_THROTTLE_NAMED
#define ROS_DEBUG_STREAM_THROTTLE_NAMED(period, name, args)
collision_detection::LOGNAME
constexpr char LOGNAME[]
Definition:
collision_env_fcl.cpp:82
collision_common.h
collision_detection::CollisionResult::contacts
ContactMap contacts
A map returning the pairs of body ids in contact, plus their contact details.
Definition:
include/moveit/collision_detection/collision_common.h:418
collision_detection::CollisionResult::print
void print() const
Throttled warning printing the first collision pair, if any. All collisions are logged at DEBUG level...
Definition:
src/collision_common.cpp:42
LOGNAME
static const char LOGNAME[]
Definition:
src/collision_common.cpp:37
collision_detection
Definition:
collision_detector_allocator_allvalid.h:42
moveit_core
Author(s): Ioan Sucan
, Sachin Chitta
, Acorn Pooley
autogenerated on Sat Dec 21 2024 03:23:41