bullet3/examples/pybullet/unittests/utils.py

9 lines
285 B
Python
Raw Normal View History

2018-04-11 07:58:58 +00:00
def dot(A, b):
"""Dot product between a 2D matrix and a 1D vector"""
return [sum([aij * bj for aij, bj in zip(ai, b)]) for ai in A]
2018-04-11 07:58:58 +00:00
def allclose(a, b, tol=1e-7):
"""Are all elements of a vector close to one another"""
return all([abs(ai - bi) < tol for ai, bi in zip(a, b)])