Updated Eigen to Version 3
!! double check setConstant !!!
Fixed gcc compiler probs
need to find an alternative for _finite for linux
fixed file locations and added ground plane