[thirdparty/pciutils.git] / lib / sylixos-device.c

/*
 *  The PCI Library -- Direct Configuration access via SylixOS Ports
 *
 *  Copyright (c) 2018 YuJian.Gong <gongyujian@acoinfo.com>
 *
 *  Can be freely distributed and used under the terms of the GNU GPL.
 */

#define _GNU_SOURCE
#define  __SYLIXOS_KERNEL
#define  __SYLIXOS_PCI_DRV
#include <SylixOS.h>
#include <stdlib.h>
#include <string.h>

#include "internal.h"

static void
sylixos_scan(struct pci_access *a)
{
  u8 busmap[256];
  int bus;

  memset(busmap, 0, sizeof(busmap));

  for (bus = 0; bus < PCI_MAX_BUS; bus++)
    if (!busmap[bus])
      pci_generic_scan_bus(a, busmap, bus);
}

static void
sylixos_config(struct pci_access *a)
{
  pci_define_param(a, "sylixos.path", PCI_PATH_SYLIXOS_DEVICE, "Path to the SylixOS PCI device");
}

static int
sylixos_detect(struct pci_access *a)
{
  char *name = pci_get_param(a, "sylixos.path");

  if (access(name, R_OK))
    {
      a->warning("Cannot open %s", name);
      return 0;
    }

  a->debug("...using %s", name);
  return 1;
}

static void
sylixos_init(struct pci_access *a UNUSED)
{
}

static void
sylixos_cleanup(struct pci_access *a UNUSED)
{
}

static int
sylixos_read(struct pci_dev *d, int pos, byte *buf, int len)
{
  int ret = -1;
  u8  data_byte = -1;
  u16 data_word = -1;
  u32 data_dword = -1;

  if (!(len == 1 || len == 2 || len == 4))
    return pci_generic_block_read(d, pos, buf, len);

  if (pos >= 256)
    return 0;

  switch (len)
    {
    case 1:
      ret = pciConfigInByte(d->bus, d->dev, d->func, pos, &data_byte);
      if (ret != ERROR_NONE)
	return 0;
      buf[0] = (u8)data_byte;
      break;

    case 2:
      ret = pciConfigInWord(d->bus, d->dev, d->func, pos, &data_word);
      if (ret != ERROR_NONE)
	return 0;
      ((u16 *) buf)[0] = cpu_to_le16(data_word);
      break;

    case 4:
      ret = pciConfigInDword(d->bus, d->dev, d->func, pos, &data_dword);
      if (ret != ERROR_NONE)
	return 0;
      ((u32 *) buf)[0] = cpu_to_le32(data_dword);
      break;
    }

  return 1;
}

static int
sylixos_write(struct pci_dev *d, int pos, byte *buf, int len)
{
  int ret = PX_ERROR;
  u8 data_byte;
  u16 data_word;
  u32 data_dword;

  if (!(len == 1 || len == 2 || len == 4))
    return pci_generic_block_write(d, pos, buf, len);

  if (pos >= 256)
    return 0;

  switch (len)
    {
    case 1:
      data_byte = buf[0];
      ret = pciConfigOutByte(d->bus, d->dev, d->func, pos, data_byte);
      if (ret != ERROR_NONE)
	return 0;
      break;

    case 2:
      data_word = le16_to_cpu(((u16 *) buf)[0]);
      ret = pciConfigOutWord(d->bus, d->dev, d->func, pos, data_word);
      if (ret != ERROR_NONE)
	return 0;
      break;

    case 4:
      data_dword = le32_to_cpu(((u32 *) buf)[0]);
      ret = pciConfigOutDword(d->bus, d->dev, d->func, pos, data_dword);
      if (ret != ERROR_NONE)
	return 0;
      break;
    }

  return 1;
}

struct pci_methods pm_sylixos_device = {
  "sylixos-device",
  "SylixOS /proc/pci device",
  sylixos_config,
  sylixos_detect,
  sylixos_init,
  sylixos_cleanup,
  sylixos_scan,
  pci_generic_fill_info,
  sylixos_read,
  sylixos_write,
  NULL,			// no read_vpd
  NULL,			// no init_dev
  NULL,			// no cleanup_dev
};
Commit	Line	Data
83fd885b MM	1	/*
	2	* The PCI Library -- Direct Configuration access via SylixOS Ports
	3	*
	4	* Copyright (c) 2018 YuJian.Gong <gongyujian@acoinfo.com>
	5	*
	6	* Can be freely distributed and used under the terms of the GNU GPL.
	7	*/
	8
	9	#define _GNU_SOURCE
	10	#define __SYLIXOS_KERNEL
	11	#define __SYLIXOS_PCI_DRV
	12	#include <SylixOS.h>
	13	#include <stdlib.h>
	14	#include <string.h>
	15
	16	#include "internal.h"
	17
