401402403404405406407408409410411
Vector3d v = vectorPool.get(sv); Vector3d w = vectorPool.get(sw); u.scale(FastMath.cos(phi)*sin_a); v.scale(FastMath.sin(phi)*sin_a); w.scale(cos_a); reflected.d.add(u, v); reflected.d.add(w); reflected.d.normalize();