qcio.c

// //
//  Драйверы для работы с Flash модема через обращения к NAND-контроллеру и процедурам загрузчика
//
#include "include.h"

// Глбальные переменные - собираем их здесь

unsigned int nand_cmd=0x1b400000;
unsigned int spp=0;
unsigned int pagesize=0;
unsigned int sectorsize=512;
unsigned int maxblock=0;     // Общее число блоков флешки
char flash_mfr[30]={0};
char flash_descr[30]={0};
unsigned int oobsize=0;
unsigned int bad_loader=0;
unsigned int flash16bit=0; // 0 - 8-битная флешка, 1 - 16-битная

unsigned int badsector;    // сектор, содержащий дефектный блок
unsigned int badflag;      // маркер дефектного блока
unsigned int badposition;  // позиция маркера дефектных блоков
unsigned int badplace;     // местоположение маркера: 0-user, 1-spare
int bch_mode=0;            // режим ЕСС: 0=R-S  1=BCH
int ecc_size;              // размер ЕСС
int ecc_bit;               // число бит, корректируемых ECC

//****************************************************************
//* Ожидание завершения операции, выполняемой контроллером nand  *
//****************************************************************
void nandwait() { 
   if (get_controller() == 0) 
     while ((mempeek(nand_status)&0xf) != 0);  // MDM
   else
     while ((mempeek(nand_status)&0x3) != 0);  // MSM
}



//*************************************88
//* Установка адресных регистров 
//*************************************
void setaddr(int block, int page) {

int adr;  
  
adr=block*ppb+page;  // # страницы от начала флешки

if (get_controller() == 0) {
  // MDM
  mempoke(nand_addr0,adr<<16);         // младшая часть адреса. 16 бит column address равны 0
  mempoke(nand_addr1,(adr>>16)&0xff);  // единственный байт старшей части адреса
}  
else {
  // MSM
  mempoke(nand_addr0,adr<<8);
}
}

//***************************************************************
//* Запуск на выполнение команды контроллера NAND с ожиданием
//***************************************************************
void exec_nand(int cmd) {

if (get_controller() == 0) {
  // MDM  
  mempoke(nand_cmd,cmd); // Сброс всех операций контроллера
  mempoke(nand_exec,0x1);
  nandwait();
}
else {
  // MSM
  mempoke(nand_cmd,cmd); // Сброс всех операций контроллера
  nandwait();
}
}



//*********************************************
//* Сброс контроллера NAND
//*********************************************
void nand_reset() {

exec_nand(1);  
}

//*********************************************
//* Чтение сектора флешки по указанному адресу 
//*********************************************

int flash_read(int block, int page, int sect) {
  
int i;

nand_reset();
// адрес
setaddr(block,page);
if (get_controller() == 0) {
  // MDM - устанавливаем код команды один раз
  mempoke(nand_cmd,0x34); // чтение data+ecc+spare
  // цикл чтения сектров до нужного нам
  for(i=0;i<(sect+1);i++) {
    mempoke(nand_exec,0x1);
    nandwait();
  }  
}
else {
  // MSM - код команды в регистр команд вводится каждый раз
  for(i=0;i<(sect+1);i++) {
    mempoke(nand_cmd,0x34); // чтение data+ecc+spare
    nandwait();
  }  
}  
if (test_badblock()) return 0;
return 1;  
}


