From a68cc1bb10e72504a6c4169c64eb1cfc1280da67 Mon Sep 17 00:00:00 2001
From: Daniel Cederman <cederman@gaisler.com>
Date: Tue, 8 Jul 2014 11:33:55 +0200
Subject: score: Add function to send a SMP message to a set of CPUs

---
 cpukit/score/include/rtems/score/smpimpl.h | 15 +++++++++++++++
 cpukit/score/src/smp.c                     | 16 ++++++++++++++++
 2 files changed, 31 insertions(+)

diff --git a/cpukit/score/include/rtems/score/smpimpl.h b/cpukit/score/include/rtems/score/smpimpl.h
index e2fee39a36..d49f88fcbb 100644
--- a/cpukit/score/include/rtems/score/smpimpl.h
+++ b/cpukit/score/include/rtems/score/smpimpl.h
@@ -175,6 +175,21 @@ void _SMP_Broadcast_message(
   uint32_t  message
 );
 
+/**
+ *  @brief Sends a SMP message to a set of processors.
+ *
+ *  The sending processor may be part of the set.
+ *
+ *  @param[in] setsize The size of the set of target processors of the message.
+ *  @param[in] cpus The set of target processors of the message.
+ *  @param[in] message The message.
+ */
+void _SMP_Send_message_multicast(
+  const size_t setsize,
+  const cpu_set_t *cpus,
+  unsigned long message
+);
+
 #endif /* defined( RTEMS_SMP ) */
 
 /**
diff --git a/cpukit/score/src/smp.c b/cpukit/score/src/smp.c
index f0554fe2d5..71406647ff 100644
--- a/cpukit/score/src/smp.c
+++ b/cpukit/score/src/smp.c
@@ -177,4 +177,20 @@ void _SMP_Broadcast_message( uint32_t message )
   }
 }
 
+void _SMP_Send_message_multicast(
+    const size_t setsize,
+    const cpu_set_t *cpus,
+    unsigned long message
+)
+{
+  uint32_t cpu_count = _SMP_Get_processor_count();
+  uint32_t cpu_index;
+
+  for ( cpu_index = 0 ; cpu_index < cpu_count ; ++cpu_index ) {
+    if ( CPU_ISSET_S( cpu_index, setsize, cpus ) ) {
+      _SMP_Send_message( cpu_index, message );
+    }
+  }
+}
+
 SMP_Test_message_handler _SMP_Test_message_handler;
-- 
cgit v1.2.3