add vector and rotation functions to utilities.c/.h