Expectation Maximization C++ code review

As a side project to get into machine learning I am trying to implement an expectation maximization algorithm in C++ but I am going wrong somewhere.

Would anyone be willing to look over my code and help me understand where I am going wrong?

edit: here is a link to the code https://bitbucket.org/MathanCompBioakes/em/src/56e1489b7a7dbe7060c8b39efacdac58c4c297c7/em.cpp?at=master