//**********************************************8
//* Процедура активации загрузчика hello
//*
//* mode=0 - автоопределение нужности hello
//* mode=1 - принудительный запуск hello
//* mode=2 - принудительный запуск hello без настройки конфигурации 
//**********************************************8
void hello(int mode) {

int i;  
unsigned char rbuf[1024];
char hellocmd[]="\x01QCOM fast download protocol host\x03### ";


// апплет проверки работоспособности загрузчика
unsigned char cmdbuf[]={
  0x11,0x00,0x12,0x00,0xa0,0xe3,0x00,0x00,
  0xc1,0xe5,0x01,0x40,0xa0,0xe3,0x1e,0xff,
  0x2f,0xe1
};
unsigned int cfg0;

// режим тихой инициализации
if (mode == 0) {
  i=send_cmd(cmdbuf,sizeof(cmdbuf),rbuf);
  ttyflush(); 
  i=rbuf[1];
  // Проверяем, не инициализировался ли загрузчик ранее
  if (i == 0x12) {
     if (!test_loader()) {
       printf("\n Используется непатченный загрузчик - продолжение работы невозможно\n");
        exit(1);
     }  
//     printf("\n chipset = %i  base = %i",chip_type,name);
     get_flash_config();
     return;
  }  
  read(siofd,rbuf,1024);   // вычищаем хвост буера с сообщением об ошибке
}  

i=send_cmd(hellocmd,strlen(hellocmd),rbuf);
if (rbuf[1] != 2) {
   printf(" Отсылка hello...");
   i=send_cmd(hellocmd,strlen(hellocmd),rbuf);
   if (rbuf[1] != 2) {
     printf(" повторный hello возвратил ошибку!\n");
     dump(rbuf,i,0);
     return;
   }  
   printf("ok");
}  
i=rbuf[0x2c];
rbuf[0x2d+i]=0;
if (mode == 2) {
   // тихий запуск - обходим настройку чипсета
   printf("Hello ok, флеш-память: %s\n",rbuf+0x2d);
   return; 
 }  
ttyflush(); 
if (!test_loader()) {
  printf("\n Используется непатченный загрузчик - продолжение работы невозможно\n");
  exit(1);
}  

if (get_sahara()) disable_bam(); // отключаем NANDc BAM, если работаем с чипсетами нового поколения

get_flash_config();
cfg0=mempeek(nand_cfg0);
printf("\n Версия HELLO-протокола: %i",rbuf[0x22]); 
printf("\n Чипсет: %s",get_chipname()); 
printf("\n Базовый адрес NAND-контроллера: %08x",nand_cmd);
printf("\n Флеш-память: %s %s, %s",flash_mfr,(rbuf[0x2d] != 0x65)?((char*)(rbuf+0x2d)):"",flash_descr);
//printf("\n Максимальный размер пакета: %i байта",*((unsigned int*)&rbuf[0x24]));
printf("\n Размер сектора: %u байт",(cfg0&(0x3ff<<9))>>9);
printf("\n Размер страницы: %u байт (%u секторов)",pagesize,spp);
printf("\n Число страниц в блоке: %u",ppb);
printf("\n Размер OOB: %u байт",oobsize); 
printf("\n Тип ECC: %s, %i бит",bch_mode?"BCH":"R-S",ecc_bit);
printf("\n Размер ЕСС: %u байт",ecc_size);
printf("\n Размер spare: %u байт",(cfg0>>23)&0xf);
printf("\n Положение маркера дефектных блоков: ");
printf("%s+%x",badplace?"spare":"user",badposition);
printf("\n Общий размер флеш-памяти = %u блоков (%i MB)",maxblock,maxblock*ppb/1024*pagesize/1024);
printf("\n");
}

