It feels a lot cleaner now, but if I start using matrix multiplication, I'm gonna need to find a linear algebra library. (There's Math.NET Numerics and others to choose from...)
The computations started to become a lot easier to comprehend once I translated them back into linear algebra, though.
There's also the documentation I left behind for myself, some of which have doodles of Gally-birb on them.