Port Code (or write it)

[joemahmah]

After the code has been documented, it must be ported to the new arm. Assuming the old code is halfway decent, this should be limited to a little of [CTRL] + [C], [CTRL] + [V], and some minor changes to variables.