int wcd9xxx_init_slimslave(struct wcd9xxx *wcd9xxx, u8 wcd9xxx_pgd_la)
{
int ret = 0;
ret = wcd9xxx_configure_ports(wcd9xxx);
if (ret) {
pr_err("%s: Failed to configure register address offset\n",
__func__);
goto err;
}
ret = wcd9xxx_alloc_slim_sh_ch_rx(wcd9xxx, wcd9xxx_pgd_la);
if (ret) {
pr_err("%s: Failed to alloc rx slimbus shared channels\n",
__func__);
goto err;
}
ret = wcd9xxx_alloc_slim_sh_ch_tx(wcd9xxx, wcd9xxx_pgd_la);
if (ret) {
pr_err("%s: Failed to alloc tx slimbus shared channels\n",
__func__);
goto tx_err;
}
return 0;
tx_err:
wcd9xxx_dealloc_slim_sh_ch_rx(wcd9xxx);
err:
return ret;
}
int wcd9xxx_init_slimslave(struct wcd9xxx *wcd9xxx, u8 wcd9xxx_pgd_la,
unsigned int tx_num, unsigned int *tx_slot,
unsigned int rx_num, unsigned int *rx_slot)
{
int ret = 0;
int i;
ret = wcd9xxx_configure_ports(wcd9xxx);
if (ret) {
pr_err("%s: Failed to configure register address offset\n",
__func__);
goto err;
}
if (wcd9xxx->rx_chs) {
wcd9xxx->num_rx_port = rx_num;
for (i = 0; i < rx_num; i++) {
wcd9xxx->rx_chs[i].ch_num = rx_slot[i];
INIT_LIST_HEAD(&wcd9xxx->rx_chs[i].list);
}
ret = wcd9xxx_alloc_slim_sh_ch(wcd9xxx, wcd9xxx_pgd_la,
wcd9xxx->num_rx_port,
wcd9xxx->rx_chs,
SLIM_SINK);
if (ret) {
pr_err("%s: Failed to alloc %d rx slimbus channels\n",
__func__, wcd9xxx->num_rx_port);
kfree(wcd9xxx->rx_chs);
wcd9xxx->rx_chs = NULL;
wcd9xxx->num_rx_port = 0;
}
} else {
pr_err("Not able to allocate memory for %d slimbus rx ports\n",
wcd9xxx->num_rx_port);
}
if (wcd9xxx->tx_chs) {
wcd9xxx->num_tx_port = tx_num;
for (i = 0; i < tx_num; i++) {
wcd9xxx->tx_chs[i].ch_num = tx_slot[i];
INIT_LIST_HEAD(&wcd9xxx->tx_chs[i].list);
}
ret = wcd9xxx_alloc_slim_sh_ch(wcd9xxx, wcd9xxx_pgd_la,
wcd9xxx->num_tx_port,
wcd9xxx->tx_chs,
SLIM_SRC);
if (ret) {
pr_err("%s: Failed to alloc %d tx slimbus channels\n",
__func__, wcd9xxx->num_tx_port);
kfree(wcd9xxx->tx_chs);
wcd9xxx->tx_chs = NULL;
wcd9xxx->num_tx_port = 0;
}
} else {
pr_err("Not able to allocate memory for %d slimbus tx ports\n",
wcd9xxx->num_tx_port);
}
mutex_init(&slim_tx_master.lock);
init_completion(&slim_tx_master.slim_s.sb_comp);
return 0;
err:
return ret;
}
