Finished control test bench and other changes

fixed a few bugs with control, recompiled control schematic and bench
test schematic