linux-imx

// SPDX-License-Identifier: GPL-2.0-only

/*

 * Function Control Protocol (IEC 61883-1) helper functions

 *

 * Copyright (c) Clemens Ladisch <clemens@ladisch.de>

 */

​

#include <linux/device.h>

#include <linux/firewire.h>

#include <linux/firewire-constants.h>

#include <linux/list.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/sched.h>

#include <linux/spinlock.h>

#include <linux/wait.h>

#include <linux/delay.h>

#include "fcp.h"

#include "lib.h"

#include "amdtp-stream.h"

​

#define CTS_AVC 0x00

​

#define ERROR_RETRIES   3

#define ERROR_DELAY_MS  5

#define FCP_TIMEOUT_MS  125

​

int avc_general_set_sig_fmt(struct fw_unit *unit, unsigned int rate,

                enum avc_general_plug_dir dir,

                unsigned short pid)

{

    unsigned int sfc;

    u8 *buf;

    bool flag;

    int err;

​

    flag = false;

    for (sfc = 0; sfc < CIP_SFC_COUNT; sfc++) {

        if (amdtp_rate_table[sfc] == rate) {

            flag = true;

            break;

        }

    }

    if (!flag)

        return -EINVAL;

​

    buf = kzalloc(8, GFP_KERNEL);

    if (buf == NULL)

        return -ENOMEM;

​

    buf[0] = 0x00;      /* AV/C CONTROL */

    buf[1] = 0xff;      /* UNIT */

    if (dir == AVC_GENERAL_PLUG_DIR_IN)

        buf[2] = 0x19;  /* INPUT PLUG SIGNAL FORMAT */

    else

        buf[2] = 0x18;  /* OUTPUT PLUG SIGNAL FORMAT */

    buf[3] = 0xff & pid;    /* plug id */

    buf[4] = 0x90;      /* EOH_1, Form_1, FMT. AM824 */

    buf[5] = 0x07 & sfc;    /* FDF-hi. AM824, frequency */

    buf[6] = 0xff;      /* FDF-mid. AM824, SYT hi (not used)*/

    buf[7] = 0xff;      /* FDF-low. AM824, SYT lo (not used) */

​

    /* do transaction and check buf[1-5] are the same against command */

    err = fcp_avc_transaction(unit, buf, 8, buf, 8,

                  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5));

    if (err < 0)

        ;

    else if (err < 8)

        err = -EIO;

    else if (buf[0] == 0x08) /* NOT IMPLEMENTED */

        err = -ENOSYS;

    else if (buf[0] == 0x0a) /* REJECTED */

        err = -EINVAL;

    if (err < 0)

        goto end;

​

    err = 0;

end:

    kfree(buf);

    return err;

}

EXPORT_SYMBOL(avc_general_set_sig_fmt);

​

int avc_general_get_sig_fmt(struct fw_unit *unit, unsigned int *rate,

                enum avc_general_plug_dir dir,

                unsigned short pid)

{

    unsigned int sfc;

    u8 *buf;

    int err;

​

    buf = kzalloc(8, GFP_KERNEL);