|
|
#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-ptable",0x10000},
|
|
|
{"M3Boot_R11",0x200000},
|
|
|
{"Ptable",0x10000},
|
|
|
{"Fastboot",0x110000},
|
|
|
{"Logo",0x130000},
|
|
|
{"Kernel",0x30000},
|
|
|
{"Kernel_R11",0x90000},
|
|
|
{"VxWorks",0x40000},
|
|
|
{"VxWorks_R11",0x220000},
|
|
|
{"M3Image",0x50000},
|
|
|
{"M3Image_R11",0x230000},
|
|
|
{"DSP",0x60000},
|
|
|
{"DSP_R11",0x240000},
|
|
|
{"Nvdload",0x70000},
|
|
|
{"Nvdload_R11",0x250000},
|
|
|
{"Nvimg",0x80000},
|
|
|
{"System",0x590000},
|
|
|
{"System",0x100000},
|
|
|
{"APP",0x570000},
|
|
|
{"APP",0x5a0000},
|
|
|
{"Oeminfo",0xa0000},
|
|
|
{"CDROMISO",0xb0000},
|
|
|
{"Oeminfo",0x550000},
|
|
|
{"Oeminfo",0x510000},
|
|
|
{"Oeminfo",0x1a0000},
|
|
|
{"WEBUI",0x560000},
|
|
|
{"WEBUI",0x5b0000},
|
|
|
{"Wimaxcfg",0x170000},
|
|
|
{"Wimaxcrf",0x180000},
|
|
|
{"Userdata",0x190000},
|
|
|
{"Online",0x1b0000},
|
|
|
{"Online",0x5d0000},
|
|
|
{"Online",0x5e0000},
|
|
|
{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 int err;
|
|
|
|
|
|
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);
|
|
|
|
|
|
|
|
|
for (err=0;err<10;err++) {
|
|
|
|
|
|
if (err == 10) {
|
|
|
printf("\n Превышено число попыток входа в режим\n");
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
write(siofd,datamodecmd,strlen(datamodecmd));
|
|
|
res=read(siofd,replybuf,6);
|
|
|
if (res != 6) {
|
|
|
printf("\n Неправильная длина ответа на ^DATAMODE, повторяем попытку...");
|
|
|
continue;
|
|
|
}
|
|
|
if (memcmp(replybuf,OKrsp,6) != 0) {
|
|
|
printf("\n Команда ^DATAMODE отвергнута, повторяем попытку...");
|
|
|
continue;
|
|
|
}
|
|
|
|
|
|
iolen=send_cmd(cmdver,1,replybuf);
|
|
|
if ((iolen == 0)||(replybuf[1] != 0x0d)) {
|
|
|
printf("\n Ошибка получения версии протокола, повторяем попытку...");
|
|
|
continue;
|
|
|
}
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
i=replybuf[2];
|
|
|
replybuf[3+i]=0;
|
|
|
printf("ok");
|
|
|
printf("\n Версия протокола: %s",replybuf+3);
|
|
|
printf("\n");
|
|
|
|
|
|
if ((optind>=argc)&rflag) goto reset; // перезагрузка без указания файла
|
|
|
|
|
|
|
|
|
// Главный цикл записи разделов
|
|
|
for(part=0;part<npart;part++) {
|
|
|
printf("\r Записываем раздел %i - %s\n",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);
|
|
|
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",replybuf[1],replybuf[2],replybuf[3]);
|
|
|
// dump(replybuf,iolen,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);
|
|
|
}
|