Added tests, added TODOs, moved math_util, rearranged examples menu