//**********************************************************
//*  Получение параметров формата флешки из контроллера
//**********************************************************
void get_flash_config() {
  
unsigned int cfg0, cfg1, nandid, pid, fid, blocksize, devcfg, chipsize;
unsigned int ecccfg;
int linuxcwsize;
int i;
int c_badmark_pos; // вычисляемая позиция маркера

struct {
  char* type;   // тектовое описание типа
  unsigned int id;      // ID флешки 
  unsigned int chipsize; // размер флешки в мегабайтах
} nand_ids[]= {

	{"NAND 16MiB 1,8V 8-bit",	0x33, 16},
	{"NAND 16MiB 3,3V 8-bit",	0x73, 16}, 
	{"NAND 16MiB 1,8V 16-bit",	0x43, 16}, 
	{"NAND 16MiB 3,3V 16-bit",	0x53, 16}, 

	{"NAND 32MiB 1,8V 8-bit",	0x35, 32},
	{"NAND 32MiB 3,3V 8-bit",	0x75, 32},
	{"NAND 32MiB 1,8V 16-bit",	0x45, 32},
	{"NAND 32MiB 3,3V 16-bit",	0x55, 32},

	{"NAND 64MiB 1,8V 8-bit",	0x36, 64},
	{"NAND 64MiB 3,3V 8-bit",	0x76, 64},
	{"NAND 64MiB 1,8V 16-bit",	0x46, 64},
	{"NAND 64MiB 3,3V 16-bit",	0x56, 64},

	{"NAND 128MiB 1,8V 8-bit",	0x78, 128},
	{"NAND 128MiB 1,8V 8-bit",	0x39, 128},
	{"NAND 128MiB 3,3V 8-bit",	0x79, 128},
	{"NAND 128MiB 1,8V 16-bit",	0x72, 128},
	{"NAND 128MiB 1,8V 16-bit",	0x49, 128},
	{"NAND 128MiB 3,3V 16-bit",	0x74, 128},
	{"NAND 128MiB 3,3V 16-bit",	0x59, 128},

	{"NAND 256MiB 3,3V 8-bit",	0x71, 256},

	/*512 Megabit */
	{"NAND 64MiB 1,8V 8-bit",	0xA2, 64},   
	{"NAND 64MiB 1,8V 8-bit",	0xA0, 64},
	{"NAND 64MiB 3,3V 8-bit",	0xF2, 64},
	{"NAND 64MiB 3,3V 8-bit",	0xD0, 64},
	{"NAND 64MiB 1,8V 16-bit",	0xB2, 64},
	{"NAND 64MiB 1,8V 16-bit",	0xB0, 64},
	{"NAND 64MiB 3,3V 16-bit",	0xC2, 64},
	{"NAND 64MiB 3,3V 16-bit",	0xC0, 64},

	/* 1 Gigabit */
	{"NAND 128MiB 1,8V 8-bit",	0xA1,128},
	{"NAND 128MiB 3,3V 8-bit",	0xF1,128},
	{"NAND 128MiB 3,3V 8-bit",	0xD1,128},
	{"NAND 128MiB 1,8V 16-bit",	0xB1,128},
	{"NAND 128MiB 3,3V 16-bit",	0xC1,128},
	{"NAND 128MiB 1,8V 16-bit",     0xAD,128},

	/* 2 Gigabit */
	{"NAND 256MiB 1.8V 8-bit",	0xAA,256},
	{"NAND 256MiB 3.3V 8-bit",	0xDA,256},
	{"NAND 256MiB 1.8V 16-bit",	0xBA,256},
	{"NAND 256MiB 3.3V 16-bit",	0xCA,256},

	/* 4 Gigabit */
	{"NAND 512MiB 1.8V 8-bit",	0xAC,512},
	{"NAND 512MiB 3.3V 8-bit",	0xDC,512},
	{"NAND 512MiB 1.8V 16-bit",	0xBC,512},
	{"NAND 512MiB 3.3V 16-bit",	0xCC,512},

	/* 8 Gigabit */
	{"NAND 1GiB 1.8V 8-bit",	0xA3,1024},
	{"NAND 1GiB 3.3V 8-bit",	0xD3,1024},
	{"NAND 1GiB 1.8V 16-bit",	0xB3,1024},
	{"NAND 1GiB 3.3V 16-bit",	0xC3,1024},

	/* 16 Gigabit */
	{"NAND 2GiB 1.8V 8-bit",	0xA5,2048},
	{"NAND 2GiB 3.3V 8-bit",	0xD5,2048},
	{"NAND 2GiB 1.8V 16-bit",	0xB5,2048},
	{"NAND 2GiB 3.3V 16-bit",	0xC5,2048},

	/* 32 Gigabit */
	{"NAND 4GiB 1.8V 8-bit",	0xA7,4096},
	{"NAND 4GiB 3.3V 8-bit",	0xD7,4096},
	{"NAND 4GiB 1.8V 16-bit",	0xB7,4096},
	{"NAND 4GiB 3.3V 16-bit",	0xC7,4096},

	/* 64 Gigabit */
	{"NAND 8GiB 1.8V 8-bit",	0xAE,8192},
	{"NAND 8GiB 3.3V 8-bit",	0xDE,8192},
	{"NAND 8GiB 1.8V 16-bit",	0xBE,8192},
	{"NAND 8GiB 3.3V 16-bit",	0xCE,8192},

	/* 128 Gigabit */
	{"NAND 16GiB 1.8V 8-bit",	0x1A,16384},
	{"NAND 16GiB 3.3V 8-bit",	0x3A,16384},
	{"NAND 16GiB 1.8V 16-bit",	0x2A,16384},
	{"NAND 16GiB 3.3V 16-bit",	0x4A,16384},
                                                  
	/* 256 Gigabit */
	{"NAND 32GiB 1.8V 8-bit",	0x1C,32768},
	{"NAND 32GiB 3.3V 8-bit",	0x3C,32768},
	{"NAND 32GiB 1.8V 16-bit",	0x2C,32768},
	{"NAND 32GiB 3.3V 16-bit",	0x4C,32768},

	/* 512 Gigabit */
	{"NAND 64GiB 1.8V 8-bit",	0x1E,65536},
	{"NAND 64GiB 3.3V 8-bit",	0x3E,65536},
	{"NAND 64GiB 1.8V 16-bit",	0x2E,65536},
	{"NAND 64GiB 3.3V 16-bit",	0x4E,65536},
	{0,0,0},
};


struct  {
  unsigned int id;
  char* name;
}  nand_manuf_ids[] = {
	{0x98, "Toshiba"},
	{0xec, "Samsung"},
	{0x04, "Fujitsu"},
	{0x8f, "National"},
	{0x07, "Renesas"},
	{0x20, "ST Micro"},
	{0xad, "Hynix"},
	{0x2c, "Micron"},
	{0xc8, "Elite Semiconductor"},
	{0x01, "Spansion/AMD"},
	{0xef, "Winbond"},
	{0x0, 0}
};

mempoke(nand_cmd,0x8000b); // команда Extended Fetch ID
mempoke(nand_exec,1); 
nandwait();
nandid=mempeek(NAND_FLASH_READ_ID); // получаем ID флешки
chipsize=0;

fid=(nandid>>8)&0xff;
pid=nandid&0xff;

// Определяем производителя флешки
i=0;
while (nand_manuf_ids[i].id != 0) {
	if (nand_manuf_ids[i].id == pid) {
	strcpy(flash_mfr,nand_manuf_ids[i].name);
	break;
	}
i++;
}  
    
// Определяем емкость флешки
i=0;
while (nand_ids[i].id != 0) {
if (nand_ids[i].id == fid) {
	chipsize=nand_ids[i].chipsize;
	strcpy(flash_descr,nand_ids[i].type);
	break;
	}
i++;
}  
if (chipsize == 0) {
	printf("\n Неопределенный Flash ID = %02x",fid);
}  

// Вынимаем параметры конфигурации

cfg0=mempeek(nand_cfg0);
cfg1=mempeek(nand_cfg1);
ecccfg=mempeek(nand_ecc_cfg);
sectorsize=512;
//sectorsize=(cfg0&(0x3ff<<9))>>9; //UD_SIZE_BYTES = blocksize

devcfg = (nandid>>24) & 0xff;
pagesize = 1024 << (devcfg & 0x3); // размер страницы в байтах
blocksize = 64 << ((devcfg >> 4) & 0x3);  // размер блока в килобайтах
spp = pagesize/sectorsize; // секторов в странице

if ((((cfg0>>6)&7)|((cfg0>>2)&8)) == 0) {
  // для старых чипсетов младшие 2 байта CFG0 надо настраивать руками
  if (!bad_loader) mempoke(nand_cfg0,(cfg0|0x40000|(((spp-1)&8)<<2)|(((spp-1)&7)<<6)));
}  

// Определяем тип и размер ЕСС
if (((cfg1>>27)&1) != 0) bch_mode=1;
if (bch_mode) { 
  // для BCH 
  ecc_size=(ecccfg>>8)&0x1f; 
  ecc_bit=((ecccfg>>4)&3) ? (((ecccfg>>4)&3)+1)*4 : 4;
}
else {
  // Для R-S
  ecc_size=(cfg0>>19)&0xf;
  ecc_bit=4;
}  

badposition=(cfg1>>6)&0x3ff;
badplace=(cfg1>>16)&1;

linuxcwsize=528;
if (bch_mode && (ecc_bit == 8)) linuxcwsize=532;

// Настройка бедмаркера, если он не автонастроился

c_badmark_pos = (pagesize-(linuxcwsize*(spp-1))+1);
if (badposition == 0) {
  printf("\n! Внимание - положение маркера дефектных блоков автоопределено!\n");  
  badplace=0;
  badposition=c_badmark_pos;
}  
if (badposition != c_badmark_pos) {
  printf("\n! Внимание - текущее положение маркера дефектных блоков %x не совпадает с расчетным %x!\n",
     badposition,c_badmark_pos);  
}

// проверяем признак 16-битной флешки
if ((cfg1&2) != 0) flash16bit=1;
if (chipsize != 0)   maxblock=chipsize*1024/blocksize;
else                 maxblock=0x800;

if (oobsize == 0) {
	// Micron MT29F4G08ABBEA3W: на самом деле 224, определяется 128, 
	// реально используется 160, для raw-режима нагляднее 256 :)
	if (nandid == 0x2690ac2c) oobsize = 256; 
	else oobsize = (8 << ((devcfg >> 2) & 0x1)) * (pagesize >> 9);
} 

}


