67 lines
2.0 KiB
C
67 lines
2.0 KiB
C
|
/* arch/arm/mach-msm/qdsp5/adsp_lpm_verify_cmd.c
|
||
|
|
*
|
||
|
|
* Verificion code for aDSP LPM packets from userspace.
|
||
|
|
*
|
||
|
|
* Copyright (C) 2008 Google, Inc.
|
||
|
|
* Copyright (c) 2008-2009, The Linux Foundation. All rights reserved.
|
||
|
|
*
|
||
|
|
* This software is licensed under the terms of the GNU General Public
|
||
|
|
* License version 2, as published by the Free Software Foundation, and
|
||
|
|
* may be copied, distributed, and modified under those terms.
|
||
|
|
*
|
||
|
|
* 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.
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <mach/qdsp5/qdsp5lpmcmdi.h>
|
||
|
|
#include "adsp.h"
|
||
|
|
#include <mach/debug_mm.h>
|
||
|
|
|
||
|
|
int adsp_lpm_verify_cmd(struct msm_adsp_module *module,
|
||
|
|
unsigned int queue_id, void *cmd_data,
|
||
|
|
size_t cmd_size)
|
||
|
|
{
|
||
|
|
uint32_t cmd_id, col_height, input_row_incr, output_row_incr,
|
||
|
|
input_size, output_size;
|
||
|
|
uint32_t size_mask = 0x0fff;
|
||
|
|
lpm_cmd_start *cmd;
|
||
|
|
|
||
|
|
if (queue_id != QDSP_lpmCommandQueue) {
|
||
|
|
MM_ERR("module %s: wrong queue id %d\n",
|
||
|
|
module->name, queue_id);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
cmd = (lpm_cmd_start *)cmd_data;
|
||
|
|
cmd_id = cmd->cmd_id;
|
||
|
|
|
||
|
|
if (cmd_id == LPM_CMD_START) {
|
||
|
|
if (cmd_size != sizeof(lpm_cmd_start)) {
|
||
|
|
MM_ERR("module %s: wrong size %d, \
|
||
|
|
expect %d\n", module->name,
|
||
|
|
cmd_size, sizeof(lpm_cmd_start));
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
col_height = cmd->ip_data_cfg_part1 & size_mask;
|
||
|
|
input_row_incr = cmd->ip_data_cfg_part2 & size_mask;
|
||
|
|
output_row_incr = cmd->op_data_cfg_part1 & size_mask;
|
||
|
|
input_size = col_height * input_row_incr;
|
||
|
|
output_size = col_height * output_row_incr;
|
||
|
|
if ((cmd->ip_data_cfg_part4 && adsp_pmem_fixup(module,
|
||
|
|
(void **)(&cmd->ip_data_cfg_part4),
|
||
|
|
input_size)) ||
|
||
|
|
(cmd->op_data_cfg_part3 && adsp_pmem_fixup(module,
|
||
|
|
(void **)(&cmd->op_data_cfg_part3),
|
||
|
|
output_size)))
|
||
|
|
return -1;
|
||
|
|
} else if (cmd_id > 1) {
|
||
|
|
MM_ERR("module %s: invalid cmd_id %d\n", module->name, cmd_id);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|