Add beta hysteresis support

Following grbl example.