Returns the distance between p1 and p2 Args: target ([type]): [description] Returns: [type]: [description]
(self, p1, p2)
| 828 | |
| 829 | |
| 830 | def _get_dist(self, p1, p2): |
| 831 | """Returns the distance between p1 and p2 |
| 832 | |
| 833 | Args: |
| 834 | target ([type]): [description] |
| 835 | |
| 836 | Returns: |
| 837 | [type]: [description] |
| 838 | """ |
| 839 | |
| 840 | distance = np.sqrt( |
| 841 | (p1[0] - p2[0]) ** 2 + |
| 842 | (p1[1] - p2[1]) ** 2 + |
| 843 | (p1[2] - p2[2]) ** 2) |
| 844 | |
| 845 | return distance |
| 846 | |
| 847 | def _get_distance(self, target): |
| 848 | """Returns the distance from the (rgb_front) camera to the target |