83fd885b MM	18	static void
	19	sylixos_scan(struct pci_access *a)
	20	{
83fd885b	21	u8 busmap[256];
6c201b8f	22	int bus;
83fd885b MM	23
	24	memset(busmap, 0, sizeof(busmap));
	25
6c201b8f MM	26	for (bus = 0; bus < PCI_MAX_BUS; bus++)
	27	if (!busmap[bus])
	28	pci_generic_scan_bus(a, busmap, bus);
83fd885b MM	29	}
	30
	31	static void
	32	sylixos_config(struct pci_access *a)
	33	{
	34	pci_define_param(a, "sylixos.path", PCI_PATH_SYLIXOS_DEVICE, "Path to the SylixOS PCI device");
	35	}
	36
	37	static int
	38	sylixos_detect(struct pci_access *a)
	39	{
	40	char *name = pci_get_param(a, "sylixos.path");
	41
	42	if (access(name, R_OK))
	43	{
	44	a->warning("Cannot open %s", name);
	45	return 0;
	46	}
	47
	48	a->debug("...using %s", name);
83fd885b MM	49	return 1;
	50	}
	51
	52	static void
6c201b8f	53	sylixos_init(struct pci_access *a UNUSED)
83fd885b	54	{
83fd885b MM	55	}
	56
	57	static void
6c201b8f	58	sylixos_cleanup(struct pci_access *a UNUSED)
83fd885b	59	{
83fd885b MM	60	}
	61
	62	static int
	63	sylixos_read(struct pci_dev d, int pos, byte buf, int len)
	64	{
	65	int ret = -1;
	66	u8 data_byte = -1;
	67	u16 data_word = -1;
	68	u32 data_dword = -1;
	69
	70	if (!(len == 1 \|\| len == 2 \|\| len == 4))
278efb21	71	return pci_generic_block_read(d, pos, buf, len);
83fd885b MM	72
83fd885b MM	73	if (pos >= 256)
278efb21	74	return 0;
83fd885b MM	75
	76	switch (len)
	77	{
	78	case 1:
	79	ret = pciConfigInByte(d->bus, d->dev, d->func, pos, &data_byte);
	80	if (ret != ERROR_NONE)
278efb21	81	return 0;
83fd885b MM	82	buf[0] = (u8)data_byte;
	83	break;
	84
	85	case 2:
	86	ret = pciConfigInWord(d->bus, d->dev, d->func, pos, &data_word);
	87	if (ret != ERROR_NONE)
278efb21	88	return 0;
83fd885b MM	89	((u16 *) buf)[0] = cpu_to_le16(data_word);
	90	break;
	91
	92	case 4:
	93	ret = pciConfigInDword(d->bus, d->dev, d->func, pos, &data_dword);
	94	if (ret != ERROR_NONE)
278efb21	95	return 0;
83fd885b MM	96	((u32 *) buf)[0] = cpu_to_le32(data_dword);
	97	break;
	98	}
	99
	100	return 1;
	101	}
	102
	103	static int
	104	sylixos_write(struct pci_dev d, int pos, byte buf, int len)
	105	{
	106	int ret = PX_ERROR;
	107	u8 data_byte;
	108	u16 data_word;
	109	u32 data_dword;
	110
	111	if (!(len == 1 \|\| len == 2 \|\| len == 4))
278efb21	112	return pci_generic_block_write(d, pos, buf, len);
83fd885b MM	113
83fd885b MM	114	if (pos >= 256)
278efb21	115	return 0;
83fd885b MM	116
	117	switch (len)
	118	{
	119	case 1:
	120	data_byte = buf[0];
	121	ret = pciConfigOutByte(d->bus, d->dev, d->func, pos, data_byte);
	122	if (ret != ERROR_NONE)
278efb21	123	return 0;
83fd885b MM	124	break;
	125
	126	case 2:
	127	data_word = le16_to_cpu(((u16 *) buf)[0]);
	128	ret = pciConfigOutWord(d->bus, d->dev, d->func, pos, data_word);
	129	if (ret != ERROR_NONE)
278efb21	130	return 0;
83fd885b MM	131	break;
	132
	133	case 4:
	134	data_dword = le32_to_cpu(((u32 *) buf)[0]);
	135	ret = pciConfigOutDword(d->bus, d->dev, d->func, pos, data_dword);
	136	if (ret != ERROR_NONE)
278efb21	137	return 0;
83fd885b MM	138	break;
	139	}
	140
	141	return 1;
	142	}
	143
	144	struct pci_methods pm_sylixos_device = {
	145	"sylixos-device",
	146	"SylixOS /proc/pci device",
278efb21	147	sylixos_config,
83fd885b MM	148	sylixos_detect,
	149	sylixos_init,
	150	sylixos_cleanup,
	151	sylixos_scan,
	152	pci_generic_fill_info,
	153	sylixos_read,
	154	sylixos_write,
278efb21 MM	155	NULL, // no read_vpd
	156	NULL, // no init_dev
	157	NULL, // no cleanup_dev
83fd885b	158	};