| 1 |
// SPDX-License-Identifier: GPL-2.0-or-later |
| 2 |
/* |
| 3 |
* RapidIO configuration space access support |
| 4 |
* |
| 5 |
* Copyright 2005 MontaVista Software, Inc. |
| 6 |
* Matt Porter <[email protected]> |
| 7 |
*/ |
| 8 |
|
| 9 |
#include <linux/rio.h> |
| 10 |
#include <linux/module.h> |
| 11 |
|
| 12 |
#include <linux/rio_drv.h> |
| 13 |
|
| 14 |
/* |
| 15 |
* Wrappers for all RIO configuration access functions. They just check |
| 16 |
* alignment and call the low-level functions pointed to by rio_mport->ops. |
| 17 |
*/ |
| 18 |
|
| 19 |
#define RIO_8_BAD 0 |
| 20 |
#define RIO_16_BAD (offset & 1) |
| 21 |
#define RIO_32_BAD (offset & 3) |
| 22 |
|
| 23 |
/** |
| 24 |
* RIO_LOP_READ - Generate rio_local_read_config_* functions |
| 25 |
* @size: Size of configuration space read (8, 16, 32 bits) |
| 26 |
* @type: C type of value argument |
| 27 |
* @len: Length of configuration space read (1, 2, 4 bytes) |
| 28 |
* |
| 29 |
* Generates rio_local_read_config_* functions used to access |
| 30 |
* configuration space registers on the local device. |
| 31 |
*/ |
| 32 |
#define RIO_LOP_READ(size,type,len) \ |
| 33 |
int __rio_local_read_config_##size \ |
| 34 |
(struct rio_mport *mport, u32 offset, type *value) \ |
| 35 |
{ \ |
| 36 |
int res; \ |
| 37 |
u32 data = 0; \ |
| 38 |
if (RIO_##size##_BAD) return RIO_BAD_SIZE; \ |
| 39 |
res = mport->ops->lcread(mport, mport->id, offset, len, &data); \ |
| 40 |
*value = (type)data; \ |
| 41 |
return res; \ |
| 42 |
} |
| 43 |
|
| 44 |
/** |
| 45 |
* RIO_LOP_WRITE - Generate rio_local_write_config_* functions |
| 46 |
* @size: Size of configuration space write (8, 16, 32 bits) |
| 47 |
* @type: C type of value argument |
| 48 |
* @len: Length of configuration space write (1, 2, 4 bytes) |
| 49 |
* |
| 50 |
* Generates rio_local_write_config_* functions used to access |
| 51 |
* configuration space registers on the local device. |
| 52 |
*/ |
| 53 |
#define RIO_LOP_WRITE(size,type,len) \ |
| 54 |
int __rio_local_write_config_##size \ |
| 55 |
(struct rio_mport *mport, u32 offset, type value) \ |
| 56 |
{ \ |
| 57 |
if (RIO_##size##_BAD) return RIO_BAD_SIZE; \ |
| 58 |
return mport->ops->lcwrite(mport, mport->id, offset, len, value);\ |
| 59 |
} |
| 60 |
|
| 61 |
RIO_LOP_READ(8, u8, 1) |
| 62 |
RIO_LOP_READ(16, u16, 2) |
| 63 |
RIO_LOP_READ(32, u32, 4) |
| 64 |
RIO_LOP_WRITE(8, u8, 1) |
| 65 |
RIO_LOP_WRITE(16, u16, 2) |
| 66 |
RIO_LOP_WRITE(32, u32, 4) |
| 67 |
|
| 68 |
EXPORT_SYMBOL_GPL(__rio_local_read_config_8); |
| 69 |
EXPORT_SYMBOL_GPL(__rio_local_read_config_16); |
| 70 |
EXPORT_SYMBOL_GPL(__rio_local_read_config_32); |
| 71 |
EXPORT_SYMBOL_GPL(__rio_local_write_config_8); |
| 72 |
EXPORT_SYMBOL_GPL(__rio_local_write_config_16); |
| 73 |
EXPORT_SYMBOL_GPL(__rio_local_write_config_32); |
| 74 |
|
| 75 |
/** |
| 76 |
* RIO_OP_READ - Generate rio_mport_read_config_* functions |
| 77 |
* @size: Size of configuration space read (8, 16, 32 bits) |
| 78 |
* @type: C type of value argument |
| 79 |
* @len: Length of configuration space read (1, 2, 4 bytes) |
| 80 |
* |
| 81 |
* Generates rio_mport_read_config_* functions used to access |
| 82 |
* configuration space registers on the local device. |
| 83 |
*/ |
| 84 |
#define RIO_OP_READ(size,type,len) \ |
| 85 |
int rio_mport_read_config_##size \ |
| 86 |
(struct rio_mport *mport, u16 destid, u8 hopcount, u32 offset, type *value) \ |
| 87 |
{ \ |
| 88 |
int res; \ |
| 89 |
u32 data = 0; \ |
| 90 |
if (RIO_##size##_BAD) return RIO_BAD_SIZE; \ |
| 91 |
res = mport->ops->cread(mport, mport->id, destid, hopcount, offset, len, &data); \ |
| 92 |
*value = (type)data; \ |
| 93 |
return res; \ |
| 94 |
} |
| 95 |
|
| 96 |
/** |
| 97 |
* RIO_OP_WRITE - Generate rio_mport_write_config_* functions |
| 98 |
* @size: Size of configuration space write (8, 16, 32 bits) |
| 99 |
* @type: C type of value argument |
| 100 |
* @len: Length of configuration space write (1, 2, 4 bytes) |
| 101 |
* |
| 102 |
* Generates rio_mport_write_config_* functions used to access |
| 103 |
* configuration space registers on the local device. |
| 104 |
*/ |
| 105 |
#define RIO_OP_WRITE(size,type,len) \ |
| 106 |
int rio_mport_write_config_##size \ |
| 107 |
(struct rio_mport *mport, u16 destid, u8 hopcount, u32 offset, type value) \ |
| 108 |
{ \ |
| 109 |
if (RIO_##size##_BAD) return RIO_BAD_SIZE; \ |
| 110 |
return mport->ops->cwrite(mport, mport->id, destid, hopcount, \ |
| 111 |
offset, len, value); \ |
| 112 |
} |
| 113 |
|
| 114 |
RIO_OP_READ(8, u8, 1) |
| 115 |
RIO_OP_READ(16, u16, 2) |
| 116 |
RIO_OP_READ(32, u32, 4) |
| 117 |
RIO_OP_WRITE(8, u8, 1) |
| 118 |
RIO_OP_WRITE(16, u16, 2) |
| 119 |
RIO_OP_WRITE(32, u32, 4) |
| 120 |
|
| 121 |
EXPORT_SYMBOL_GPL(rio_mport_read_config_8); |
| 122 |
EXPORT_SYMBOL_GPL(rio_mport_read_config_16); |
| 123 |
EXPORT_SYMBOL_GPL(rio_mport_read_config_32); |
| 124 |
EXPORT_SYMBOL_GPL(rio_mport_write_config_8); |
| 125 |
EXPORT_SYMBOL_GPL(rio_mport_write_config_16); |
| 126 |
EXPORT_SYMBOL_GPL(rio_mport_write_config_32); |
| 127 |
|
| 128 |
/** |
| 129 |
* rio_mport_send_doorbell - Send a doorbell message |
| 130 |
* |
| 131 |
* @mport: RIO master port |
| 132 |
* @destid: RIO device destination ID |
| 133 |
* @data: Doorbell message data |
| 134 |
* |
| 135 |
* Send a doorbell message to a RIO device. The doorbell message |
| 136 |
* has a 16-bit info field provided by the data argument. |
| 137 |
*/ |
| 138 |
int rio_mport_send_doorbell(struct rio_mport *mport, u16 destid, u16 data) |
| 139 |
{ |
| 140 |
return mport->ops->dsend(mport, mport->id, destid, data); |
| 141 |
} |
| 142 |
|
| 143 |
EXPORT_SYMBOL_GPL(rio_mport_send_doorbell); |