From ba89803397cff3631423c3ccd6c2c473b1c8b8fe Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Roman=20Smr=C5=BE?= <roman.smrz@seznam.cz>
Date: Sun, 11 Aug 2024 12:08:57 +0200
Subject: Local discovery with IPv6

Changelog: Local discovery with IPv6
---
 src/Erebos/Network.hs | 29 ++++++++++++++++++++++++-----
 1 file changed, 24 insertions(+), 5 deletions(-)

(limited to 'src/Erebos/Network.hs')

diff --git a/src/Erebos/Network.hs b/src/Erebos/Network.hs
index 1e06008..2064d1c 100644
--- a/src/Erebos/Network.hs
+++ b/src/Erebos/Network.hs
@@ -54,6 +54,9 @@ import GHC.Conc.Sync (unsafeIOToSTM)
 import Network.Socket hiding (ControlMessage)
 import qualified Network.Socket.ByteString as S
 
+import Foreign.C.Types
+import Foreign.Marshal.Alloc
+
 import Erebos.Channel
 #ifdef ENABLE_ICE_SUPPORT
 import Erebos.ICE
@@ -71,6 +74,9 @@ import Erebos.Storage.Merge
 discoveryPort :: PortNumber
 discoveryPort = 29665
 
+discoveryMulticastGroup :: HostAddress6
+discoveryMulticastGroup = tupleToHostAddress6 (0xff12, 0xb6a4, 0x6b1f, 0x0969, 0xcaee, 0xacc2, 0x5c93, 0x73e1) -- ff12:b6a4:6b1f:969:caee:acc2:5c93:73e1
+
 announceIntervalSeconds :: Int
 announceIntervalSeconds = 60
 
@@ -249,8 +255,6 @@ startServer opt serverOrigHead logd' serverServices = do
         either (atomically . logd) return =<< runExceptT =<<
             atomically (readTQueue serverIOActions)
 
-    broadcastAddreses <- getBroadcastAddresses discoveryPort
-
     let open addr = do
             sock <- socket (addrFamily addr) (addrSocketType addr) (addrProtocol addr)
             putMVar serverSocket sock
@@ -261,9 +265,14 @@ startServer opt serverOrigHead logd' serverServices = do
             return sock
 
         loop sock = do
-            when (serverLocalDiscovery opt) $ forkServerThread server $ forever $ do
-                atomically $ writeFlowBulk serverControlFlow $ map (SendAnnounce . DatagramAddress) broadcastAddreses
-                threadDelay $ announceIntervalSeconds * 1000 * 1000
+            when (serverLocalDiscovery opt) $ forkServerThread server $ do
+                announceAddreses <- fmap concat $ sequence $
+                    [ map (SockAddrInet6 discoveryPort 0 discoveryMulticastGroup) <$> joinMulticast sock
+                    , getBroadcastAddresses discoveryPort
+                    ]
+                forever $ do
+                    atomically $ writeFlowBulk serverControlFlow $ map (SendAnnounce . DatagramAddress) announceAddreses
+                    threadDelay $ announceIntervalSeconds * 1000 * 1000
 
             let announceUpdate identity = do
                     st <- derivePartialStorage serverStorage
@@ -944,9 +953,19 @@ runPeerServiceOn mbservice peer handler = liftIO $ do
             logd $ "unhandled service '" ++ show (toUUID svc) ++ "'"
 
 
+foreign import ccall unsafe "Network/ifaddrs.h join_multicast" cJoinMulticast :: CInt -> Ptr CSize -> IO (Ptr Word32)
 foreign import ccall unsafe "Network/ifaddrs.h broadcast_addresses" cBroadcastAddresses :: IO (Ptr Word32)
 foreign import ccall unsafe "stdlib.h free" cFree :: Ptr Word32 -> IO ()
 
+joinMulticast :: Socket -> IO [ Word32 ]
+joinMulticast sock =
+    withFdSocket sock $ \fd ->
+    alloca $ \pcount -> do
+        ptr <- cJoinMulticast fd pcount
+        count <- fromIntegral <$> peek pcount
+        forM [ 0 .. count - 1 ] $ \i ->
+            peekElemOff ptr i
+
 getBroadcastAddresses :: PortNumber -> IO [SockAddr]
 getBroadcastAddresses port = do
     ptr <- cBroadcastAddresses
-- 
cgit v1.2.3