Added matrix generic functions
Merge branch 'pako-devel' of https://github.com/pakozm/april-ann into pako-devel