Similar to 8139cp code but more inspired/lucky.
Signed-off-by: NFrancois Romieu <romieu@fr.zoreil.com>