void OSD::detectMode()
{
//read STAT and auto detect Mode PAL/NTSC
max7456_on();
byte osdstat_r;
if(!FLAGS.mode_auto) {
goto no_auto;
}else {
osdstat_r = MAX_read(MAX7456_STAT_reg_read);//status register
if ((B00000001 & osdstat_r) != 0){ //PAL
setMode(1);
FLAGS.PAL_NTSC = 1; // remember in case of camera off
}
else if((B00000010 & osdstat_r) != 0){ //NTSC
setMode(0);
FLAGS.PAL_NTSC = 0; // remember in case of camera off
}
else if((B00000100 & osdstat_r) != 0){ //loss of sync
no_auto:
if (FLAGS.PAL_NTSC) //NTSC
setMode(1);
else //PAL
setMode(0);
}
}
max7456_off();
}
void OSD::detectMode()
{
//read STAT and auto detect Mode PAL/NTSC
max7456_on();
byte osdstat_r = MAX_read(MAX7456_STAT_reg_read);//status register
if ((B00000001 & osdstat_r) != 0) { //PAL
setMode(1);
}
else if((B00000010 & osdstat_r) != 0) { //NTSC
setMode(0);
}
else if((B00000100 & osdstat_r) != 0) { //loss of sync
// setMode(1); // PAL without video
if (flags.PAL_NTSC) //NTSC
setMode(0);
else //PAL
setMode(1);
}
//If no signal was detected so it uses EEPROM config
else {
/* if (flags.PAL_NTSC) //NTSC
setMode(0);
else //PAL
setMode(1);
*/
}
max7456_off();
}
void OSD::hw_init() {
max7456_on();
//read black level register
byte osdbl_r = MAX_read(MAX7456_OSDBL_reg_read);//black level read register
MAX_write(MAX7456_VM0_reg, MAX7456_RESET | video_mode);
delay_150();
//set black level
MAX_write(MAX7456_OSDBL_reg, (osdbl_r & 0xef)); //black level write register - Set bit 4 to zero 11101111 - Enable automatic OSD black level control
// set position - may be EEPROM.read(OSD_SHIFT_X)
MAX_write(MAX7456_HOS_reg, 0x20); // 0x20 default
MAX_write(MAX7456_VOS_reg, 0x10); // 0x10 default
MAX_write(MAX7456_OSDM_reg, 0b00010010); // 0x00011011 default
setBrightness();
// define sync (auto,int,ext)
// MAX_write(MAX7456_VM0_reg, MAX7456_DISABLE_display | video_mode);
MAX_write(MAX7456_VM0_reg, (MAX7456_ENABLE_display_vert | video_mode) | MAX7456_SYNC_internal);
delay_150();
MAX_write(MAX7456_VM0_reg, (MAX7456_ENABLE_display_vert | video_mode) | MAX7456_SYNC_autosync);
max7456_off();
}
void OSD::hw_init(){
max7456_on();
//read black level register
byte osdbl_r = MAX_read(MAX7456_OSDBL_reg_read); //black level read register
MAX_write(MAX7456_VM0_reg, MAX7456_RESET | video_mode);
delay_150();
//set black level
MAX_write(MAX7456_OSDBL_reg, (osdbl_r & 0xef)); //black level write register - Set bit 4 to zero 11101111 - Enable automatic OSD black level control
MAX_write(MAX7456_OSDM_reg, 0b00010010); // 0x00011011 default
// define sync (auto,int,ext)
MAX_write(MAX7456_VM0_reg, (MAX7456_ENABLE_display_vert | video_mode) | MAX7456_SYNC_internal); // first time on internal sync
delay_150();
MAX_write(MAX7456_VM0_reg, (MAX7456_ENABLE_display_vert | video_mode) | MAX7456_SYNC_autosync); // and then switch to auto mode
// max7456_off();
adjust();
}
void OSD::write_NVM(uint16_t font_count, uint8_t *character_bitmap)
{
byte x;
byte char_address_hi;
byte screen_char;
char_address_hi = font_count;
// byte char_address_lo = 0; - autoincrement mode
// cli(); - нет смысла
max7456_on();
MAX_mode( MAX7456_DISABLE_display);
MAX_write(MAX7456_CMAH_reg, char_address_hi);// set start address high
for(x = 0; x < NVM_ram_size; x++) {// write out 54 (out of 64) bytes of character to shadow ram
screen_char = *character_bitmap++;
MAX_write(MAX7456_CMAL_reg, x);// set start address low
MAX_write(MAX7456_CMDI_reg, screen_char);
}
// transfer a 54 bytes from shadow ram to NVM
MAX_write(MAX7456_CMM_reg, WRITE_nvr);
// wait until bit 5 in the status register returns to 0 (12ms)
#if 0
while (1) {
Spi.transfer(MAX7456_STAT_reg_read);
if(!(Spi.transfer(0xff) & STATUS_reg_nvr_busy)) break;
}
#else
while (1) {
if(!(MAX_read(MAX7456_STAT_reg_read) & STATUS_reg_nvr_busy)) break;
extern void delay_telem();
delay_telem(); // some delay
}
#endif
MAX_mode( MAX7456_ENABLE_display_vert);// turn on screen next vertical
max7456_off();
}
void OSD::reset(){
max7456_on();
byte cnt=15;
while(cnt-- && !( MAX_read(MAX7456_STAT_reg_read) & 0x7) ) {//read status register - sync to soft-only versions
byte j=3;
#ifdef SLAVE_BUILD
while(j--) osd_spi->transfer(0xff); // try to sync
#else
while(j--) SPI::transfer(0xff); // try to sync
#endif
delay_15();
}
MAX_mode( MAX7456_RESET | video_mode );
delay_15();
hw_init();
}
void OSD::detectMode()
{
//read STAT and auto detect Mode PAL/NTSC
digitalWrite(MAX7456_SELECT,LOW);
byte osdstat_r = MAX_read(MAX7456_STAT_reg_read);//status register
if ((B00000001 & osdstat_r) != 0){ //PAL
setMode(1);
}
else if((B00000010 & osdstat_r) != 0){ //NTSC
setMode(0);
}
//If no signal was detected so it uses EEPROM config
else{
if (flags.PAL_NTSC) //NTSC
setMode(0);
else //PAL
setMode(1);
}
digitalWrite(MAX7456_SELECT,HIGH);
}
void OSD::hw_init(){
digitalWrite(MAX7456_SELECT,LOW);
//read black level register
byte osdbl_r = MAX_read(MAX7456_OSDBL_reg_read);//black level read register
MAX_write(MAX7456_VM0_reg, MAX7456_RESET | video_mode);
delay(150);
//set black level
MAX_write(MAX7456_OSDBL_reg, (osdbl_r & 0xef)); //black level write register - Set bit 4 to zero 11101111 - Enable automatic OSD black level control
// set position - may be EEPROM.read(OSD_SHIFT_X)
MAX_write(MAX7456_HOS_reg, 0x20); // 0x20 default
MAX_write(MAX7456_VOS_reg, 0x10); // 0x10 default
// MAX_write(MAX7456_HOS_reg, sets.horiz_offs); // 0x20 default
// MAX_write(MAX7456_VOS_reg, sets.vert_offs); // 0x10 default
setBrightness();
// define sync (auto,int,ext) and
// making sure the Max7456 is enabled
control(1);
}
