Changed the diagonal to be a VectorXd
adding kepler test