mirror of
https://git.zaage.it/robert/balong-flash
synced 2024-11-16 06:15:21 +00:00
405 lines
14 KiB
C
405 lines
14 KiB
C
#include <stdio.h>
|
||
#include <stdlib.h>
|
||
#include <string.h>
|
||
#include <sys/types.h>
|
||
#include <sys/stat.h>
|
||
#include <fcntl.h>
|
||
#include <strings.h>
|
||
#include <termios.h>
|
||
#include <unistd.h>
|
||
#include <arpa/inet.h>
|
||
|
||
#include "hdlcio.h"
|
||
|
||
//******************************************************
|
||
//* поиск символического имени раздела по его коду
|
||
//******************************************************
|
||
|
||
void find_pname(unsigned int id,unsigned char* pname) {
|
||
|
||
unsigned int j;
|
||
struct {
|
||
char name[20];
|
||
int code;
|
||
} pcodes[]={
|
||
{"M3Boot",0x20000},
|
||
{"M3Boot_R11",0x200000},
|
||
{"Ptable",0x10000},
|
||
{"Fastboot",0x110000},
|
||
{"Kernel",0x30000},
|
||
{"Kernel_R11",0x90000},
|
||
{"VxWorks",0x40000},
|
||
{"VxWorks_R11",0x220000},
|
||
{"M3Image",0x50000},
|
||
{"M3Image_R11",0x230000},
|
||
{"DSP",0x60000},
|
||
{"DSP_R11",0x240000},
|
||
{"NVRAM",0x70000},
|
||
{"NVRAM_R11",0x250000},
|
||
{"System",0x590000},
|
||
{"APP",0x5a0000},
|
||
{"CD_WUI_VER",0xa0000},
|
||
{"CDROMISO",0xb0000},
|
||
{"WEBUI",0x5b0000},
|
||
{0,0}
|
||
};
|
||
|
||
for(j=0;pcodes[j].code != 0;j++) {
|
||
if(pcodes[j].code == id) break;
|
||
}
|
||
if (pcodes[j].code != 0) strcpy(pname,pcodes[j].name); // имя найдено - копируем его в структуру
|
||
else sprintf(pname,"U%08x",id); // имя не найдено - подставляем псевдоимя Uxxxxxxxx в тупоконечном формате
|
||
}
|
||
|
||
|
||
//@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
|
||
|
||
void main(int argc, char* argv[]) {
|
||
|
||
unsigned int i,j,res,opt,npart=0,iolen,part,blk,blksize;
|
||
FILE* in;
|
||
FILE* out;
|
||
|
||
struct {
|
||
unsigned int offset; // позиция образа раздела
|
||
unsigned int hdoffset; // позиция заголовка раздела
|
||
unsigned int size; // размер образа раздела
|
||
unsigned int hdsize; // размер заголовка раздела
|
||
unsigned int code; // ID раздела
|
||
unsigned char pname[20]; // буквенное имя раздела
|
||
unsigned char filename[50]; // имя файла, соответствующее разделу
|
||
}ptable[100];
|
||
|
||
unsigned char buf[4096];
|
||
unsigned char devname[50]="/dev/ttyUSB0";
|
||
unsigned char replybuf[4096];
|
||
unsigned char datamodecmd[]="AT^DATAMODE";
|
||
unsigned char resetcmd[]="AT^RESET";
|
||
|
||
unsigned char OKrsp[]={0x0d, 0x0a, 0x4f, 0x4b, 0x0d, 0x0a};
|
||
unsigned char NAKrsp[]={0x03, 0x00, 0x02, 0xba, 0x0a, 0x7e};
|
||
|
||
unsigned int dpattern=0xa55aaa55;
|
||
unsigned int mflag=0,eflag=0,rflag=0,sflag=0,nflag=0;
|
||
unsigned char filename [100];
|
||
|
||
unsigned char fdir[40]; // каталог для мультифайловой прошивки
|
||
|
||
unsigned char cmdver[7]={0x0c}; // версия протокола
|
||
unsigned char cmddone[7]={0x1}; // команда выхода из HDLC
|
||
unsigned char cmd_reset[7]={0xa}; // команда выхода из HDLC
|
||
unsigned char cmd_dload_init[15]={0x41}; // команда начала раздела
|
||
unsigned char cmd_data_packet[11000]={0x42}; // команда начала пакета
|
||
unsigned char cmd_dload_end[30]={0x43}; // команда конца раздела
|
||
// Коды типов разделов
|
||
//-d - попытка переключить модем из режима HDLC в АТ-режим\n\
|
||
|
||
while ((opt = getopt(argc, argv, "hp:mersn")) != -1) {
|
||
switch (opt) {
|
||
case 'h':
|
||
|
||
printf("\n Утилита предназначена для прошивки модемов E3372S\n\n\
|
||
%s [ключи] <имя файла для загрузки или имя каталога с файлами>\n\n\
|
||
Допустимы следующие ключи:\n\n\
|
||
-p <tty> - последовательный порт для общения с загрузчиком (по умолчанию /dev/ttyUSB0)\n\
|
||
-n - режим мультифайловой прошивки из указанного каталога\n\
|
||
-m - вывести карту файла прошивки и завершить работу\n\
|
||
-e - разобрать файл прошивки на разделы без заголовков\n\
|
||
-s - разобрать файл прошивки на разделы с заголовками\n\
|
||
-r - выйти из режима прошивки и перезагрузить модем\n\
|
||
\n",argv[0]);
|
||
return;
|
||
|
||
case 'p':
|
||
strcpy(devname,optarg);
|
||
break;
|
||
|
||
case 'm':
|
||
mflag=1;
|
||
break;
|
||
|
||
case 'n':
|
||
nflag=1;
|
||
break;
|
||
|
||
case 'r':
|
||
rflag=1;
|
||
break;
|
||
|
||
case 'e':
|
||
eflag=1;
|
||
break;
|
||
|
||
case 's':
|
||
sflag=1;
|
||
break;
|
||
|
||
case '?':
|
||
case ':':
|
||
return;
|
||
}
|
||
}
|
||
|
||
if (eflag&sflag) {
|
||
printf("\n Ключи -s и -e несовместимы\n");
|
||
return;
|
||
}
|
||
|
||
if (nflag&(eflag|sflag|mflag)) {
|
||
printf("\n Ключ -n несовместим с ключами -s, -m и -e\n");
|
||
return;
|
||
}
|
||
|
||
|
||
// ------ перезагрузка без указания файла
|
||
//--------------------------------------------
|
||
if ((optind>=argc)&rflag) goto sio;
|
||
|
||
|
||
// Открытие входного файла
|
||
//--------------------------------------------
|
||
if (optind>=argc) {
|
||
if (nflag)
|
||
printf("\n - Не указан каталог с файлами\n");
|
||
else
|
||
printf("\n - Не указано имя файла для загрузки\n");
|
||
return;
|
||
}
|
||
|
||
if (nflag)
|
||
// для -n - просто копируем префикс
|
||
strncpy(fdir,argv[optind],39);
|
||
else {
|
||
// для однофайловых операций
|
||
in=fopen(argv[optind],"r");
|
||
if (in == 0) {
|
||
printf("\n Ошибка открытия %s",argv[optind]);
|
||
return;
|
||
}
|
||
}
|
||
|
||
|
||
// Поиск разделов внутри файла
|
||
//--------------------------------------------
|
||
|
||
if (!nflag) {
|
||
printf("\n Разбираем файл прошвки...");
|
||
while (fread(&i,1,4,in) == 4) {
|
||
if (i != dpattern) continue; // ищем разделитель
|
||
|
||
// Выделяем параметры раздела
|
||
ptable[npart].hdoffset=ftell(in); // позиция начала заголовка раздела
|
||
fread(buf,1,96,in); // заголовок
|
||
ptable[npart].hdsize=*((unsigned int*)&buf[0])-4; // размер заголовка
|
||
ptable[npart].offset=ptable[npart].hdoffset+ptable[npart].hdsize; // смещение до тела раздела
|
||
ptable[npart].size=*((unsigned int*)&buf[20]); // размер раздела
|
||
ptable[npart].code=*((unsigned int*)&buf[16]); // тип раздела
|
||
|
||
// Ищем символическое имя раздела по таблице
|
||
find_pname(ptable[npart].code,ptable[npart].pname);
|
||
// увеличиваем счетчик разделов
|
||
npart++;
|
||
}
|
||
if (npart == 0) {
|
||
printf("\nРазделы не найдены!");
|
||
return ;
|
||
}
|
||
}
|
||
|
||
// Поиск файлов прошивок в указанном каталоге
|
||
//--------------------------------------------
|
||
else {
|
||
printf("\n Поиск файлов-образов разделов...\n\n ## Размер ID Имя Файл\n-----------------------------------------------------------------\n");
|
||
for (npart=0;npart<30;npart++) {
|
||
if (find_file(npart, fdir, ptable[npart].filename, &ptable[npart].code, &ptable[npart].size) == 0) break; // конец поиска - раздела с таким ID не нашли
|
||
// получаем символическое имя раздела
|
||
find_pname(ptable[npart].code,ptable[npart].pname);
|
||
printf("\n %02i %8i %08x %-8.8s %s",npart,ptable[npart].size,ptable[npart].code,ptable[npart].pname,ptable[npart].filename);
|
||
}
|
||
}
|
||
|
||
printf("\n Найдено %i разделов",npart);
|
||
|
||
|
||
//------ Режим вывода карты файла прошивки
|
||
//--------------------------------------------
|
||
|
||
if (mflag) {
|
||
printf("\n Таблица разделов, найденных в файле:\n\n ## Смещение Размер Имя\n-------------------------------------");
|
||
for (i=0;i<npart;i++)
|
||
printf("\n %02i %08x %8i %s",i,ptable[i].offset,ptable[i].size,ptable[i].pname);
|
||
printf("\n");
|
||
return;
|
||
}
|
||
|
||
|
||
//------- Режим разрезания файла прошивки
|
||
//--------------------------------------------
|
||
if (eflag|sflag) {
|
||
printf("\n Выделение разделов из файла прошивки:\n\n ## Смещение Размер Имя\n-------------------------------------");
|
||
for (i=0;i<npart;i++) {
|
||
printf("\n %02i %08x %8i %s",i,ptable[i].offset,ptable[i].size,ptable[i].pname);
|
||
// формируем имя файла
|
||
sprintf(filename,"%02i-%08x-%s.%s",i,ptable[i].code,ptable[i].pname,(eflag?"bin":"fw"));
|
||
out=fopen(filename,"w");
|
||
|
||
if(sflag) {
|
||
// запись заголовка
|
||
fwrite(&dpattern,1,4,out); // маркер- magic заголовка блока
|
||
fseek(in,ptable[i].hdoffset,SEEK_SET); // встаем на начало заголовка
|
||
fread(buf,1,ptable[i].offset-ptable[i].hdoffset,in);
|
||
fwrite(buf,1,ptable[i].offset-ptable[i].hdoffset,out);
|
||
}
|
||
// запись тела
|
||
fseek(in,ptable[i].offset,SEEK_SET); // встаем на начало
|
||
for(j=0;j<ptable[i].size;j+=4) {
|
||
fread(buf,4,1,in);
|
||
fwrite(buf,4,1,out);
|
||
}
|
||
fclose(out);
|
||
}
|
||
printf("\n");
|
||
return;
|
||
}
|
||
|
||
|
||
sio:
|
||
//--------- Основной режим - запись прошивки
|
||
//--------------------------------------------
|
||
|
||
// Настройка SIO
|
||
|
||
if (!open_port(devname)) {
|
||
#ifndef WIN32
|
||
printf("\n - Последовательный порт %s не открывается\n", devname);
|
||
#else
|
||
printf("\n - Последовательный порт COM%s не открывается\n", devname);
|
||
#endif
|
||
return;
|
||
}
|
||
|
||
|
||
tcflush(siofd,TCIOFLUSH); // очистка выходного буфера
|
||
|
||
// выходим из режима HDLC - если модем уже был в нем
|
||
port_timeout(1);
|
||
send_cmd(cmddone,1,replybuf);
|
||
|
||
|
||
|
||
// Входим в HDLC-режим
|
||
printf("\n Входим в режим HDLC...");
|
||
port_timeout(100);
|
||
i=0;
|
||
|
||
rehdlc:
|
||
if (i == 10) {
|
||
printf("превышено число попыток входа в режим\n");
|
||
return;
|
||
}
|
||
|
||
write(siofd,datamodecmd,strlen(datamodecmd));
|
||
res=read(siofd,replybuf,6);
|
||
if (res != 6) {
|
||
printf("\n Неправильная длина ответ на DATAMODE\n");
|
||
dump(replybuf,res,0);
|
||
return;
|
||
}
|
||
i++;
|
||
if (memcmp(replybuf,NAKrsp,6) == 0) goto rehdlc;
|
||
|
||
if (memcmp(replybuf,OKrsp,6) != 0) {
|
||
printf("\n Неправильный ответ на DATAMODE\n");
|
||
dump(replybuf,res,0);
|
||
return;
|
||
}
|
||
|
||
printf("ok");
|
||
iolen=send_cmd(cmdver,1,replybuf);
|
||
if ((iolen == 0)||(replybuf[1] != 0x0d)) {
|
||
printf("\n Ошибка команды GET_VERSION\n");
|
||
if (iolen != 0) dump(replybuf,iolen,0);
|
||
return;
|
||
}
|
||
i=replybuf[2];
|
||
replybuf[3+i]=0;
|
||
printf("\n Версия протокола: %s",replybuf+3);
|
||
printf("\n");
|
||
|
||
if ((optind>=argc)&rflag) goto reset; // перезагрузка без указания файла
|
||
|
||
|
||
// Главный цикл записи разделов
|
||
for(part=0;part<npart;part++) {
|
||
printf("\n Записываем раздел %i - %s",part,ptable[part].pname);
|
||
|
||
// заполняем командный пакет
|
||
*((unsigned int*)&cmd_dload_init[1])=htonl(ptable[part].code);
|
||
*((unsigned int*)&cmd_dload_init[5])=htonl(ptable[part].size);
|
||
// отсылаем команду
|
||
iolen=send_cmd(cmd_dload_init,12,replybuf);
|
||
if ((iolen == 0) || (replybuf[1] != 2)) {
|
||
printf("\n Заголовок раздела не принят, код ошибки = %02x %02x %02x\n",replybuf[1],replybuf[2],replybuf[3]);
|
||
dump(cmd_dload_init,13,0);
|
||
printf("\nreply\n");
|
||
dump(replybuf,iolen,0);
|
||
return;
|
||
}
|
||
|
||
// Подготовка к поблочному циклу
|
||
blksize=4096; // начальное значение размера блока
|
||
if (!nflag)
|
||
// встаем на начало раздела в однофайловом режиме
|
||
fseek(in,ptable[part].offset,SEEK_SET);
|
||
else
|
||
// открываем файл в многофайловом режиме
|
||
in=fopen(ptable[part].filename,"r");
|
||
|
||
// Поблочный цикл
|
||
for(blk=0;blk<((ptable[part].size+4095)/4096);blk++) {
|
||
printf("\r Блок %i из %i",blk,(ptable[part].size+4095)/4096); fflush(stdout);
|
||
res=ptable[part].size+ptable[part].offset-ftell(in); // размер оставшегося куска до конца файла
|
||
if (res<4096) blksize=res; // корректируем размер последнего блока
|
||
*(unsigned int*)&cmd_data_packet[1]=htonl(blk+1); // # пакета
|
||
*(unsigned short*)&cmd_data_packet[5]=htons(blksize); // размер блока
|
||
fread(cmd_data_packet+7,1,blksize,in); // читаем очередной кусок раздела в буфер команды
|
||
iolen=send_cmd(cmd_data_packet,blksize+7,replybuf); // отсылаем команду
|
||
if ((iolen == 0) || (replybuf[1] != 2)) {
|
||
printf("\n Блок %i раздела не принят, код ошибки = %02x %02x %02x\n",blk,replybuf[1],replybuf[2],replybuf[3]);
|
||
// dump(cmd_data_packet,blksize+7,0);
|
||
return;
|
||
}
|
||
}
|
||
|
||
// Закрытие файла в многофайловом режиме
|
||
if (nflag) fclose(in);
|
||
|
||
// Закрытие потока
|
||
*((unsigned int*)&cmd_dload_end[1])=htonl(ptable[part].size);
|
||
*((unsigned int*)&cmd_dload_end[8])=htonl(ptable[part].code);
|
||
iolen=send_cmd(cmd_dload_end,24,replybuf); // отсылаем команду
|
||
if ((iolen == 0) || (replybuf[1] != 2)) {
|
||
printf("\n Ошибка закрытия раздела, код ошибки = %02x %02x %02x\n",blk,replybuf[1],replybuf[2],replybuf[3]);
|
||
dump(replybuf,iolen,0);
|
||
printf("\nИсходная команда:");
|
||
dump(cmd_data_packet,24,0);
|
||
return;
|
||
}
|
||
|
||
}
|
||
// Конец главного цикла
|
||
printf("\n");
|
||
|
||
|
||
port_timeout(1);
|
||
// выходим из режима HDLC и перезагружаемся
|
||
reset:
|
||
|
||
if (rflag) {
|
||
printf("\n Перезарузка модема...\n");
|
||
send_cmd(cmd_reset,1,replybuf);
|
||
write(siofd,resetcmd,strlen(resetcmd));
|
||
}
|
||
else send_cmd(cmddone,1,replybuf);
|
||
}
|