rt2x00: Move code into seperate functions