forked from jla3378/qtools
-
Notifications
You must be signed in to change notification settings - Fork 0
/
qident.c
118 lines (101 loc) · 3.9 KB
/
qident.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
#include "include.h"
//@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
//* Идентификация чипсетов устройств (с DMSS-протоколом)
//
void main(int argc, char* argv[]) {
unsigned char iobuf[2048];
unsigned int iolen;
char id_cmd[2]={0,0};
char flashid_cmd[4]={0x4b, 0x13, 0x15, 0};
unsigned short chip_code;
int chip_id;
int opt;
struct {
int32 hdr;
int32 diag_errno; /* Error code if error, 0 otherwise */
int32 total_no_of_blocks; /* Total number of blocks in the device */
int32 no_of_pages_per_block; /* Number of pages in a block */
int32 page_size; /* Size of page data region in bytes */
int32 total_page_size; /* Size of total page_size */
int32 maker_id; /* Device maker ID */
int32 device_id; /* Device ID */
uint8 device_type; /* 0 indicates NOR device 1 NAND */
uint8 device_name[15]; /* Device name */
} fid;
#ifndef WIN32
char devname[20]="/dev/ttyUSB0";
#else
char devname[20]="";
#endif
while ((opt = getopt(argc, argv, "p:")) != -1) {
switch (opt) {
case 'h':
printf("\n Утилита предназначена для идентификации чипсета устройств, поддерживающих DMSS-протокол.\n\
Утилита работает с диагностическим портом устройства, находящегося в нормальном (рабочем) режиме.\n\n\
Допустимы следующие ключи:\n\n\
-p <tty> - указывает имя устройства последовательного порта для общения с загрузчиком\n\
");
return;
case 'p':
strcpy(devname,optarg);
break;
case '?':
case ':':
return;
}
}
#ifdef WIN32
if (*devname == '\0')
{
printf("\n - Последовательный порт не задан\n");
return;
}
#endif
if (!open_port(devname)) {
#ifndef WIN32
printf("\n - Последовательный порт %s не открывается\n", devname);
#else
printf("\n - Последовательный порт COM%s не открывается\n", devname);
#endif
return;
}
iolen=send_cmd_base(id_cmd,1,iobuf,0);
if (iolen == 0) {
printf("\n Нет ответа на команду идентификации\n");
return;
}
if (iobuf[0] != 0) {
printf("\n Неправильный ответ на команду идентификации\n");
return;
}
// выделяем код чипсета
chip_code=*((unsigned short*)&iobuf[0x35]);
// переворачиваем chip id
chip_code=( ((chip_code&0xff)<<8) | ((chip_code&0xff00)>>8) );
// получаем ID чипсета по коду
chip_id=find_chipset(chip_code);
if (chip_id == -1) {
printf("\n Чипсет не опознан, код чипсета - %04x\n",chip_code);
return;
}
// чипсет найден
set_chipset(chip_id);
printf("\n Чипсет: %s (%08x)\n",get_chipname(),nand_cmd); fflush(stdout);
// Определяем тип и параметры флешки
iolen=send_cmd_base(flashid_cmd,4,iobuf,0);
if (iolen == 0) {
printf("\n Ошибка идентификации flash\n");
return;
}
memcpy(&fid,iobuf,sizeof(fid));
if (fid.diag_errno != 0) {
printf("\n Ошибка идентификации flash\n");
return;
}
printf("\n Flash: %s %s, vid=%02x pid=%02x",(fid.device_type?"NAND":"NOR"),fid.device_name,fid.maker_id,fid.device_id);
//printf("\n Размер EFS: %i блоков",fid.total_no_of_blocks);
printf("\n Страниц на блок: %i",fid.no_of_pages_per_block);
printf("\n Размер страницы: %i",fid.page_size);
printf("\n Размер ООВ: %i",fid.total_page_size-fid.page_size);
printf("\n");
}