Started and changed to Eigen

Still have to fix MAP and maybe a few other things. Need to figure out
how to include Eigen properly.