mirror of
https://github.com/linux-msm/diag.git
synced 2026-02-25 13:11:48 -08:00
6edf2d5a0f
Registered the Extended Build ID request command and implemented its handler. Signed-off-by: Eyal Ilsar <eilsar@codeaurora.org> [bjorn: Moved implementation to app_cmds.c] Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org>
118 lines
3.8 KiB
C
118 lines
3.8 KiB
C
/*
|
|
* Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
|
|
* Copyright (c) 2016, Linaro Ltd.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright notice,
|
|
* this list of conditions and the following disclaimer.
|
|
*
|
|
* 2. 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.
|
|
*
|
|
* 3. Neither the name of the copyright holder 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 <err.h>
|
|
#include <errno.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#include "diag.h"
|
|
#include "hdlc.h"
|
|
#include "util.h"
|
|
|
|
#define DIAG_CMD_KEEP_ALIVE_SUBSYS 50
|
|
#define DIAG_CMD_KEEP_ALIVE_CMD 3
|
|
|
|
#define DIAG_CMD_DIAG_VERSION_ID 28
|
|
#define DIAG_PROTOCOL_VERSION_NUMBER 2
|
|
|
|
#define DIAG_CMD_EXTENDED_BUILD_ID 124
|
|
#define MOBILE_MODEL_NUMBER 0
|
|
#define MOBILE_SOFTWARE_REVISION "OE"
|
|
#define MOBILE_MODEL_STRING "DB410C"
|
|
#define MSM_REVISION_NUMBER 2
|
|
|
|
static int handle_diag_version(struct diag_client *client, const void *buf,
|
|
size_t len)
|
|
{
|
|
struct {
|
|
uint8_t cmd_code;
|
|
uint8_t ver;
|
|
} __packed resp;
|
|
|
|
if (len != sizeof(uint8_t))
|
|
return -EMSGSIZE;
|
|
|
|
resp.cmd_code = *(uint8_t*)buf;
|
|
resp.ver = DIAG_PROTOCOL_VERSION_NUMBER;
|
|
|
|
return hdlc_enqueue(&client->outq, &resp, sizeof(resp));
|
|
}
|
|
|
|
static int handle_extended_build_id(struct diag_client *client,
|
|
const void *buf, size_t len)
|
|
{
|
|
struct {
|
|
uint8_t cmd_code;
|
|
uint8_t ver;
|
|
uint16_t reserved;
|
|
uint32_t msm_rev;
|
|
uint32_t mobile_model_number;
|
|
char strings[];
|
|
} __packed *resp;
|
|
size_t resp_size;
|
|
size_t string1_size = strlen(MOBILE_SOFTWARE_REVISION) + 1;
|
|
size_t string2_size = strlen(MOBILE_MODEL_STRING) + 1;
|
|
size_t strings_size = string1_size + string2_size;
|
|
|
|
if (len != sizeof(uint8_t))
|
|
return -EMSGSIZE;
|
|
|
|
resp_size = sizeof(*resp) + strings_size;
|
|
resp = malloc(resp_size);
|
|
if (!resp)
|
|
err(1, "failed to allocate build id response\n");
|
|
|
|
memset(resp, 0, resp_size);
|
|
resp->cmd_code = *(uint8_t*)buf;
|
|
resp->ver = DIAG_PROTOCOL_VERSION_NUMBER;
|
|
resp->msm_rev = MSM_REVISION_NUMBER;
|
|
resp->mobile_model_number = MOBILE_MODEL_NUMBER;
|
|
strncpy(resp->strings, MOBILE_SOFTWARE_REVISION, string1_size);
|
|
strncpy(resp->strings + string1_size, MOBILE_MODEL_STRING, string2_size);
|
|
|
|
return hdlc_enqueue(&client->outq, resp, resp_size);
|
|
}
|
|
|
|
static int handle_keep_alive(struct diag_client *client, const void *buf,
|
|
size_t len)
|
|
{
|
|
return hdlc_enqueue(&client->outq, buf, len);
|
|
}
|
|
|
|
void register_app_cmds(void)
|
|
{
|
|
register_cmd(DIAG_CMD_DIAG_VERSION_ID, handle_diag_version);
|
|
register_cmd(DIAG_CMD_EXTENDED_BUILD_ID, handle_extended_build_id);
|
|
register_subsys_cmd(DIAG_CMD_KEEP_ALIVE_SUBSYS, DIAG_CMD_KEEP_ALIVE_CMD,
|
|
handle_keep_alive);
|
|
}
|