Fixed some bugs in AABB_tpl
Merge branch 'master' of https://github.com/Marvin-Pohl/MathLib into develop