a ij @sdZddlmZddlmZddlmZddlmZddlmZej dddd d d d d d ddddZ ej dddd d ddd d ddddZ ej ddddddddZ ej ddddddddZ dS)zCommon geometric utils.) annotations)checking)compat) numpy_utils) FloatArrayF)strict.)keepdimsxnpzFloatArray['... n']boolznumpy_utils.NpModulezFloatArray['... 1?'])x0x1rr returncCs|d||}|r|dS|S)aDot product on the last dimension, with broadcasting support. Contrary to `np.dot`, the behavior is consistent for 1-dim vs n-dim (while dot act as matmul). First dimensions are always broadcasted. Args: x0: Vector array x1: Vector array keepdims: If True, returns `FloatArray['... 1']` xnp: Numpy module to use Returns: The dot product along the last axis. z...m,...m->...).N)Zeinsum)r r rr yrQ/home/ghrups/robot-bench/.venv/lib/python3.9/site-packages/etils/enp/geo_utils.py batch_dotsrzFloatArray[..., 3]cCs6tj|||d|d}t|||d}|||}|S)z*Compute angle between 2 vectors, unsigned.Zaxisrr)rnormcrossrZarctan2)r r rr Za0Za1Zanglerrr angle_between9s  r)uvr cCs&t||ddtj|dddd|S)zProject `u` onto `v`.Trrr)rrr)rrrrrproject_onto_vectorHs  r)rnr cCs|t||S)z3Project `u` onto the plane `n` (orthogonal vector).)r)rrrrrproject_onto_planeUsrN)__doc__ __future__rZ etils.enprrrZetils.enp.typingrZcheck_and_normalize_arraysrrrrrrrrs"