Update to diver-avalon2.c

Possible fix to the avalon2 driver