Finish matrix implementation, add algo package.
Tremaux DFS works.