Check Tx queue state before waking

Signed-off-by: Stefan Wahren <stefan.wahren@i2se.com>