We have been developing similar things for quite some time both in Matlab and more recently in Python (for a better dissemination outside of academia) and we'd be glad also to look at your work, if it's licensed openly.
www.openpiv.net
www.openptv.net