Add polynomial functions to funcs.go, write PolExpand function