segment.h
Go to the documentation of this file.
1 // -*- mode: c++ -*-
2 /*********************************************************************
3  * Software License Agreement (BSD License)
4  *
5  * Copyright (c) 2015, JSK Lab
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  *
12  * * Redistributions of source code must retain the above copyright
13  * notice, this list of conditions and the following disclaimer.
14  * * Redistributions in binary form must reproduce the above
15  * copyright notice, this list of conditions and the following
16  * disclaimer in the documentation and/o2r other materials provided
17  * with the distribution.
18  * * Neither the name of the JSK Lab nor the names of its
19  * contributors may be used to endorse or promote products derived
20  * from this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
28  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
29  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
30  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
32  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33  * POSSIBILITY OF SUCH DAMAGE.
34  *********************************************************************/
35 
36 #ifndef JSK_RECOGNITION_UTILS_GEO_SEGMENT_H_
37 #define JSK_RECOGNITION_UTILS_GEO_SEGMENT_H_
38 
39 #include <iostream>
41 #include "visualization_msgs/Marker.h"
42 
43 namespace jsk_recognition_utils
44 {
45  class Plane;
50  class Segment: public Line
51  {
52  public:
54 
62  Segment(const Eigen::Vector3f& from, const Eigen::Vector3f to);
63 
68  virtual void getEnd(Eigen::Vector3f& output) const;
69  virtual Eigen::Vector3f getEnd() const;
70 
71  virtual void foot(const Eigen::Vector3f& point, Eigen::Vector3f& output) const;
72  virtual double dividingRatio(const Eigen::Vector3f& point) const;
73  virtual double distance(const Eigen::Vector3f& point) const;
74  virtual double distance(const Eigen::Vector3f& point, Eigen::Vector3f& foot_point) const;
75  virtual bool intersect(Plane& plane, Eigen::Vector3f& point) const;
76  virtual void midpoint(Eigen::Vector3f& midpoint) const;
77  //virtual double distance(const Segment& other);
78  friend std::ostream& operator<<(std::ostream& os, const Segment& seg);
79 
87  virtual double distanceWithInfo(const Eigen::Vector3f& from,
88  Eigen::Vector3f& foot_point,
89  double &distance_to_goal) const;
90 
95  virtual Segment::Ptr flipSegment() const;
96 
101  virtual double length() const;
102 
107  void toMarker(visualization_msgs::Marker& marker) const;
108 
113  virtual bool isCross (const Line &ln, double distance_threshold = 1e-5) const;
114  virtual bool isCross (const Segment &ln, double distance_threshold = 1e-5) const;
115 
116  protected:
117  Eigen::Vector3f to_;
118  double length_;
119  private:
120  };
121 }
122 
123 #endif
virtual double distanceWithInfo(const Eigen::Vector3f &from, Eigen::Vector3f &foot_point, double &distance_to_goal) const
compute a distance to a point
Definition: segment.cpp:118
virtual double distance(const Eigen::Vector3f &point) const
Definition: segment.cpp:76
virtual bool intersect(Plane &plane, Eigen::Vector3f &point) const
Definition: segment.cpp:89
Segment(const Eigen::Vector3f &from, const Eigen::Vector3f to)
Construct a line from a start point and a goal point.
Definition: segment.cpp:42
boost::shared_ptr< Segment > Ptr
Definition: segment.h:53
virtual void point(double alpha, Eigen::Vector3f &ouptut)
Compute a point on normal from alpha parameter.
Definition: line.cpp:201
Class to represent 3-D straight line which has finite length.
Definition: segment.h:50
void toMarker(visualization_msgs::Marker &marker) const
make marker message to display the finite line
Definition: segment.cpp:150
virtual Eigen::Vector3f getEnd() const
Definition: segment.cpp:113
virtual void foot(const Eigen::Vector3f &point, Eigen::Vector3f &output) const
compute a point which gives perpendicular projection.
Definition: segment.cpp:60
virtual void midpoint(Eigen::Vector3f &midpoint) const
Definition: segment.cpp:97
virtual double dividingRatio(const Eigen::Vector3f &point) const
Definition: segment.cpp:47
virtual bool isCross(const Line &ln, double distance_threshold=1e-5) const
is crossing with another line
Definition: segment.cpp:174
friend std::ostream & operator<<(std::ostream &os, const Segment &seg)
Definition: segment.cpp:102
virtual Segment::Ptr flipSegment() const
return flipped line (line of opposite direction)
Definition: segment.cpp:139
virtual double length() const
return length of the line
Definition: segment.cpp:145
Class to represent 3-D straight line.
Definition: line.h:49


jsk_recognition_utils
Author(s):
autogenerated on Mon May 3 2021 03:03:03