//**********************************************
//* Отключение аппаратного контроля бедблоков
//**********************************************
void hardware_bad_off() {

int cfg1;

cfg1=mempeek(nand_cfg1);
cfg1 &= ~(0x3ff<<6);
mempoke(nand_cfg1,cfg1);
}

//**********************************************
//* Включение аппаратного контроля бедблоков
//**********************************************
void hardware_bad_on() {

int cfg1;

cfg1=mempeek(nand_cfg1);
cfg1 &= ~(0x7ff<<6);
cfg1 |= (badposition &0x3ff)<<6; // смещение до маркера
cfg1 |= badplace<<16;            // область, где расположен маркер (user/spare)
mempoke(nand_cfg1,cfg1);
}

//**********************************************
//* Установка позиции маркера
//**********************************************
void set_badmark_pos (int pos, int place) {

badposition=pos;
badplace=place&1;
hardware_bad_on();
}


//**********************************
//* Закрытие потока данных раздела
//**********************************
int qclose(int errmode) {
unsigned char iobuf[600];
unsigned char cmdbuf[]={0x15};
int iolen;

iolen=send_cmd(cmdbuf,1,iobuf);
if (!errmode) return 1;
if (iobuf[1] == 0x16) return 1;
show_errpacket("close()",iobuf,iolen);
return 0;

}  

