im zweifelsfall machs in assembler - das sind auch nur 3 zeilen

oder such mal nach "shift left" beim cc5x