Vector3f angVelB = rbB.getAngularVelocity(Stack.alloc(Vector3f.class));
Vector3f angVelAroundAxisA = Stack.alloc(Vector3f.class);
angVelAroundAxisA.scale(axisA.dot(angVelA), axisA);
Vector3f angVelAroundAxisB = Stack.alloc(Vector3f.class);
angVelAroundAxisB.scale(axisB.dot(angVelB), axisB);
Vector3f angAorthog = Stack.alloc(Vector3f.class);
angAorthog.sub(angVelA, angVelAroundAxisA);
Vector3f angBorthog = Stack.alloc(Vector3f.class);
angBorthog.sub(angVelB, angVelAroundAxisB);