Serial version of FMM working now