linux-imx

// SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)

// Copyright(c) 2015-18 Intel Corporation.

​

/*

 *  stream.c - SoundWire Bus stream operations.

 */

​

#include <linux/delay.h>

#include <linux/device.h>

#include <linux/init.h>

#include <linux/module.h>

#include <linux/mod_devicetable.h>

#include <linux/slab.h>

#include <linux/soundwire/sdw_registers.h>

#include <linux/soundwire/sdw.h>

#include "bus.h"

​

/*

 * Array of supported rows and columns as per MIPI SoundWire Specification 1.1

 *

 * The rows are arranged as per the array index value programmed

 * in register. The index 15 has dummy value 0 in order to fill hole.

 */

int rows[SDW_FRAME_ROWS] = {48, 50, 60, 64, 75, 80, 125, 147,

            96, 100, 120, 128, 150, 160, 250, 0,

            192, 200, 240, 256, 72, 144, 90, 180};

​

int cols[SDW_FRAME_COLS] = {2, 4, 6, 8, 10, 12, 14, 16};

​

static int sdw_find_col_index(int col)

{

    int i;

​

    for (i = 0; i < SDW_FRAME_COLS; i++) {

        if (cols[i] == col)

            return i;

    }

​

    pr_warn("Requested column not found, selecting lowest column no: 2\n");

    return 0;

}

​

static int sdw_find_row_index(int row)

{

    int i;

​

    for (i = 0; i < SDW_FRAME_ROWS; i++) {

        if (rows[i] == row)

            return i;

    }

​

    pr_warn("Requested row not found, selecting lowest row no: 48\n");

    return 0;

}

static int _sdw_program_slave_port_params(struct sdw_bus *bus,

                struct sdw_slave *slave,

                struct sdw_transport_params *t_params,

                enum sdw_dpn_type type)

{

    u32 addr1, addr2, addr3, addr4;

    int ret;

    u16 wbuf;

​

    if (bus->params.next_bank) {

        addr1 = SDW_DPN_OFFSETCTRL2_B1(t_params->port_num);

        addr2 = SDW_DPN_BLOCKCTRL3_B1(t_params->port_num);

        addr3 = SDW_DPN_SAMPLECTRL2_B1(t_params->port_num);

        addr4 = SDW_DPN_HCTRL_B1(t_params->port_num);

    } else {

        addr1 = SDW_DPN_OFFSETCTRL2_B0(t_params->port_num);

        addr2 = SDW_DPN_BLOCKCTRL3_B0(t_params->port_num);

        addr3 = SDW_DPN_SAMPLECTRL2_B0(t_params->port_num);

        addr4 = SDW_DPN_HCTRL_B0(t_params->port_num);

    }

​

    /* Program DPN_OffsetCtrl2 registers */

    ret = sdw_write(slave, addr1, t_params->offset2);

    if (ret < 0) {

        dev_err(bus->dev, "DPN_OffsetCtrl2 register write failed");

        return ret;

    }

​

    /* Program DPN_BlockCtrl3 register */

    ret = sdw_write(slave, addr2, t_params->blk_pkg_mode);

    if (ret < 0) {

        dev_err(bus->dev, "DPN_BlockCtrl3 register write failed");

        return ret;

    }

​

    /*

     * Data ports are FULL, SIMPLE and REDUCED. This function handles

     * FULL and REDUCED only and and beyond this point only FULL is