Fixed arguments in rhs functions. Implemented FE integration. Going into testing sooooooooooooon.