stlink: dequeue CSW write only if it doesn't change csw_default