TODO: treat saddle points correctly

Signed-off-by: Titouan Rigoudy <titouan.rigoudy@gmail.com>
Added epsilon to getEquiPoint and other things

Signed-off-by: Titouan Rigoudy <titouan.rigoudy@gmail.com>