Remove useless tryDirectPath()
Add eigen matrix initialization, add another eps coef, correct indentation