Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / ipxe / src / core / device.c

diff --git a/qemu/roms/ipxe/src/core/device.c b/qemu/roms/ipxe/src/core/device.c
new file mode 100644 (file)
index 0000000..330f95c
--- /dev/null
+++ b/qemu/roms/ipxe/src/core/device.c
@@ -0,0 +1,136 @@
+/*
+ * Copyright (C) 2006 Michael Brown <mbrown@fensystems.co.uk>.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of the
+ * License, or any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
+ * 02110-1301, USA.
+ */
+
+FILE_LICENCE ( GPL2_OR_LATER );
+
+#include <string.h>
+#include <ipxe/list.h>
+#include <ipxe/tables.h>
+#include <ipxe/init.h>
+#include <ipxe/interface.h>
+#include <ipxe/device.h>
+
+/**
+ * @file
+ *
+ * Device model
+ *
+ */
+
+/** Registered root devices */
+static LIST_HEAD ( devices );
+
+/** Device removal inhibition counter */
+int device_keep_count = 0;
+
+/**
+ * Probe a root device
+ *
+ * @v rootdev          Root device
+ * @ret rc             Return status code
+ */
+static int rootdev_probe ( struct root_device *rootdev ) {
+       int rc;
+
+       DBG ( "Adding %s root bus\n", rootdev->dev.name );
+       if ( ( rc = rootdev->driver->probe ( rootdev ) ) != 0 ) {
+               DBG ( "Failed to add %s root bus: %s\n",
+                     rootdev->dev.name, strerror ( rc ) );
+               return rc;
+       }
+
+       return 0;
+}
+
+/**
+ * Remove a root device
+ *
+ * @v rootdev          Root device
+ */
+static void rootdev_remove ( struct root_device *rootdev ) {
+       rootdev->driver->remove ( rootdev );
+       DBG ( "Removed %s root bus\n", rootdev->dev.name );
+}
+
+/**
+ * Probe all devices
+ *
+ * This initiates probing for all devices in the system.  After this
+ * call, the device hierarchy will be populated, and all hardware
+ * should be ready to use.
+ */
+static void probe_devices ( void ) {
+       struct root_device *rootdev;
+       int rc;
+
+       for_each_table_entry ( rootdev, ROOT_DEVICES ) {
+               list_add ( &rootdev->dev.siblings, &devices );
+               INIT_LIST_HEAD ( &rootdev->dev.children );
+               if ( ( rc = rootdev_probe ( rootdev ) ) != 0 )
+                       list_del ( &rootdev->dev.siblings );
+       }
+}
+
+/**
+ * Remove all devices
+ *
+ */
+static void remove_devices ( int booting __unused ) {
+       struct root_device *rootdev;
+       struct root_device *tmp;
+
+       if ( device_keep_count != 0 ) {
+               DBG ( "Refusing to remove devices on shutdown\n" );
+               return;
+       }
+
+       list_for_each_entry_safe ( rootdev, tmp, &devices, dev.siblings ) {
+               rootdev_remove ( rootdev );
+               list_del ( &rootdev->dev.siblings );
+       }
+}
+
+struct startup_fn startup_devices __startup_fn ( STARTUP_NORMAL ) = {
+       .startup = probe_devices,
+       .shutdown = remove_devices,
+};
+
+/**
+ * Identify a device behind an interface
+ *
+ * @v intf             Interface
+ * @ret device         Device, or NULL
+ */
+struct device * identify_device ( struct interface *intf ) {
+       struct interface *dest;
+       identify_device_TYPE ( void * ) *op =
+               intf_get_dest_op ( intf, identify_device, &dest );
+       void *object = intf_object ( dest );
+       void *device;
+
+       if ( op ) {
+               device = op ( object );
+       } else {
+               /* Default is to return NULL */
+               device = NULL;
+       }
+
+       intf_put ( dest );
+       return device;
+}