linuxmsm/diag
0
0
Fork 0
mirror of https://github.com/linux-msm/diag.git synced 2026-06-03 13:57:51 -07:00
Code Issues Packages Projects Releases Wiki Activity

perif-rpmsg: Support dedicated cmd channel

Browse Source 
On MSM8996 communication is required to go over the CMD channel, even if
we don't set the REQ_RSP feature flag when negotiating features.

So implement support for sending and receiving commands on this channel.

Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org>
This commit is contained in:
Bjorn Andersson
2018-07-12 21:56:45 -07:00
parent 386b41ab01
commit 0aa4b06c85
1 changed files with 39 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
router/peripheral-rpmsg.c
+39 -6
View File
@@ -66,20 +66,46 @@ struct devnode {
struct list_head devnodes = LIST_INIT(devnodes);
struct non_hdlc_pkt {
uint8_t start;
uint8_t version;
uint16_t length;
char payload[];
};
static int diag_cmd_recv(int fd, void *data)
{
struct peripheral *peripheral = data;
struct non_hdlc_pkt *frame;
uint8_t buf[APPS_BUF_SIZE];
ssize_t n;
ssize_t len;
n = read(fd, buf, sizeof(buf));
if (n < 0) {
len = read(fd, buf, sizeof(buf));
if (len < 0) {
if (errno != EAGAIN) {
warn("failed to read from cmd channel");
peripheral_close(peripheral);
}
}
frame = (struct non_hdlc_pkt *)buf;
if (frame->start != 0x7e || frame->version != 1) {
fprintf(stderr, "invalid non-HDLC frame\n");
return 0;
}
if (sizeof(*frame) + frame->length + 1 > len) {
fprintf(stderr, "truncated non-HDLC frame\n");
return 0;
}
if (frame->payload[frame->length] != 0x7e) {
fprintf(stderr, "non-HDLC frame is not truncated\n");
return 0;
}
dm_broadcast(frame->payload, frame->length);
return 0;
}
@@ -144,10 +170,17 @@ static int diag_data_recv(int fd, void *data)
static int perif_rpmsg_send(struct peripheral *peripheral, const void *ptr, size_t len)
{
if (peripheral->features & DIAG_FEATURE_APPS_HDLC_ENCODE)
queue_push(&peripheral->dataq, ptr, len);
struct list_head *queue;
if (peripheral->features & DIAG_FEATURE_REQ_RSP_SUPPORT)
queue = &peripheral->cmdq;
else
hdlc_enqueue(&peripheral->dataq, ptr, len);
queue = &peripheral->dataq;
if (peripheral->features & DIAG_FEATURE_APPS_HDLC_ENCODE)
queue_push(queue, ptr, len);
else
hdlc_enqueue(queue, ptr, len);
return 0;
}