Subversion Repositories Projects

Rev

Rev 737 | Rev 757 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 737 Rev 738
Line 122... Line 122...
122 
                write_ascii_string_pgm(23, 2, VM_PAL);
 122 
                write_ascii_string_pgm(23, 2, VM_PAL);
123 
        }
 123 
        }
Line 124... Line 124...
124 
 
 124 
 
125 
        // request version from board
 125 
        // request version from board
- 
 
 126 
        rxd_buffer_locked = 0;
126 
        rxd_buffer_locked = 0;
 127 
        usart1_EnableTXD();
127 
        #if FCONLY
 128 
        #if FCONLY
128 
        usart1_request_mk_data(0, 'v', 0);
 129 
                //usart1_request_mk_data(0, 'v', 0);
- 
 
 130 
                write_ascii_string_pgm(2, 11, PSTR("FC VERSION: ........"));
129 
        write_ascii_string_pgm(2, 11, PSTR("FC VERSION: ........"));
 131 
                usart1_puts_pgm(PSTR(REQUEST_FC_VERSION));
130 
        #else
 132 
        #else
- 
 
 133 
                //usart1_request_mk_data(1, 'v', 0);   
131 
        usart1_request_mk_data(1, 'v', 0);
 134 
                usart1_puts_pgm(PSTR(REQUEST_NC_VERSION));
132 
        write_ascii_string_pgm(2, 11, PSTR("NC VERSION: ........"));
 135 
                write_ascii_string_pgm(2, 11, PSTR("NC VERSION: ........"));
- 
 
 136 
        #endif
133 
        #endif
 137 
        usart1_DisableTXD();
134 
        // wait for response
 138 
        // wait for response
135 
        while (rxd_buffer_locked == 0) {
 139 
        while (rxd_buffer_locked == 0) {
136 
                asm("nop");
 140 
                asm("nop");
137 
        }
 141 
        }
Line 149... Line 153...
149 
        COSD_DISPLAYMODE %= (sizeof(fcdisplaymodes) / sizeof(displaymode_t));
 153 
        COSD_DISPLAYMODE %= (sizeof(fcdisplaymodes) / sizeof(displaymode_t));
150 
        mode = fcdisplaymodes;
 154 
        mode = fcdisplaymodes;
151 
        mode += COSD_DISPLAYMODE;
 155 
        mode += COSD_DISPLAYMODE;
152 
        osd_fcmode = (int(*)(void)) pgm_read_word(&mode->dfun);
 156 
        osd_fcmode = (int(*)(void)) pgm_read_word(&mode->dfun);
153 
        // re-request data ever 100ms from FC;
 157 
        // re-request data ever 100ms from FC;
154 
        usart1_request_mk_data(0, 'd', 100);
 158 
        //usart1_request_mk_data(0, 'd', 100);
155 
        #else
 159 
        #else
156 
        COSD_DISPLAYMODE %= (sizeof(ncdisplaymodes) / sizeof(displaymode_t));
 160 
        COSD_DISPLAYMODE %= (sizeof(ncdisplaymodes) / sizeof(displaymode_t));
157 
        mode = ncdisplaymodes;
 161 
        mode = ncdisplaymodes;
158 
        mode += COSD_DISPLAYMODE;
 162 
        mode += COSD_DISPLAYMODE;
159 
        osd_ncmode = (int(*)(void)) pgm_read_word(&mode->dfun);
 163 
        osd_ncmode = (int(*)(void)) pgm_read_word(&mode->dfun);
160 
        // re-request OSD Data from NC every 100ms
 164 
        // re-request OSD Data from NC every 100ms
161 
        usart1_request_mk_data(1, 'o', 100);
 165 
        //usart1_request_mk_data(1, 'o', 100);
162 
        #endif
 166 
        #endif
Line 163... Line 167...
163 
 
 167 
 
164 
    _delay_ms(3000);
 168 
    _delay_ms(3000);
165 
    clear();
 169 
    clear();