78 lines
1.5 KiB
C
78 lines
1.5 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2018 Intel Corporation
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <kernel.h>
|
||
|
|
#include <syscall_handler.h>
|
||
|
|
#include <i2s.h>
|
||
|
|
|
||
|
|
Z_SYSCALL_HANDLER(i2s_buf_read, dev, buf, size)
|
||
|
|
{
|
||
|
|
void *mem_block;
|
||
|
|
size_t data_size;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
Z_OOPS(Z_SYSCALL_DRIVER_I2S(dev, read));
|
||
|
|
|
||
|
|
ret = i2s_read((struct device *)dev, &mem_block, &data_size);
|
||
|
|
|
||
|
|
if (!ret) {
|
||
|
|
struct i2s_config *rx_cfg;
|
||
|
|
int copy_success;
|
||
|
|
|
||
|
|
/* Presumed to be configured otherwise the i2s_read() call
|
||
|
|
* would have failed.
|
||
|
|
*/
|
||
|
|
rx_cfg = i2s_config_get((struct device *)dev, I2S_DIR_RX);
|
||
|
|
|
||
|
|
copy_success = z_user_to_copy((void *)buf, mem_block,
|
||
|
|
data_size);
|
||
|
|
|
||
|
|
k_mem_slab_free(rx_cfg->mem_slab, mem_block);
|
||
|
|
Z_OOPS(copy_success);
|
||
|
|
Z_OOPS(z_user_to_copy((void *)size, &data_size,
|
||
|
|
sizeof(data_size)));
|
||
|
|
}
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
Z_SYSCALL_HANDLER(i2s_buf_write, dev, buf, size)
|
||
|
|
{
|
||
|
|
int ret;
|
||
|
|
struct i2s_config *tx_cfg;
|
||
|
|
void *mem_block;
|
||
|
|
|
||
|
|
Z_OOPS(Z_SYSCALL_DRIVER_I2S(dev, write));
|
||
|
|
tx_cfg = i2s_config_get((struct device *)dev, I2S_DIR_TX);
|
||
|
|
if (!tx_cfg) {
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (size > tx_cfg->block_size) {
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
ret = k_mem_slab_alloc(tx_cfg->mem_slab, &mem_block, K_FOREVER);
|
||
|
|
if (ret < 0) {
|
||
|
|
return -ENOMEM;
|
||
|
|
}
|
||
|
|
|
||
|
|
ret = z_user_from_copy(mem_block, (void *)buf, size);
|
||
|
|
if (ret) {
|
||
|
|
k_mem_slab_free(tx_cfg->mem_slab, mem_block);
|
||
|
|
Z_OOPS(ret);
|
||
|
|
}
|
||
|
|
|
||
|
|
return i2s_write((struct device *)dev, mem_block, size);
|
||
|
|
}
|
||
|
|
|
||
|
|
Z_SYSCALL_HANDLER(i2s_trigger, dev, dir, cmd)
|
||
|
|
{
|
||
|
|
Z_OOPS(Z_SYSCALL_DRIVER_I2S(dev, trigger));
|
||
|
|
|
||
|
|
return _impl_i2s_trigger((struct device *)dev, dir, cmd);
|
||
|
|
}
|