feat: Massive OS expansion with IPC, Sound & TTS, Block layer, FAT32/ext2/sysfs, Signals, Syscalls, Modules, Drivers & 50+ LazyBox applets

ipc/msg.c

@@ -0,0 +1,97 @@
+#include <ipc/msg.h>
+#include <mm/kmalloc.h>
+#include <lib/string.h>
+
+static msqid_ds_t msg_queues[MAX_MSG_QUEUES];
+
+int msgget(key_t key, int msgflg) {
+    (void)msgflg;
+    for (int i = 0; i < MAX_MSG_QUEUES; i++) {
+        if (msg_queues[i].in_use && msg_queues[i].key == key) {
+            return i;
+        }
+    }
+
+    for (int i = 0; i < MAX_MSG_QUEUES; i++) {
+        if (!msg_queues[i].in_use) {
+            msg_queues[i].in_use = true;
+            msg_queues[i].key = key;
+            msg_queues[i].msqid = i;
+            msg_queues[i].msg_qnum = 0;
+            msg_queues[i].msg_qbytes = MAX_MSG_PAYLOAD * MAX_MSGS_PER_QUEUE;
+            msg_queues[i].head = NULL;
+            msg_queues[i].tail = NULL;
+            return i;
+        }
+    }
+    return -1;
+}
+
+int msgsnd(int msqid, const void* msgp, size_t msgsz, int msgflg) {
+    (void)msgflg;
+    if (msqid < 0 || msqid >= MAX_MSG_QUEUES || !msg_queues[msqid].in_use || !msgp) return -1;
+    if (msgsz > MAX_MSG_PAYLOAD) return -1;
+
+    msqid_ds_t* q = &msg_queues[msqid];
+    if (q->msg_qnum >= MAX_MSGS_PER_QUEUE) return -1;
+
+    msg_entry_t* entry = (msg_entry_t*)kmalloc(sizeof(msg_entry_t));
+    if (!entry) return -1;
+
+    const msgbuf_t* mb = (const msgbuf_t*)msgp;
+    entry->mtype = mb->mtype;
+    entry->size = msgsz;
+    memcpy(entry->data, mb->mtext, msgsz);
+    entry->next = NULL;
+
+    if (!q->tail) {
+        q->head = entry;
+        q->tail = entry;
+    } else {
+        q->tail->next = entry;
+        q->tail = entry;
+    }
+    q->msg_qnum++;
+    return 0;
+}
+
+ssize_t msgrcv(int msqid, void* msgp, size_t msgsz, long msgtyp, int msgflg) {
+    (void)msgtyp; (void)msgflg;
+    if (msqid < 0 || msqid >= MAX_MSG_QUEUES || !msg_queues[msqid].in_use || !msgp) return -1;
+
+    msqid_ds_t* q = &msg_queues[msqid];
+    if (!q->head) return -1;
+
+    msg_entry_t* entry = q->head;
+    q->head = entry->next;
+    if (!q->head) q->tail = NULL;
+    q->msg_qnum--;
+
+    msgbuf_t* mb = (msgbuf_t*)msgp;
+    mb->mtype = entry->mtype;
+    size_t copy_len = entry->size < msgsz ? entry->size : msgsz;
+    memcpy(mb->mtext, entry->data, copy_len);
+
+    kfree(entry);
+    return (ssize_t)copy_len;
+}
+
+int msgctl(int msqid, int cmd, struct msqid_ds* buf) {
+    if (msqid < 0 || msqid >= MAX_MSG_QUEUES || !msg_queues[msqid].in_use) return -1;
+
+    if (cmd == IPC_RMID) {
+        msqid_ds_t* q = &msg_queues[msqid];
+        msg_entry_t* curr = q->head;
+        while (curr) {
+            msg_entry_t* next = curr->next;
+            kfree(curr);
+            curr = next;
+        }
+        memset(q, 0, sizeof(msqid_ds_t));
+        return 0;
+    } else if (cmd == IPC_STAT && buf) {
+        memcpy(buf, &msg_queues[msqid], sizeof(msqid_ds_t));
+        return 0;
+    }
+    return -1;
+}