@@ -31,7 +31,7 @@ static unsigned long ipi_data_off;
static const struct sbi_ipi_device *ipi_dev = NULL;
static const struct sbi_ipi_event_ops *ipi_ops_array[SBI_IPI_EVENT_MAX];
-static int sbi_ipi_send(struct sbi_scratch *scratch, u32 remote_hartid,
+static int sbi_ipi_update(struct sbi_scratch *scratch, u32 remote_hartid,
u32 event, void *data)
{
int ret;
@@ -75,6 +75,21 @@ static int sbi_ipi_send(struct sbi_scratch *scratch, u32 remote_hartid,
return 0;
}
+static int sbi_ipi_sync(struct sbi_scratch *scratch, u32 event)
+{
+ const struct sbi_ipi_event_ops *ipi_ops;
+
+ if ((SBI_IPI_EVENT_MAX <= event) ||
+ !ipi_ops_array[event])
+ return SBI_EINVAL;
+ ipi_ops = ipi_ops_array[event];
+
+ if (ipi_ops->sync)
+ ipi_ops->sync(scratch);
+
+ return 0;
+}
+
/**
* As this this function only handlers scalar values of hart mask, it must be
* set to all online harts if the intention is to send IPIs to all the harts.
@@ -83,7 +98,7 @@ static int sbi_ipi_send(struct sbi_scratch *scratch, u32 remote_hartid,
int sbi_ipi_send_many(ulong hmask, ulong hbase, u32 event, void *data)
{
int rc;
- ulong i, m;
+ ulong i, m, n;
struct sbi_domain *dom = sbi_domain_thishart_ptr();
struct sbi_scratch *scratch = sbi_scratch_thishart_ptr();
@@ -92,19 +107,37 @@ int sbi_ipi_send_many(ulong hmask, ulong hbase, u32 event, void *data)
if (rc)
return rc;
m &= hmask;
+ n = m;
- /* Send IPIs */
+ /* update IPIs */
for (i = hbase; m; i++, m >>= 1) {
if (m & 1UL)
- sbi_ipi_send(scratch, i, event, data);
+ sbi_ipi_update(scratch, i, event, data);
+ }
+
+ /* sync IPIs */
+ m = n;
+ for (i = hbase; m; i++, m >>= 1) {
+ if (m & 1UL)
+ sbi_ipi_sync(scratch, event);
}
} else {
+ /* update IPIs */
+ hbase = 0;
+ while (!sbi_hsm_hart_interruptible_mask(dom, hbase, &m)) {
+ for (i = hbase; m; i++, m >>= 1) {
+ if (m & 1UL)
+ sbi_ipi_update(scratch, i, event, data);
+ }
+ hbase += BITS_PER_LONG;
+ }
+
+ /* sync IPIs */
hbase = 0;
while (!sbi_hsm_hart_interruptible_mask(dom, hbase, &m)) {
- /* Send IPIs */
for (i = hbase; m; i++, m >>= 1) {
if (m & 1UL)
- sbi_ipi_send(scratch, i, event, data);
+ sbi_ipi_sync(scratch, event);
}
hbase += BITS_PER_LONG;
}
the original sbI_ipi will be processed by hart by hart, after optimization, send ipi first and finally wait together. Signed-off-by: Xiang W <wxjstz@126.com> --- lib/sbi/sbi_ipi.c | 45 +++++++++++++++++++++++++++++++++++++++------ 1 file changed, 39 insertions(+), 6 deletions(-)