//************************
//* Стирание блока флешки  
//************************

void block_erase(int block) {
  
int oldcfg;  
  
nand_reset();
mempoke(nand_addr0,block*ppb);         // младшая часть адреса - # страницы
mempoke(nand_addr1,0);                 // старшая часть адреса - всегда 0

oldcfg=mempeek(nand_cfg0);
mempoke(nand_cfg0,oldcfg&~(0x1c0));    // устанавливаем CW_PER_PAGE=0, как требует даташит

mempoke(nand_cmd,0x3a); // стирание. Бит Last page установлен
mempoke(nand_exec,0x1);
nandwait();
mempoke(nand_cfg0,oldcfg);   // восстанавливаем CFG0
}

//****************************************
//* Отключение NANDc BAM
//****************************************
void disable_bam() {

unsigned int i,nandcstate[256];

for (i=0;i<0xec;i+=4) nandcstate[i]=mempeek(nand_cmd+i); // сохраняем состояние контроллера NAND
mempoke(0xfc401a40,1); // GCC_QPIC_BCR
mempoke(0xfc401a40,0); // полный асинхронный сброс QPIC
for (i=0;i<0xec;i+=4) mempoke(nand_cmd+i,nandcstate[i]);  // восстанавливаем состояние
mempoke(nand_exec,1); // фиктивное чтение для снятия защиты адресных регистров контроллера от записи
}


//****************************************************
//* Проверка массива на ненулевые значения
//*
//*  0 - в массиве одни нули
//*  1 - в массиве есть ненули
//****************************************************
int test_zero(unsigned char* buf, int len) {
  
int i;
for (i=0;i<len;i++)
  if (buf[i] != 0) return 1;
return 0;
}

