2023-02-14 06:49:09 -08:00
|
|
|
# _____ _ _ __ #
|
|
|
|
|
# / ____| | | |/ / #
|
|
|
|
|
# ___ _ __ ___ _ __ | | __ | | ' / #
|
|
|
|
|
# / _ \| '_ \ / _ \ '_ \| | |_ |_ | | < #
|
|
|
|
|
# | (_) | |_) | __/ | | | |__| | |__| | . \ #
|
|
|
|
|
# \___/| .__/ \___|_| |_|\_____|\____/|_|\_\ #
|
|
|
|
|
# | | #
|
|
|
|
|
# |_| #
|
|
|
|
|
# #
|
|
|
|
|
# Copyright 2022 Mattia Montanari, University of Oxford #
|
|
|
|
|
# #
|
|
|
|
|
# This program is free software: you can redistribute it and/or modify it under #
|
|
|
|
|
# the terms of the GNU General Public License as published by the Free Software #
|
|
|
|
|
# Foundation, either version 3 of the License. You should have received a copy #
|
|
|
|
|
# of the GNU General Public License along with this program. If not, visit #
|
|
|
|
|
# #
|
|
|
|
|
# https://www.gnu.org/licenses/ #
|
|
|
|
|
# #
|
|
|
|
|
# This program is distributed in the hope that it will be useful, but WITHOUT #
|
|
|
|
|
# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS #
|
|
|
|
|
# FOR A PARTICULAR PURPOSE. See GNU General Public License for details. #
|
2020-05-21 09:27:47 -07:00
|
|
|
|
2020-05-19 17:46:42 -07:00
|
|
|
import numpy as np
|
2020-05-21 08:24:36 -07:00
|
|
|
import openGJK_cython as opengjk
|
2020-05-21 09:27:47 -07:00
|
|
|
|
2023-02-14 06:49:09 -08:00
|
|
|
a = np.array([[1.0,1.0,1.0],[1.0,1.0,1.0]])
|
|
|
|
|
b = np.array([[-1.,-1.,-1.],[-1.,-1.,-1.]])
|
2020-05-21 07:45:51 -07:00
|
|
|
d = opengjk.pygjk(a,b)
|
2020-05-21 09:27:47 -07:00
|
|
|
|
2023-02-14 06:49:09 -08:00
|
|
|
print("Distance is:" , d)
|
