Cleaned up code, Added logic to enable/disable estop code via USE_ESTOP variable, Default set to off.