/usr/include/SurgSim/Collision/OctreeContact.h is in libopensurgsim-dev 0.7.0-6ubuntu1.
This file is owned by root:root, with mode 0o644.
The actual contents of the file can be viewed below.
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 | // This file is a part of the OpenSurgSim project.
// Copyright 2013-2015, SimQuest Solutions Inc.
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
// http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.
#ifndef SURGSIM_COLLISION_OCTREECONTACT_H
#define SURGSIM_COLLISION_OCTREECONTACT_H
#include <memory>
#include "SurgSim/Collision/ContactCalculation.h"
#include "SurgSim/Math/BoxShape.h"
#include "SurgSim/Math/OctreeShape.h"
#include "SurgSim/Math/RigidTransform.h"
namespace SurgSim
{
namespace Collision
{
class CollisionPair;
class ShapeCollisionRepresentation;
/// Abstract base class to calculate intersections between an Octree and other shapes
///
/// Derived classes handle the calculation for specific shape types (ie
/// OctreeSphereContact).
class OctreeContact : public ContactCalculation
{
protected:
/// Do the calculation between an octree node (BoxShape) and the other shape
/// \param boxShape the box shape
/// \param boxPose the pose of the box
/// \param otherShape the other shape
/// \param otherPose the pose of the other shape
/// \return a list of contacts between the shapes, if any
virtual std::list<std::shared_ptr<Contact>> boxContactCalculation(
const SurgSim::Math::BoxShape& boxShape, const SurgSim::Math::RigidTransform3d& boxPose,
const SurgSim::Math::Shape& otherShape, const SurgSim::Math::RigidTransform3d& otherPose) = 0;
private:
std::list<std::shared_ptr<Contact>> doCalculateDcdContact(
const Math::PosedShape<std::shared_ptr<Math::Shape>>& posedShape1,
const Math::PosedShape<std::shared_ptr<Math::Shape>>& posedShape2) override;
/// Calculate the collision between a specific octree node and a shape
/// This function will check for contact between the node and shape. If
/// contact is found, this function will be called on each of the
/// node's children. Once a leaf node is reached, contacts are added to the
/// CollisionPair.
/// \param node the octree node to collide with
/// \param octreePose the pose of the octree shape
/// \param shape the shape that the octree is colliding with
/// \param shapePose the pose of the shape
/// \param nodePath the NodePath of the current octree node
/// \param result [in,out] all generated contacts are agreggated here
/// \param nodePath [in,out] the path of the current node
void calculateContactWithNode(
std::shared_ptr<const SurgSim::Math::OctreeShape::NodeType> node,
Math::RigidTransform3d octreePose,
const std::shared_ptr<Math::Shape>& shape,
const Math::RigidTransform3d& shapePose,
SurgSim::DataStructures::OctreePath* nodePath,
std::list<std::shared_ptr<Contact>>* result);
/// Enable a Vector3d to be used as a key in an unordered map.
class Vector3dHash
{
public:
size_t operator()(const SurgSim::Math::Vector3d& id) const;
};
/// The shapes used for the contact calculations are cached for performance.
std::unordered_map<SurgSim::Math::Vector3d, std::shared_ptr<SurgSim::Math::BoxShape>, Vector3dHash> m_shapes;
};
};
};
#endif // SURGSIM_COLLISION_OCTREECONTACT_H
|