Add control test program

A control node test program has been added. It mainly works, but
the sequence numbers are not currently being set.