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
|
/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
/*
* qmi-firmware-update -- Command line tool to update firmware in QMI devices
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*
* Copyright (C) 2016 Bjørn Mork <bjorn@mork.no>
* Copyright (C) 2016 Zodiac Inflight Innovations
* Copyright (C) 2016-2017 Aleksander Morgado <aleksander@aleksander.es>
*/
#include <string.h>
#include <glib-object.h>
#include <gio/gio.h>
#include "qfu-dload-message.h"
#include "qfu-utils.h"
#include "qfu-enum-types.h"
/******************************************************************************/
/* DLOAD SDP */
/* Generic message for operations that just require the command id */
typedef struct _DloadSdpReq DloadSdpReq;
struct _DloadSdpReq {
guint8 cmd;
guint16 reserved;
} __attribute__ ((packed));
G_STATIC_ASSERT (sizeof (DloadSdpReq) <= QFU_DLOAD_MESSAGE_MAX_SIZE);
gsize
qfu_dload_request_sdp_build (guint8 *buffer,
gsize buffer_len)
{
DloadSdpReq *req;
g_assert (buffer_len >= sizeof (DloadSdpReq));
/* Create request */
req = (DloadSdpReq *) buffer;
memset (buffer, 0, sizeof (DloadSdpReq));
req->cmd = (guint8) QFU_DLOAD_CMD_SDP;
g_debug ("[qfu,dload-message] sent %s:", qfu_dload_cmd_get_string ((QfuDloadCmd) req->cmd));
return (sizeof (DloadSdpReq));
}
/******************************************************************************/
/* DLOAD Ack */
typedef struct _DloadAckRsp DloadAckRsp;
struct _DloadAckRsp {
guint8 cmd; /* 0x2a */
} __attribute__ ((packed));
G_STATIC_ASSERT (sizeof (DloadAckRsp) <= QFU_DLOAD_MESSAGE_MAX_SIZE);
gboolean
qfu_dload_response_ack_parse (const guint8 *buffer,
gsize buffer_len,
GError **error)
{
DloadAckRsp *rsp;
if (buffer_len != sizeof (DloadAckRsp)) {
g_set_error (error, G_IO_ERROR, G_IO_ERROR_FAILED,
"message size mismatch: %" G_GSIZE_FORMAT " != %" G_GSIZE_FORMAT,
buffer_len, sizeof (DloadAckRsp));
return FALSE;
}
rsp = (DloadAckRsp *) buffer;
g_assert (rsp->cmd == QFU_DLOAD_CMD_ACK);
g_debug ("[qfu,dload-message] received %s:", qfu_dload_cmd_get_string ((QfuDloadCmd) rsp->cmd));
return TRUE;
}
|
