Add 2d math and fix some bugs.
Merge github.com:Kent-Na/tc_math

Conflicts:
	filter_1d.h