Bugs Fixeds

USB Stack bugs fixeds and adapted to work with XC8, #warning added and
should remain until XC8 becomes better