Your epsilon definition is wrong.

it should be
#define epsilon 0.0001,
not
#define epsilon = 0.0001;