These changes are the raw update to linux-4.4.6-rt14. Kernel sources

[kvmfornfv.git] / kernel / drivers / acpi / tables.c

diff --git a/kernel/drivers/acpi/tables.c b/kernel/drivers/acpi/tables.c
index 2e19189..6c0f079 100644 (file)
--- a/kernel/drivers/acpi/tables.c
+++ b/kernel/drivers/acpi/tables.c
@@ -15,10 +15,6 @@
  *  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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
- *
  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  *
  */
@@ -214,20 +210,39 @@ void acpi_table_print_madt_entry(struct acpi_subtable_header *header)
        }
 }
 
-int __init
-acpi_parse_entries(char *id, unsigned long table_size,
-               acpi_tbl_entry_handler handler,
+/**
+ * acpi_parse_entries_array - for each proc_num find a suitable subtable
+ *
+ * @id: table id (for debugging purposes)
+ * @table_size: single entry size
+ * @table_header: where does the table start?
+ * @proc: array of acpi_subtable_proc struct containing entry id
+ *        and associated handler with it
+ * @proc_num: how big proc is?
+ * @max_entries: how many entries can we process?
+ *
+ * For each proc_num find a subtable with proc->id and run proc->handler
+ * on it. Assumption is that there's only single handler for particular
+ * entry id.
+ *
+ * On success returns sum of all matching entries for all proc handlers.
+ * Otherwise, -ENODEV or -EINVAL is returned.
+ */
+static int __init
+acpi_parse_entries_array(char *id, unsigned long table_size,
                struct acpi_table_header *table_header,
-               int entry_id, unsigned int max_entries)
+               struct acpi_subtable_proc *proc, int proc_num,
+               unsigned int max_entries)
 {
        struct acpi_subtable_header *entry;
-       int count = 0;
        unsigned long table_end;
+       int count = 0;
+       int i;
 
        if (acpi_disabled)
                return -ENODEV;
 
-       if (!id || !handler)
+       if (!id)
                return -EINVAL;
 
        if (!table_size)
@@ -247,20 +262,28 @@ acpi_parse_entries(char *id, unsigned long table_size,
 
        while (((unsigned long)entry) + sizeof(struct acpi_subtable_header) <
               table_end) {
-               if (entry->type == entry_id
-                   && (!max_entries || count < max_entries)) {
-                       if (handler(entry, table_end))
+               if (max_entries && count >= max_entries)
+                       break;
+
+               for (i = 0; i < proc_num; i++) {
+                       if (entry->type != proc[i].id)
+                               continue;
+                       if (!proc[i].handler ||
+                            proc[i].handler(entry, table_end))
                                return -EINVAL;
 
-                       count++;
+                       proc->count++;
+                       break;
                }
+               if (i != proc_num)
+                       count++;
 
                /*
                 * If entry->length is 0, break from this loop to avoid
                 * infinite loop.
                 */
                if (entry->length == 0) {
-                       pr_err("[%4.4s:0x%02x] Invalid zero length\n", id, entry_id);
+                       pr_err("[%4.4s:0x%02x] Invalid zero length\n", id, proc->id);
                        return -EINVAL;
                }
 
@@ -270,17 +293,32 @@ acpi_parse_entries(char *id, unsigned long table_size,
 
        if (max_entries && count > max_entries) {
                pr_warn("[%4.4s:0x%02x] ignored %i entries of %i found\n",
-                       id, entry_id, count - max_entries, count);
+                       id, proc->id, count - max_entries, count);
        }
 
        return count;
 }
 
 int __init
-acpi_table_parse_entries(char *id,
+acpi_parse_entries(char *id,
+                       unsigned long table_size,
+                       acpi_tbl_entry_handler handler,
+                       struct acpi_table_header *table_header,
+                       int entry_id, unsigned int max_entries)
+{
+       struct acpi_subtable_proc proc = {
+               .id             = entry_id,
+               .handler        = handler,
+       };
+
+       return acpi_parse_entries_array(id, table_size, table_header,
+                       &proc, 1, max_entries);
+}
+
+int __init
+acpi_table_parse_entries_array(char *id,
                         unsigned long table_size,
-                        int entry_id,
-                        acpi_tbl_entry_handler handler,
+                        struct acpi_subtable_proc *proc, int proc_num,
                         unsigned int max_entries)
 {
        struct acpi_table_header *table_header = NULL;
@@ -291,7 +329,7 @@ acpi_table_parse_entries(char *id,
        if (acpi_disabled)
                return -ENODEV;
 
-       if (!id || !handler)
+       if (!id)
                return -EINVAL;
 
        if (!strncmp(id, ACPI_SIG_MADT, 4))
@@ -303,13 +341,29 @@ acpi_table_parse_entries(char *id,
                return -ENODEV;
        }
 
-       count = acpi_parse_entries(id, table_size, handler, table_header,
-                       entry_id, max_entries);
+       count = acpi_parse_entries_array(id, table_size, table_header,
+                       proc, proc_num, max_entries);
 
        early_acpi_os_unmap_memory((char *)table_header, tbl_size);
        return count;
 }
 
+int __init
+acpi_table_parse_entries(char *id,
+                       unsigned long table_size,
+                       int entry_id,
+                       acpi_tbl_entry_handler handler,
+                       unsigned int max_entries)
+{
+       struct acpi_subtable_proc proc = {
+               .id             = entry_id,
+               .handler        = handler,
+       };
+
+       return acpi_table_parse_entries_array(id, table_size, &proc, 1,
+                                               max_entries);
+}
+
 int __init
 acpi_table_parse_madt(enum acpi_madt_type id,
                      acpi_tbl_entry_handler handler, unsigned int max_entries)