//***************************************************************
//* Идентификация чипсета через апплет по сигнатуре загрузчика
//*
//* return -1 - загрузчик не поддерживает команду 11
//*         0 - в загрузчике не найдена сигнатура идентификации чипсета
//*         остальное - код чипсета из загрузчика 
//***************************************************************
int identify_chipset() {

char cmdbuf[]={ 
  0x11,0x00,0x04,0x10,0x2d,0xe5,0x0e,0x00,0xa0,0xe1,0x03,0x00,0xc0,0xe3,0xff,0x30,
  0x80,0xe2,0x34,0x10,0x9f,0xe5,0x04,0x20,0x90,0xe4,0x01,0x00,0x52,0xe1,0x03,0x00,
  0x00,0x0a,0x03,0x00,0x50,0xe1,0xfa,0xff,0xff,0x3a,0x00,0x00,0xa0,0xe3,0x00,0x00,
  0x00,0xea,0x00,0x00,0x90,0xe5,0x04,0x10,0x9d,0xe4,0x01,0x00,0xc1,0xe5,0xaa,0x00,
  0xa0,0xe3,0x00,0x00,0xc1,0xe5,0x02,0x40,0xa0,0xe3,0x1e,0xff,0x2f,0xe1,0xef,0xbe,
  0xad,0xde
};
unsigned char iobuf[1024];
send_cmd(cmdbuf,sizeof(cmdbuf),iobuf);
if (iobuf[1] != 0xaa) return -1;
return iobuf[2];
}

//*******************************************************
//* Проверка работы патча загрузчика
//*
//* Возвращает 0, если команда 11 не поддерживается
//* и устанавливает глобальную переменную bad_loader=1
//*******************************************************
int test_loader() {

int i;

i=identify_chipset();
//printf("\n ident = %i\n",i);
if (i<=0) {
  bad_loader=1;
  return 0;
}
if (chip_type == 0) set_chipset(i); // если чипсет не был явно задан
return 1;
}

//****************************************************************
//*  Проверка флага дефектного блока предыдущей операции чтения 
//*
//* 0 -нет бедблока
//* 1 -есть
//****************************************************************

int test_badblock() {

unsigned int st,r,badflag=0;

// Старшие 2 байта регистра nand_buffer_status отражают прочитанный с флешки маркер. 
// Для 8-битных флешек  используется только младший байт, для 16-битных - оба байта
st=r=mempeek(nand_buffer_status)&0xffff0000;
if (flash16bit == 0) {
  if (st != 0xff0000) { 
    badflag=1;  
//     printf("\nst=%08x",r);    
  }
}  
else  if (st != 0xffff0000) badflag=1;
return badflag;
}


//*********************************
//*  Проверка дефектности блока
//*********************************
int check_block(int blk) {

nand_reset(); // сброс
setaddr(blk,0);
mempoke(nand_cmd,0x34); // чтение data+ecc+spare
mempoke(nand_exec,0x1);
nandwait();
return test_badblock();
}  

//*********************************
//* Запись bad-маркера
//*********************************
void write_badmark(unsigned int blk, int val) {
  
char buf[1000];
const int udsize=0x220;
int i;
unsigned int cfg1bak,cfgeccbak;

cfg1bak=mempeek(nand_cfg1);
cfgeccbak=mempeek(nand_ecc_cfg);
mempoke(nand_ecc_cfg,mempeek(nand_ecc_cfg)|1); 
mempoke(nand_cfg1,mempeek(nand_cfg1)|1); 

hardware_bad_off();
memset(buf,val,udsize);
buf[0]=0xeb;   // признак искусственно созданного бедблока

nand_reset();
nandwait();

setaddr(blk,0);
mempoke(nand_cmd,0x39); // запись data+ecc+spare
for (i=0;i<spp;i++) {
 memwrite(sector_buf, buf, udsize);
 mempoke(nand_exec,1);
 nandwait();
}
hardware_bad_on();
mempoke(nand_cfg1,cfg1bak);
mempoke(nand_ecc_cfg,cfgeccbak);
}


//************************************************
//* Установка bad-маркера
//* -> 0 - блок и так был дефектным
//*    1 - был нормальным и сделан дефектным
//**********************************************
int mark_bad(unsigned int blk) {

//flash_read(blk,0,0);  
if (!check_block(blk)) {  
 write_badmark(blk,0);
 return 1;
}
return 0;
}


//************************************************
//* Снятие bad-маркера
//* -> 0 - блок не был дефектным
//*    1 - был дефектным и сделан нормальным
//************************************************
int unmark_bad(unsigned int blk) {
  

//flash_read(blk,0,0);  
if (check_block(blk)) {  
 block_erase(blk);
 return 1;
}
return 0;
}

//****************************************************
//* Проверка буфера на наличие заполнителя бедблоков
//****************************************************
int test_badpattern(unsigned char* buf) {
  
int i;
for(i=0;i<512;i++) {
  if (buf[i] != 0xbb) return 0;
}
return 1;
}

