Tested. STP on/off support added.