Start using eigen for matrix and vector manipulation