removed all old codes, updated herkulex interface as class based, DRS40x/60x support