Fixed tons of linkage issues with moving App_SW from C to C++. Added basic testbench.