Almost working. AH-290

Wrote a new SAT following Eberlys math. Seems to be working.
Collision depth not 100% correct.