#include <defs.h>
#include <stub.c>
#include "bitbang_functions.c"

void main(){
        unsigned int i, j, k;
        reg_wb_enable =1; // for enable writing to reg_debug_1 and reg_debug_2
        reg_debug_1  = 0x0;
        reg_debug_2  = 0x0;

        reg_mprj_io_37 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_36 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_35 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_34 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_33 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_32 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_31 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_30 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_29 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_28 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_27 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_26 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_25 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_24 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_23 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_22 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_21 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_20 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_19 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_18 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_17 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_16 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_15 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_14 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_13 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_12 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_11 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_10 = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_9  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_8  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_7  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_6  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_5  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_4  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_3  = GPIO_MODE_MGMT_STD_OUTPUT ;
        reg_mprj_io_2  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_1  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_0  = GPIO_MODE_MGMT_STD_OUTPUT;
        reg_mprj_io_0  = GPIO_MODE_MGMT_STD_OUTPUT;

        // bitbang
        // Configure all as output except reg_mprj_io_3
        clock_in_right_o_left_o_standard(0); // 18	and 19	
        clock_in_right_o_left_o_standard(0); // 17	and 20	
        clock_in_right_o_left_o_standard(0); // 16	and 21	
        clock_in_right_o_left_o_standard(0); // 15	and 22	
        clock_in_right_o_left_o_standard(0); // 14	and 23	
        clock_in_right_o_left_o_standard(0); // 13	and 24	
        clock_in_right_o_left_o_standard(0); // 12	and 25	
        clock_in_right_o_left_o_standard(0); // 11	and 26	
        clock_in_right_o_left_o_standard(0); // 10	and 27	
        clock_in_right_o_left_o_standard(0); // 9	and 28	
        clock_in_right_o_left_o_standard(0); // 8	and 29	
        clock_in_right_o_left_o_standard(0); // 7	and 30	
        clock_in_right_o_left_o_standard(0); // 6	and 31	
        clock_in_right_o_left_o_standard(0); // 5	and 32	
        clock_in_right_o_left_o_standard(0); // 4	and 33	
        clock_in_right_o_left_o_standard(0); // 3	and 34	
        clock_in_right_o_left_o_standard(0); // 2	and 35	
        clock_in_right_o_left_o_standard(0); // 1	and 36	
        clock_in_right_o_left_o_standard(0); // 0 and 37	
        load();
        reg_debug_1 = 0xFF; // finish configuration 
        reg_mprj_datal = 0x0;
        reg_mprj_datah = 0x0;
        i = 0x20;
        for (j = 0; j < 5; j++) {
                reg_mprj_datah = i;
                reg_debug_2 = 37-j;
                reg_mprj_datah = 0x00000000;
                reg_debug_2 = 0;
                i >>=1;
                i |= 0x20;
        }
        i = 0x80000000;
        for (j = 0; j < 32; j++) {
                reg_mprj_datah = 0x3f;
                reg_mprj_datal = i;
                reg_debug_2 = 32-j;
                reg_mprj_datah = 0x00;
                reg_mprj_datal = 0x00000000;
                reg_debug_2 = 0;
                i >>=1;
                i |= 0x80000000;
        }

}