Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / SLOF / clients / net-snk / kernel / systemcall.c

diff --git a/qemu/roms/SLOF/clients/net-snk/kernel/systemcall.c b/qemu/roms/SLOF/clients/net-snk/kernel/systemcall.c
new file mode 100644 (file)
index 0000000..52c45ca
--- /dev/null
+++ b/qemu/roms/SLOF/clients/net-snk/kernel/systemcall.c
@@ -0,0 +1,176 @@
+/******************************************************************************
+ * Copyright (c) 2004, 2008 IBM Corporation
+ * All rights reserved.
+ * This program and the accompanying materials
+ * are made available under the terms of the BSD License
+ * which accompanies this distribution, and is available at
+ * http://www.opensource.org/licenses/bsd-license.php
+ *
+ * Contributors:
+ *     IBM Corporation - initial implementation
+ *****************************************************************************/
+
+#include <stdint.h>
+#include <stdarg.h>
+#include <string.h>
+#include <fileio.h>
+#include <kernel.h>
+#include <of.h>
+#include <sys/socket.h>
+
+extern int vsprintf(char *, const char *, va_list);
+extern void _exit(int status);
+
+void exit(int status);
+
+int open(const char* name, int flags)
+{
+       int fd;
+
+       /* search free file descriptor */
+       for (fd=0; fd<FILEIO_MAX; ++fd) {
+               if(fd_array[fd].type == FILEIO_TYPE_EMPTY) {
+                       break;
+               }
+       }
+       if (fd == FILEIO_MAX) {
+               printf("Can not open \"%s\" because file descriptor list is full\n", name);
+               /* there is no free file descriptor available */
+               return -2;
+       }
+
+       fd_array[fd].ih = of_open(name);
+       if (fd_array[fd].ih == 0)
+               return -1;
+
+       fd_array[fd].type = FILEIO_TYPE_FILE;
+
+       return fd;
+}
+
+int pre_open_ih(int fd, ihandle_t ih)
+{
+       if (fd_array[fd].type != FILEIO_TYPE_EMPTY)
+               return -2;
+       fd_array[fd].ih = ih;
+       fd_array[fd].type = FILEIO_TYPE_FILE;
+
+       return fd;
+}
+
+int socket(int domain, int type, int proto, char *mac_addr)
+{
+       uint8_t tmpbuf[8];
+       int fd;
+       phandle_t ph;
+
+       /* search free file descriptor */
+       for (fd=0; fd<FILEIO_MAX; ++fd) {
+               if(fd_array[fd].type == FILEIO_TYPE_EMPTY) {
+                       break;
+               }
+       }
+       if (fd == FILEIO_MAX) {
+               printf("Can not open socket, file descriptor list is full\n");
+               /* there is no free file descriptor available */
+               return -2;
+       }
+
+       fd_array[fd].ih = of_interpret_1("my-parent", tmpbuf);
+       if (fd_array[fd].ih == 0) {
+               printf("Can not open socket, no parent instance\n");
+               return -1;
+       }
+       ph = of_instance_to_package(fd_array[fd].ih);
+       if (ph == -1) {
+               printf("Can not open socket, no parent package\n");
+               return -1;
+       }
+       if (of_get_mac(ph, mac_addr) < 0) {
+               printf("Can not open socket, no MAC address\n");
+               return -1;
+       }
+       fd_array[fd].type = FILEIO_TYPE_SOCKET;
+
+       return fd;
+}
+
+int close(int fd)
+{
+       if (fd < 0 || fd >= FILEIO_MAX ||
+           fd_array[fd].type == FILEIO_TYPE_EMPTY)
+               return -1;
+       if (fd_array[fd].type == FILEIO_TYPE_FILE)
+               of_close(fd_array[fd].ih);
+       fd_array[fd].type = FILEIO_TYPE_EMPTY;
+       return 0;
+}
+
+ssize_t read(int fd, void *buf, size_t len)
+{
+       if (fd < 0 || fd >= FILEIO_MAX ||
+           fd_array[fd].type == FILEIO_TYPE_EMPTY)
+               return -1;
+
+       return of_read(fd_array[fd].ih, buf, len);
+}
+
+ssize_t write (int fd, const void *buf, size_t len)
+{
+       char dest_buf[512];
+       char *dest_buf_ptr;
+       const char *dbuf = buf;
+       int i;
+
+       if (fd == 1 || fd == 2) {
+               dest_buf_ptr = &dest_buf[0];
+               for (i = 0; i < len && i < 256; i++)
+                       {
+                               *dest_buf_ptr++ = *dbuf++;
+                               if (dbuf[-1] == '\n')
+                                       *dest_buf_ptr++ = '\r';
+                       }
+               len = dest_buf_ptr - &dest_buf[0];
+               buf = &dest_buf[0];
+       }
+
+       if(fd < 0 || fd >= FILEIO_MAX ||
+          fd_array[fd].type == FILEIO_TYPE_EMPTY)
+               return -1;
+
+       return of_write(fd_array[fd].ih, (void *)buf, len);
+}
+
+ssize_t lseek (int fd, long offset, int whence)
+{
+       return 0; // this syscall is unused !!!
+#if 0
+    if (whence != 0)
+       return -1;
+
+    of_seek (fd_array[fd], (unsigned int) (offset>>32), (unsigned int) (offset & 0xffffffffULL));
+
+    return offset;
+#endif
+}
+
+int recv(int fd, void *packet, int packet_len, int flags)
+{
+       return read(fd, packet, packet_len);
+}
+
+int send(int fd, const void *packet, int packet_len, int flags)
+{
+       return write(fd, packet, packet_len);
+}
+
+int sendto(int fd, const void *packet, int packet_len, int flags,
+          const void *sock_addr, int sock_addr_len)
+{
+       return send(fd, packet, packet_len, flags);
+}
+
+void exit(int status)
+{
+       _exit(status);
+}