Adding driver code for the wsg50 and catkinization.