Create function matrix_apply_parallel
Remove cg_test
Reorginization and sequential Richardson