Added #to_vect
Fixed cp_arbiter includes
Added mat2x2 test and doc