Implement algorithms for nalgebra types

This probably is quite a bit of work but should be fairly straight forward to do. `ndarray` and `nalgebra` support could both be behind features so that users can decide which they want (and thus avoid pulling in unnecessary dependencies).