Wrote function to setup controller.
Added UPLOAD_CONFIG state.
Fixed bugs in test script.