forked from nxp-imx/mfgtools
-
Notifications
You must be signed in to change notification settings - Fork 0
/
sdps.cpp
135 lines (115 loc) · 4.08 KB
/
sdps.cpp
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
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
/*
* Copyright 2018 NXP.
*
* Redistribution and use in source and binary forms, with or without modification,
* are permitted provided that the following conditions are met:
*
* Redistributions of source code must retain the above copyright notice, this
* list of conditions and the following disclaimer.
*
* Redistributions in binary form must reproduce the above copyright notice, this
* list of conditions and the following disclaimer in the documentation and/or
* other materials provided with the distribution.
*
* Neither the name of the NXP Semiconductor nor the names of its
* contributors may be used to endorse or promote products derived from this
* software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*
*/
#include <string>
#include "sdps.h"
#include "hidreport.h"
#include "liberror.h"
#include "libcomm.h"
#include "buffer.h"
#include "sdp.h"
//------------------------------------------------------------------------------
// HID Command Block Wrapper (CBW)
//------------------------------------------------------------------------------
#pragma pack (1)
typedef struct _CDBHIDDOWNLOAD {
uint8_t Command;
uint32_t Length;
uint8_t Reserved[11];
} CDBHIDDOWNLOAD, *PCDBHIDDOWNLOAD;
struct _ST_HID_CBW
{
uint32_t Signature; // Signature: 0x43544C42:1129598018, o "BLTC" (little endian) for the BLTC CBW
uint32_t Tag; // Tag: to be returned in the csw
uint32_t XferLength; // XferLength: number of bytes to transfer
uint8_t Flags; // Flags:
// Bit 7: direction - device shall ignore this bit if the
// XferLength field is zero, otherwise:
// 0 = data-out from the host to the device,
// 1 = data-in from the device to the host.
// Bits 6..0: reserved - shall be zero.
uint8_t Reserved[2]; // Reserved - shall be zero.
CDBHIDDOWNLOAD Cdb; // cdb: the command descriptor block
};
#define BLTC_DOWNLOAD_FW 2
#define HID_BLTC_REPORT_TYPE_DATA_OUT 2
#define HID_BLTC_REPORT_TYPE_COMMAND_OUT 1
#define CBW_BLTC_SIGNATURE 0x43544C42; // "BLTC" (little endian)
#define CBW_PITC_SIGNATURE 0x43544950; // "PITC" (little endian)
// Flags values for _ST_HID_CBW
#define CBW_DEVICE_TO_HOST_DIR 0x80; // "Data Out"
#define CBW_HOST_TO_DEVICE_DIR 0x00; // "Data In"
#pragma pack ()
int SDPSCmd::run(CmdCtx *pro)
{
HIDTrans dev;
if(dev.open(pro->m_dev))
return -1;
shared_ptr<FileBuffer> p = get_file_buffer(m_filename);
if (!p)
return -1;
ROM_INFO * rom;
rom = search_rom_info(pro->m_config_item);
if (rom == NULL)
{
set_last_err_string("Fail found ROM info");
return -1;
}
HIDReport report(&dev);
report.m_skip_notify = false;
if (m_offset >= p->size())
{
set_last_err_string("Offset bigger than file size");
return -1;
}
size_t sz = GetContainerActualSize(p, m_offset);
if (!(rom->flags & ROM_INFO_HID_NO_CMD))
{
_ST_HID_CBW cbw;
uint32_t length = (uint32_t) sz;
memset(&cbw, 0, sizeof(_ST_HID_CBW));
cbw.Cdb.Command = BLTC_DOWNLOAD_FW;
cbw.Cdb.Length = EndianSwap(length);
++cbw.Tag;
cbw.Signature = CBW_BLTC_SIGNATURE;
cbw.XferLength = (uint32_t)length;
cbw.Flags = CBW_HOST_TO_DEVICE_DIR;
int ret = report.write(&cbw, sizeof(_ST_HID_CBW), HID_BLTC_REPORT_TYPE_COMMAND_OUT);
if (ret)
return ret;
}
int ret = report.write(p->data() + m_offset, sz, 2);
if (ret == 0)
{
SDPBootlogCmd log(NULL);
log.run(pro);
}
return ret;
}