#ifndef __QMATH_H__
#define __QMATH_H__

MATRIX *RotMatrixQ(SVECTOR *r, MATRIX *m);

#define m_dot12(a, b)   ((((int)((a)->vx) * (b)->vx) >> 12) + (((int)((a)->vy) * (b)->vy) >> 12) + (((int)((a)->vz) * (b)->vz) >> 12))

// TODO: worth a benchmark: is it faster to copy these vectors and use them from the stack, or to do six pointer dereferences?
INLINE int m_pointPlaneDist2(const VECTOR* point2, const SVECTOR* normal12, int dist2)
{
    int x = ((int)point2->vx * normal12->vx) >> 12;
    int y = ((int)point2->vy * normal12->vy) >> 12;
    int z = ((int)point2->vz * normal12->vz) >> 12;
    return (x + y + z - dist2);
}

#endif // __QMATH_H__