added member function to copy matrix back to ctypes pointer
Made skeleton for main integration function
Rough integration function. Now Python and cpp implementation his the same