//**********************************************************
//* Установка размера поля данных сектора
//**********************************************************
void set_udsize(unsigned int size) {

unsigned int tmpreg=mempeek(nand_cfg0);  

tmpreg=(tmpreg&(~(0x3ff<<9)))|(size<<9); // CFG0.UD_SIZE_BYTES
mempoke(nand_cfg0,tmpreg);

if (((mempeek(nand_cfg1)>>27)&1) != 0) { // BCH ECC
  tmpreg=mempeek(nand_ecc_cfg);
  tmpreg=(tmpreg&(~(0x3ff<<16))|(size<<16)); //ECC_CFG.ECC_NUM_DATA_BYTES
  mempoke(nand_ecc_cfg,tmpreg);
}  
}

//**********************************************************
//* Установка размера поля spare
//**********************************************************
void set_sparesize(unsigned int size) {

unsigned int cfg0=mempeek(nand_cfg0);  
cfg0=cfg0&(~(0xf<<23))|(size<<23); //SPARE_SIZE_BYTES 
mempoke(nand_cfg0,cfg0);
}

//**********************************************************
//* Установка размера поля ECC
//**********************************************************
void set_eccsize(unsigned int size) {

uint32 cfg0, cfg1, ecccfg, bch_mode=0;

cfg1=mempeek(nand_cfg1);
  
// Определяем тип ЕСС
if (((cfg1>>27)&1) != 0) bch_mode=1;
  
if (bch_mode) {
  ecccfg=mempeek(nand_ecc_cfg);
  ecccfg= (ecccfg&(~(0x1f<<8))|(size<<8));
  mempoke(nand_ecc_cfg,ecccfg);
}  
else {
  cfg0=mempeek(nand_cfg0);  
  cfg0=cfg0&(~(0xf<<19))|(size<<19); //ECC_PARITY_SIZE_BYTES = eccs
  mempoke(nand_cfg0,cfg0);
} 
}

  
//**********************************************************
//*  Установка формата сектора в конфигурации контроллера
//*
//*  udsize - размер данных в байтах
//*  ss - размер spare в хз каких единицах
//*  eccs - размер ecc в байтах
//**********************************************************
void set_blocksize(unsigned int udsize, unsigned int ss,unsigned int eccs) {

set_udsize(udsize);
set_sparesize(ss);
set_eccsize(eccs);
}

//******************************************************************
//*  Получение текущего udsize
//******************************************************************
int get_udsize() {

return ( mempeek(nand_cfg0) & (0x3ff<<9) )>>9;
}  
  

//******************************************************************
//* Разбор параметров ключа, определяющего позицию бедмаркера
//*
//* Формат параметра:
//*   xxx  - маркер в области данных сектора
//*   Uxxx - маркер в области данных сектора
//*   Sxxx - маркер в области ООВ (в spare)
//*
//*  badpos - позиция маркера
//*  badloc - область, где расположен маркер (0-user, 1-spare)
//******************************************************************
void parse_badblock_arg(char* arg, int* badpos, int* badloc) {

char* str=arg;
  
*badloc=0;
if       (toupper(str[0]) == 'U') str++;
else if  (toupper(str[0]) == 'S') {
  *badloc=1;
  str++;
}

sscanf(str,"%x",badpos);
}


//***************************************************************
//* Определение состояния ЕСС-коррекции после операции чтения
//*
//* Возвращает:
//*  0 - не было коррекции
//* -1 - некорректируемая ошибка
//* >0 - число скорректированных ошибок
//***************************************************************

int check_ecc_status() {
  
int bs;

bs=mempeek(nand_buffer_status);
if (((bs&0x100) != 0) && ((mempeek(nand_cmd+0xec) & 0x40) == 0)) return -1; // некорректируемая ошибка
return bs&0x1f; // 	число корректируемых ошибок
}

//***************************************************************
//*  Сброс движка ЕСС ВСН
//***************************************************************
void bch_reset() {

int cfgecctemp;  
  
if (!bch_mode) return;
cfgecctemp=mempeek(nand_ecc_cfg); // конфигурация с учётом включения/отключения ECC
mempoke(nand_ecc_cfg,cfgecctemp|2); // сброс движка BCH
mempoke(nand_ecc_cfg,cfgecctemp); // восстановление конфигурации BCH
}