cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

oxfw-command.c (4005B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * oxfw_command.c - a part of driver for OXFW970/971 based devices
      4 *
      5 * Copyright (c) 2014 Takashi Sakamoto
      6 */
      7
      8#include "oxfw.h"
      9
     10int avc_stream_set_format(struct fw_unit *unit, enum avc_general_plug_dir dir,
     11			  unsigned int pid, u8 *format, unsigned int len)
     12{
     13	u8 *buf;
     14	int err;
     15
     16	buf = kmalloc(len + 10, GFP_KERNEL);
     17	if (buf == NULL)
     18		return -ENOMEM;
     19
     20	buf[0] = 0x00;		/* CONTROL */
     21	buf[1] = 0xff;		/* UNIT */
     22	buf[2] = 0xbf;		/* EXTENDED STREAM FORMAT INFORMATION */
     23	buf[3] = 0xc0;		/* SINGLE subfunction */
     24	buf[4] = dir;		/* Plug Direction */
     25	buf[5] = 0x00;		/* UNIT */
     26	buf[6] = 0x00;		/* PCR (Isochronous Plug) */
     27	buf[7] = 0xff & pid;	/* Plug ID */
     28	buf[8] = 0xff;		/* Padding */
     29	buf[9] = 0xff;		/* Support status in response */
     30	memcpy(buf + 10, format, len);
     31
     32	/* do transaction and check buf[1-8] are the same against command */
     33	err = fcp_avc_transaction(unit, buf, len + 10, buf, len + 10,
     34				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
     35				  BIT(6) | BIT(7) | BIT(8));
     36	if (err < 0)
     37		;
     38	else if (err < len + 10)
     39		err = -EIO;
     40	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
     41		err = -ENXIO;
     42	else if (buf[0] == 0x0a) /* REJECTED */
     43		err = -EINVAL;
     44	else
     45		err = 0;
     46
     47	kfree(buf);
     48
     49	return err;
     50}
     51
     52int avc_stream_get_format(struct fw_unit *unit,
     53			  enum avc_general_plug_dir dir, unsigned int pid,
     54			  u8 *buf, unsigned int *len, unsigned int eid)
     55{
     56	unsigned int subfunc;
     57	int err;
     58
     59	if (eid == 0xff)
     60		subfunc = 0xc0;	/* SINGLE */
     61	else
     62		subfunc = 0xc1;	/* LIST */
     63
     64	buf[0] = 0x01;		/* STATUS */
     65	buf[1] = 0xff;		/* UNIT */
     66	buf[2] = 0xbf;		/* EXTENDED STREAM FORMAT INFORMATION */
     67	buf[3] = subfunc;	/* SINGLE or LIST */
     68	buf[4] = dir;		/* Plug Direction */
     69	buf[5] = 0x00;		/* Unit */
     70	buf[6] = 0x00;		/* PCR (Isochronous Plug) */
     71	buf[7] = 0xff & pid;	/* Plug ID */
     72	buf[8] = 0xff;		/* Padding */
     73	buf[9] = 0xff;		/* support status in response */
     74	buf[10] = 0xff & eid;	/* entry ID for LIST subfunction */
     75	buf[11] = 0xff;		/* padding */
     76
     77	/* do transaction and check buf[1-7] are the same against command */
     78	err = fcp_avc_transaction(unit, buf, 12, buf, *len,
     79				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
     80				  BIT(6) | BIT(7));
     81	if (err < 0)
     82		;
     83	else if (err < 12)
     84		err = -EIO;
     85	else if (buf[0] == 0x08)	/* NOT IMPLEMENTED */
     86		err = -ENXIO;
     87	else if (buf[0] == 0x0a)	/* REJECTED */
     88		err = -EINVAL;
     89	else if (buf[0] == 0x0b)	/* IN TRANSITION */
     90		err = -EAGAIN;
     91	/* LIST subfunction has entry ID */
     92	else if ((subfunc == 0xc1) && (buf[10] != eid))
     93		err = -EIO;
     94	if (err < 0)
     95		goto end;
     96
     97	/* keep just stream format information */
     98	if (subfunc == 0xc0) {
     99		memmove(buf, buf + 10, err - 10);
    100		*len = err - 10;
    101	} else {
    102		memmove(buf, buf + 11, err - 11);
    103		*len = err - 11;
    104	}
    105
    106	err = 0;
    107end:
    108	return err;
    109}
    110
    111int avc_general_inquiry_sig_fmt(struct fw_unit *unit, unsigned int rate,
    112				enum avc_general_plug_dir dir,
    113				unsigned short pid)
    114{
    115	unsigned int sfc;
    116	u8 *buf;
    117	int err;
    118
    119	for (sfc = 0; sfc < CIP_SFC_COUNT; sfc++) {
    120		if (amdtp_rate_table[sfc] == rate)
    121			break;
    122	}
    123	if (sfc == CIP_SFC_COUNT)
    124		return -EINVAL;
    125
    126	buf = kzalloc(8, GFP_KERNEL);
    127	if (buf == NULL)
    128		return -ENOMEM;
    129
    130	buf[0] = 0x02;		/* SPECIFIC INQUIRY */
    131	buf[1] = 0xff;		/* UNIT */
    132	if (dir == AVC_GENERAL_PLUG_DIR_IN)
    133		buf[2] = 0x19;	/* INPUT PLUG SIGNAL FORMAT */
    134	else
    135		buf[2] = 0x18;	/* OUTPUT PLUG SIGNAL FORMAT */
    136	buf[3] = 0xff & pid;	/* plug id */
    137	buf[4] = 0x90;		/* EOH_1, Form_1, FMT. AM824 */
    138	buf[5] = 0x07 & sfc;	/* FDF-hi. AM824, frequency */
    139	buf[6] = 0xff;		/* FDF-mid. AM824, SYT hi (not used) */
    140	buf[7] = 0xff;		/* FDF-low. AM824, SYT lo (not used) */
    141
    142	/* do transaction and check buf[1-5] are the same against command */
    143	err = fcp_avc_transaction(unit, buf, 8, buf, 8,
    144				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5));
    145	if (err < 0)
    146		;
    147	else if (err < 8)
    148		err = -EIO;
    149	else if (buf[0] == 0x08)	/* NOT IMPLEMENTED */
    150		err = -ENXIO;
    151	if (err < 0)
    152		goto end;
    153
    154	err = 0;
    155end:
    156	kfree(buf);
    157	return err;
    158}