Still refactoring code into FMath and working on FMatrix