diff options
| author | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2013-12-16 19:11:28 -0500 |
|---|---|---|
| committer | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2013-12-16 19:11:28 -0500 |
| commit | 138a6d7ea2deb3080116a4f99019e181b62e5ce5 (patch) | |
| tree | 424622059405352935fbf1dde015a1e130b56198 /drivers | |
| parent | 4fc6069e7df873bda9baabe0fa9f0be23363159a (diff) | |
| parent | 319e2e3f63c348a9b66db4667efa73178e18b17d (diff) | |
Merge 3.13-rc4 into char-misc-next
We want these fixes in here.
Diffstat (limited to 'drivers')
551 files changed, 7036 insertions, 3074 deletions
diff --git a/drivers/acpi/acpica/acresrc.h b/drivers/acpi/acpica/acresrc.h index f691d0e4d9fa..ff97430455cb 100644 --- a/drivers/acpi/acpica/acresrc.h +++ b/drivers/acpi/acpica/acresrc.h | |||
| @@ -184,7 +184,7 @@ acpi_rs_create_resource_list(union acpi_operand_object *aml_buffer, | |||
| 184 | struct acpi_buffer *output_buffer); | 184 | struct acpi_buffer *output_buffer); |
| 185 | 185 | ||
| 186 | acpi_status | 186 | acpi_status |
| 187 | acpi_rs_create_aml_resources(struct acpi_resource *linked_list_buffer, | 187 | acpi_rs_create_aml_resources(struct acpi_buffer *resource_list, |
| 188 | struct acpi_buffer *output_buffer); | 188 | struct acpi_buffer *output_buffer); |
| 189 | 189 | ||
| 190 | acpi_status | 190 | acpi_status |
| @@ -227,8 +227,8 @@ acpi_rs_get_list_length(u8 * aml_buffer, | |||
| 227 | u32 aml_buffer_length, acpi_size * size_needed); | 227 | u32 aml_buffer_length, acpi_size * size_needed); |
| 228 | 228 | ||
| 229 | acpi_status | 229 | acpi_status |
| 230 | acpi_rs_get_aml_length(struct acpi_resource *linked_list_buffer, | 230 | acpi_rs_get_aml_length(struct acpi_resource *resource_list, |
| 231 | acpi_size * size_needed); | 231 | acpi_size resource_list_size, acpi_size * size_needed); |
| 232 | 232 | ||
| 233 | acpi_status | 233 | acpi_status |
| 234 | acpi_rs_get_pci_routing_table_length(union acpi_operand_object *package_object, | 234 | acpi_rs_get_pci_routing_table_length(union acpi_operand_object *package_object, |
diff --git a/drivers/acpi/acpica/nsalloc.c b/drivers/acpi/acpica/nsalloc.c index 243737363fb8..fd1ff54cda19 100644 --- a/drivers/acpi/acpica/nsalloc.c +++ b/drivers/acpi/acpica/nsalloc.c | |||
| @@ -106,6 +106,7 @@ struct acpi_namespace_node *acpi_ns_create_node(u32 name) | |||
| 106 | void acpi_ns_delete_node(struct acpi_namespace_node *node) | 106 | void acpi_ns_delete_node(struct acpi_namespace_node *node) |
| 107 | { | 107 | { |
| 108 | union acpi_operand_object *obj_desc; | 108 | union acpi_operand_object *obj_desc; |
| 109 | union acpi_operand_object *next_desc; | ||
| 109 | 110 | ||
| 110 | ACPI_FUNCTION_NAME(ns_delete_node); | 111 | ACPI_FUNCTION_NAME(ns_delete_node); |
| 111 | 112 | ||
| @@ -114,12 +115,13 @@ void acpi_ns_delete_node(struct acpi_namespace_node *node) | |||
| 114 | acpi_ns_detach_object(node); | 115 | acpi_ns_detach_object(node); |
| 115 | 116 | ||
| 116 | /* | 117 | /* |
| 117 | * Delete an attached data object if present (an object that was created | 118 | * Delete an attached data object list if present (objects that were |
| 118 | * and attached via acpi_attach_data). Note: After any normal object is | 119 | * attached via acpi_attach_data). Note: After any normal object is |
| 119 | * detached above, the only possible remaining object is a data object. | 120 | * detached above, the only possible remaining object(s) are data |
| 121 | * objects, in a linked list. | ||
| 120 | */ | 122 | */ |
| 121 | obj_desc = node->object; | 123 | obj_desc = node->object; |
| 122 | if (obj_desc && (obj_desc->common.type == ACPI_TYPE_LOCAL_DATA)) { | 124 | while (obj_desc && (obj_desc->common.type == ACPI_TYPE_LOCAL_DATA)) { |
| 123 | 125 | ||
| 124 | /* Invoke the attached data deletion handler if present */ | 126 | /* Invoke the attached data deletion handler if present */ |
| 125 | 127 | ||
| @@ -127,7 +129,15 @@ void acpi_ns_delete_node(struct acpi_namespace_node *node) | |||
| 127 | obj_desc->data.handler(node, obj_desc->data.pointer); | 129 | obj_desc->data.handler(node, obj_desc->data.pointer); |
| 128 | } | 130 | } |
| 129 | 131 | ||
| 132 | next_desc = obj_desc->common.next_object; | ||
| 130 | acpi_ut_remove_reference(obj_desc); | 133 | acpi_ut_remove_reference(obj_desc); |
| 134 | obj_desc = next_desc; | ||
| 135 | } | ||
| 136 | |||
| 137 | /* Special case for the statically allocated root node */ | ||
| 138 | |||
| 139 | if (node == acpi_gbl_root_node) { | ||
| 140 | return; | ||
| 131 | } | 141 | } |
| 132 | 142 | ||
| 133 | /* Now we can delete the node */ | 143 | /* Now we can delete the node */ |
diff --git a/drivers/acpi/acpica/nsutils.c b/drivers/acpi/acpica/nsutils.c index cc2fea94c5f0..4a0665b6bcc1 100644 --- a/drivers/acpi/acpica/nsutils.c +++ b/drivers/acpi/acpica/nsutils.c | |||
| @@ -593,24 +593,26 @@ struct acpi_namespace_node *acpi_ns_validate_handle(acpi_handle handle) | |||
| 593 | 593 | ||
| 594 | void acpi_ns_terminate(void) | 594 | void acpi_ns_terminate(void) |
| 595 | { | 595 | { |
| 596 | union acpi_operand_object *obj_desc; | 596 | acpi_status status; |
| 597 | 597 | ||
| 598 | ACPI_FUNCTION_TRACE(ns_terminate); | 598 | ACPI_FUNCTION_TRACE(ns_terminate); |
| 599 | 599 | ||
| 600 | /* | 600 | /* |
| 601 | * 1) Free the entire namespace -- all nodes and objects | 601 | * Free the entire namespace -- all nodes and all objects |
| 602 | * | 602 | * attached to the nodes |
| 603 | * Delete all object descriptors attached to namepsace nodes | ||
| 604 | */ | 603 | */ |
| 605 | acpi_ns_delete_namespace_subtree(acpi_gbl_root_node); | 604 | acpi_ns_delete_namespace_subtree(acpi_gbl_root_node); |
| 606 | 605 | ||
| 607 | /* Detach any objects attached to the root */ | 606 | /* Delete any objects attached to the root node */ |
| 608 | 607 | ||
| 609 | obj_desc = acpi_ns_get_attached_object(acpi_gbl_root_node); | 608 | status = acpi_ut_acquire_mutex(ACPI_MTX_NAMESPACE); |
| 610 | if (obj_desc) { | 609 | if (ACPI_FAILURE(status)) { |
| 611 | acpi_ns_detach_object(acpi_gbl_root_node); | 610 | return_VOID; |
| 612 | } | 611 | } |
| 613 | 612 | ||
| 613 | acpi_ns_delete_node(acpi_gbl_root_node); | ||
| 614 | (void)acpi_ut_release_mutex(ACPI_MTX_NAMESPACE); | ||
| 615 | |||
| 614 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Namespace freed\n")); | 616 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Namespace freed\n")); |
| 615 | return_VOID; | 617 | return_VOID; |
| 616 | } | 618 | } |
diff --git a/drivers/acpi/acpica/rscalc.c b/drivers/acpi/acpica/rscalc.c index b62a0f4f4f9b..b60c9cf82862 100644 --- a/drivers/acpi/acpica/rscalc.c +++ b/drivers/acpi/acpica/rscalc.c | |||
| @@ -174,6 +174,7 @@ acpi_rs_stream_option_length(u32 resource_length, | |||
| 174 | * FUNCTION: acpi_rs_get_aml_length | 174 | * FUNCTION: acpi_rs_get_aml_length |
| 175 | * | 175 | * |
| 176 | * PARAMETERS: resource - Pointer to the resource linked list | 176 | * PARAMETERS: resource - Pointer to the resource linked list |
| 177 | * resource_list_size - Size of the resource linked list | ||
| 177 | * size_needed - Where the required size is returned | 178 | * size_needed - Where the required size is returned |
| 178 | * | 179 | * |
| 179 | * RETURN: Status | 180 | * RETURN: Status |
| @@ -185,16 +186,20 @@ acpi_rs_stream_option_length(u32 resource_length, | |||
| 185 | ******************************************************************************/ | 186 | ******************************************************************************/ |
| 186 | 187 | ||
| 187 | acpi_status | 188 | acpi_status |
| 188 | acpi_rs_get_aml_length(struct acpi_resource * resource, acpi_size * size_needed) | 189 | acpi_rs_get_aml_length(struct acpi_resource *resource, |
| 190 | acpi_size resource_list_size, acpi_size * size_needed) | ||
| 189 | { | 191 | { |
| 190 | acpi_size aml_size_needed = 0; | 192 | acpi_size aml_size_needed = 0; |
| 193 | struct acpi_resource *resource_end; | ||
| 191 | acpi_rs_length total_size; | 194 | acpi_rs_length total_size; |
| 192 | 195 | ||
| 193 | ACPI_FUNCTION_TRACE(rs_get_aml_length); | 196 | ACPI_FUNCTION_TRACE(rs_get_aml_length); |
| 194 | 197 | ||
| 195 | /* Traverse entire list of internal resource descriptors */ | 198 | /* Traverse entire list of internal resource descriptors */ |
| 196 | 199 | ||
| 197 | while (resource) { | 200 | resource_end = |
| 201 | ACPI_ADD_PTR(struct acpi_resource, resource, resource_list_size); | ||
| 202 | while (resource < resource_end) { | ||
| 198 | 203 | ||
| 199 | /* Validate the descriptor type */ | 204 | /* Validate the descriptor type */ |
| 200 | 205 | ||
diff --git a/drivers/acpi/acpica/rscreate.c b/drivers/acpi/acpica/rscreate.c index 65f3e1c5b598..3a2ace93e62c 100644 --- a/drivers/acpi/acpica/rscreate.c +++ b/drivers/acpi/acpica/rscreate.c | |||
| @@ -418,22 +418,21 @@ acpi_rs_create_pci_routing_table(union acpi_operand_object *package_object, | |||
| 418 | * | 418 | * |
| 419 | * FUNCTION: acpi_rs_create_aml_resources | 419 | * FUNCTION: acpi_rs_create_aml_resources |
| 420 | * | 420 | * |
| 421 | * PARAMETERS: linked_list_buffer - Pointer to the resource linked list | 421 | * PARAMETERS: resource_list - Pointer to the resource list buffer |
| 422 | * output_buffer - Pointer to the user's buffer | 422 | * output_buffer - Where the AML buffer is returned |
| 423 | * | 423 | * |
| 424 | * RETURN: Status AE_OK if okay, else a valid acpi_status code. | 424 | * RETURN: Status AE_OK if okay, else a valid acpi_status code. |
| 425 | * If the output_buffer is too small, the error will be | 425 | * If the output_buffer is too small, the error will be |
| 426 | * AE_BUFFER_OVERFLOW and output_buffer->Length will point | 426 | * AE_BUFFER_OVERFLOW and output_buffer->Length will point |
| 427 | * to the size buffer needed. | 427 | * to the size buffer needed. |
| 428 | * | 428 | * |
| 429 | * DESCRIPTION: Takes the linked list of device resources and | 429 | * DESCRIPTION: Converts a list of device resources to an AML bytestream |
| 430 | * creates a bytestream to be used as input for the | 430 | * to be used as input for the _SRS control method. |
| 431 | * _SRS control method. | ||
| 432 | * | 431 | * |
| 433 | ******************************************************************************/ | 432 | ******************************************************************************/ |
| 434 | 433 | ||
| 435 | acpi_status | 434 | acpi_status |
| 436 | acpi_rs_create_aml_resources(struct acpi_resource *linked_list_buffer, | 435 | acpi_rs_create_aml_resources(struct acpi_buffer *resource_list, |
| 437 | struct acpi_buffer *output_buffer) | 436 | struct acpi_buffer *output_buffer) |
| 438 | { | 437 | { |
| 439 | acpi_status status; | 438 | acpi_status status; |
| @@ -441,16 +440,16 @@ acpi_rs_create_aml_resources(struct acpi_resource *linked_list_buffer, | |||
| 441 | 440 | ||
| 442 | ACPI_FUNCTION_TRACE(rs_create_aml_resources); | 441 | ACPI_FUNCTION_TRACE(rs_create_aml_resources); |
| 443 | 442 | ||
| 444 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "LinkedListBuffer = %p\n", | 443 | /* Params already validated, no need to re-validate here */ |
| 445 | linked_list_buffer)); | ||
| 446 | 444 | ||
| 447 | /* | 445 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "ResourceList Buffer = %p\n", |
| 448 | * Params already validated, so we don't re-validate here | 446 | resource_list->pointer)); |
| 449 | * | 447 | |
| 450 | * Pass the linked_list_buffer into a module that calculates | 448 | /* Get the buffer size needed for the AML byte stream */ |
| 451 | * the buffer size needed for the byte stream. | 449 | |
| 452 | */ | 450 | status = acpi_rs_get_aml_length(resource_list->pointer, |
| 453 | status = acpi_rs_get_aml_length(linked_list_buffer, &aml_size_needed); | 451 | resource_list->length, |
| 452 | &aml_size_needed); | ||
| 454 | 453 | ||
| 455 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "AmlSizeNeeded=%X, %s\n", | 454 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "AmlSizeNeeded=%X, %s\n", |
| 456 | (u32)aml_size_needed, acpi_format_exception(status))); | 455 | (u32)aml_size_needed, acpi_format_exception(status))); |
| @@ -467,10 +466,9 @@ acpi_rs_create_aml_resources(struct acpi_resource *linked_list_buffer, | |||
| 467 | 466 | ||
| 468 | /* Do the conversion */ | 467 | /* Do the conversion */ |
| 469 | 468 | ||
| 470 | status = | 469 | status = acpi_rs_convert_resources_to_aml(resource_list->pointer, |
| 471 | acpi_rs_convert_resources_to_aml(linked_list_buffer, | 470 | aml_size_needed, |
| 472 | aml_size_needed, | 471 | output_buffer->pointer); |
| 473 | output_buffer->pointer); | ||
| 474 | if (ACPI_FAILURE(status)) { | 472 | if (ACPI_FAILURE(status)) { |
| 475 | return_ACPI_STATUS(status); | 473 | return_ACPI_STATUS(status); |
| 476 | } | 474 | } |
diff --git a/drivers/acpi/acpica/rsutils.c b/drivers/acpi/acpica/rsutils.c index aef303d56d86..14a7982c9961 100644 --- a/drivers/acpi/acpica/rsutils.c +++ b/drivers/acpi/acpica/rsutils.c | |||
| @@ -753,7 +753,7 @@ acpi_rs_set_srs_method_data(struct acpi_namespace_node *node, | |||
| 753 | * Convert the linked list into a byte stream | 753 | * Convert the linked list into a byte stream |
| 754 | */ | 754 | */ |
| 755 | buffer.length = ACPI_ALLOCATE_LOCAL_BUFFER; | 755 | buffer.length = ACPI_ALLOCATE_LOCAL_BUFFER; |
| 756 | status = acpi_rs_create_aml_resources(in_buffer->pointer, &buffer); | 756 | status = acpi_rs_create_aml_resources(in_buffer, &buffer); |
| 757 | if (ACPI_FAILURE(status)) { | 757 | if (ACPI_FAILURE(status)) { |
| 758 | goto cleanup; | 758 | goto cleanup; |
| 759 | } | 759 | } |
diff --git a/drivers/acpi/acpica/utdebug.c b/drivers/acpi/acpica/utdebug.c index 1a67b3944b3b..03ae8affe48f 100644 --- a/drivers/acpi/acpica/utdebug.c +++ b/drivers/acpi/acpica/utdebug.c | |||
| @@ -185,6 +185,7 @@ acpi_debug_print(u32 requested_debug_level, | |||
| 185 | } | 185 | } |
| 186 | 186 | ||
| 187 | acpi_gbl_prev_thread_id = thread_id; | 187 | acpi_gbl_prev_thread_id = thread_id; |
| 188 | acpi_gbl_nesting_level = 0; | ||
| 188 | } | 189 | } |
| 189 | 190 | ||
| 190 | /* | 191 | /* |
| @@ -193,13 +194,21 @@ acpi_debug_print(u32 requested_debug_level, | |||
| 193 | */ | 194 | */ |
| 194 | acpi_os_printf("%9s-%04ld ", module_name, line_number); | 195 | acpi_os_printf("%9s-%04ld ", module_name, line_number); |
| 195 | 196 | ||
| 197 | #ifdef ACPI_EXEC_APP | ||
| 198 | /* | ||
| 199 | * For acpi_exec only, emit the thread ID and nesting level. | ||
| 200 | * Note: nesting level is really only useful during a single-thread | ||
| 201 | * execution. Otherwise, multiple threads will keep resetting the | ||
| 202 | * level. | ||
| 203 | */ | ||
| 196 | if (ACPI_LV_THREADS & acpi_dbg_level) { | 204 | if (ACPI_LV_THREADS & acpi_dbg_level) { |
| 197 | acpi_os_printf("[%u] ", (u32)thread_id); | 205 | acpi_os_printf("[%u] ", (u32)thread_id); |
| 198 | } | 206 | } |
| 199 | 207 | ||
| 200 | acpi_os_printf("[%02ld] %-22.22s: ", | 208 | acpi_os_printf("[%02ld] ", acpi_gbl_nesting_level); |
| 201 | acpi_gbl_nesting_level, | 209 | #endif |
| 202 | acpi_ut_trim_function_name(function_name)); | 210 | |
| 211 | acpi_os_printf("%-22.22s: ", acpi_ut_trim_function_name(function_name)); | ||
| 203 | 212 | ||
| 204 | va_start(args, format); | 213 | va_start(args, format); |
| 205 | acpi_os_vprintf(format, args); | 214 | acpi_os_vprintf(format, args); |
| @@ -420,7 +429,9 @@ acpi_ut_exit(u32 line_number, | |||
| 420 | component_id, "%s\n", acpi_gbl_fn_exit_str); | 429 | component_id, "%s\n", acpi_gbl_fn_exit_str); |
| 421 | } | 430 | } |
| 422 | 431 | ||
| 423 | acpi_gbl_nesting_level--; | 432 | if (acpi_gbl_nesting_level) { |
| 433 | acpi_gbl_nesting_level--; | ||
| 434 | } | ||
| 424 | } | 435 | } |
| 425 | 436 | ||
| 426 | ACPI_EXPORT_SYMBOL(acpi_ut_exit) | 437 | ACPI_EXPORT_SYMBOL(acpi_ut_exit) |
| @@ -467,7 +478,9 @@ acpi_ut_status_exit(u32 line_number, | |||
| 467 | } | 478 | } |
| 468 | } | 479 | } |
| 469 | 480 | ||
| 470 | acpi_gbl_nesting_level--; | 481 | if (acpi_gbl_nesting_level) { |
| 482 | acpi_gbl_nesting_level--; | ||
| 483 | } | ||
| 471 | } | 484 | } |
| 472 | 485 | ||
| 473 | ACPI_EXPORT_SYMBOL(acpi_ut_status_exit) | 486 | ACPI_EXPORT_SYMBOL(acpi_ut_status_exit) |
| @@ -504,7 +517,9 @@ acpi_ut_value_exit(u32 line_number, | |||
| 504 | ACPI_FORMAT_UINT64(value)); | 517 | ACPI_FORMAT_UINT64(value)); |
| 505 | } | 518 | } |
| 506 | 519 | ||
| 507 | acpi_gbl_nesting_level--; | 520 | if (acpi_gbl_nesting_level) { |
| 521 | acpi_gbl_nesting_level--; | ||
| 522 | } | ||
| 508 | } | 523 | } |
| 509 | 524 | ||
| 510 | ACPI_EXPORT_SYMBOL(acpi_ut_value_exit) | 525 | ACPI_EXPORT_SYMBOL(acpi_ut_value_exit) |
| @@ -540,7 +555,9 @@ acpi_ut_ptr_exit(u32 line_number, | |||
| 540 | ptr); | 555 | ptr); |
| 541 | } | 556 | } |
| 542 | 557 | ||
| 543 | acpi_gbl_nesting_level--; | 558 | if (acpi_gbl_nesting_level) { |
| 559 | acpi_gbl_nesting_level--; | ||
| 560 | } | ||
| 544 | } | 561 | } |
| 545 | 562 | ||
| 546 | #endif | 563 | #endif |
diff --git a/drivers/acpi/nvs.c b/drivers/acpi/nvs.c index 266bc58ce0ce..386a9fe497b4 100644 --- a/drivers/acpi/nvs.c +++ b/drivers/acpi/nvs.c | |||
| @@ -13,7 +13,6 @@ | |||
| 13 | #include <linux/slab.h> | 13 | #include <linux/slab.h> |
| 14 | #include <linux/acpi.h> | 14 | #include <linux/acpi.h> |
| 15 | #include <linux/acpi_io.h> | 15 | #include <linux/acpi_io.h> |
| 16 | #include <acpi/acpiosxf.h> | ||
| 17 | 16 | ||
| 18 | /* ACPI NVS regions, APEI may use it */ | 17 | /* ACPI NVS regions, APEI may use it */ |
| 19 | 18 | ||
diff --git a/drivers/acpi/pci_root.c b/drivers/acpi/pci_root.c index 0703bff5e60e..20360e480bd8 100644 --- a/drivers/acpi/pci_root.c +++ b/drivers/acpi/pci_root.c | |||
| @@ -65,6 +65,9 @@ static struct acpi_scan_handler pci_root_handler = { | |||
| 65 | .ids = root_device_ids, | 65 | .ids = root_device_ids, |
| 66 | .attach = acpi_pci_root_add, | 66 | .attach = acpi_pci_root_add, |
| 67 | .detach = acpi_pci_root_remove, | 67 | .detach = acpi_pci_root_remove, |
| 68 | .hotplug = { | ||
| 69 | .ignore = true, | ||
| 70 | }, | ||
| 68 | }; | 71 | }; |
| 69 | 72 | ||
| 70 | static DEFINE_MUTEX(osc_lock); | 73 | static DEFINE_MUTEX(osc_lock); |
diff --git a/drivers/acpi/scan.c b/drivers/acpi/scan.c index 15daa21fcd05..fd39459926b1 100644 --- a/drivers/acpi/scan.c +++ b/drivers/acpi/scan.c | |||
| @@ -1772,7 +1772,7 @@ static void acpi_scan_init_hotplug(acpi_handle handle, int type) | |||
| 1772 | */ | 1772 | */ |
| 1773 | list_for_each_entry(hwid, &pnp.ids, list) { | 1773 | list_for_each_entry(hwid, &pnp.ids, list) { |
| 1774 | handler = acpi_scan_match_handler(hwid->id, NULL); | 1774 | handler = acpi_scan_match_handler(hwid->id, NULL); |
| 1775 | if (handler) { | 1775 | if (handler && !handler->hotplug.ignore) { |
| 1776 | acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, | 1776 | acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, |
| 1777 | acpi_hotplug_notify_cb, handler); | 1777 | acpi_hotplug_notify_cb, handler); |
| 1778 | break; | 1778 | break; |
diff --git a/drivers/acpi/sleep.c b/drivers/acpi/sleep.c index 14df30580e15..721e949e606e 100644 --- a/drivers/acpi/sleep.c +++ b/drivers/acpi/sleep.c | |||
| @@ -525,7 +525,7 @@ static int acpi_suspend_enter(suspend_state_t pm_state) | |||
| 525 | * generate wakeup events. | 525 | * generate wakeup events. |
| 526 | */ | 526 | */ |
| 527 | if (ACPI_SUCCESS(status) && (acpi_state == ACPI_STATE_S3)) { | 527 | if (ACPI_SUCCESS(status) && (acpi_state == ACPI_STATE_S3)) { |
| 528 | acpi_event_status pwr_btn_status; | 528 | acpi_event_status pwr_btn_status = ACPI_EVENT_FLAG_DISABLED; |
| 529 | 529 | ||
| 530 | acpi_get_event_status(ACPI_EVENT_POWER_BUTTON, &pwr_btn_status); | 530 | acpi_get_event_status(ACPI_EVENT_POWER_BUTTON, &pwr_btn_status); |
| 531 | 531 | ||
diff --git a/drivers/acpi/sysfs.c b/drivers/acpi/sysfs.c index db5293650f62..6dbc3ca45223 100644 --- a/drivers/acpi/sysfs.c +++ b/drivers/acpi/sysfs.c | |||
| @@ -309,7 +309,7 @@ static void acpi_table_attr_init(struct acpi_table_attr *table_attr, | |||
| 309 | sprintf(table_attr->name + ACPI_NAME_SIZE, "%d", | 309 | sprintf(table_attr->name + ACPI_NAME_SIZE, "%d", |
| 310 | table_attr->instance); | 310 | table_attr->instance); |
| 311 | 311 | ||
| 312 | table_attr->attr.size = 0; | 312 | table_attr->attr.size = table_header->length; |
| 313 | table_attr->attr.read = acpi_table_show; | 313 | table_attr->attr.read = acpi_table_show; |
| 314 | table_attr->attr.attr.name = table_attr->name; | 314 | table_attr->attr.attr.name = table_attr->name; |
| 315 | table_attr->attr.attr.mode = 0400; | 315 | table_attr->attr.attr.mode = 0400; |
| @@ -354,8 +354,9 @@ static int acpi_tables_sysfs_init(void) | |||
| 354 | { | 354 | { |
| 355 | struct acpi_table_attr *table_attr; | 355 | struct acpi_table_attr *table_attr; |
| 356 | struct acpi_table_header *table_header = NULL; | 356 | struct acpi_table_header *table_header = NULL; |
| 357 | int table_index = 0; | 357 | int table_index; |
| 358 | int result; | 358 | acpi_status status; |
| 359 | int ret; | ||
| 359 | 360 | ||
| 360 | tables_kobj = kobject_create_and_add("tables", acpi_kobj); | 361 | tables_kobj = kobject_create_and_add("tables", acpi_kobj); |
| 361 | if (!tables_kobj) | 362 | if (!tables_kobj) |
| @@ -365,33 +366,34 @@ static int acpi_tables_sysfs_init(void) | |||
| 365 | if (!dynamic_tables_kobj) | 366 | if (!dynamic_tables_kobj) |
| 366 | goto err_dynamic_tables; | 367 | goto err_dynamic_tables; |
| 367 | 368 | ||
| 368 | do { | 369 | for (table_index = 0;; table_index++) { |
| 369 | result = acpi_get_table_by_index(table_index, &table_header); | 370 | status = acpi_get_table_by_index(table_index, &table_header); |
| 370 | if (!result) { | 371 | |
| 371 | table_index++; | 372 | if (status == AE_BAD_PARAMETER) |
| 372 | table_attr = NULL; | 373 | break; |
| 373 | table_attr = | 374 | |
| 374 | kzalloc(sizeof(struct acpi_table_attr), GFP_KERNEL); | 375 | if (ACPI_FAILURE(status)) |
| 375 | if (!table_attr) | 376 | continue; |
| 376 | return -ENOMEM; | 377 | |
| 377 | 378 | table_attr = NULL; | |
| 378 | acpi_table_attr_init(table_attr, table_header); | 379 | table_attr = kzalloc(sizeof(*table_attr), GFP_KERNEL); |
| 379 | result = | 380 | if (!table_attr) |
| 380 | sysfs_create_bin_file(tables_kobj, | 381 | return -ENOMEM; |
| 381 | &table_attr->attr); | 382 | |
| 382 | if (result) { | 383 | acpi_table_attr_init(table_attr, table_header); |
| 383 | kfree(table_attr); | 384 | ret = sysfs_create_bin_file(tables_kobj, &table_attr->attr); |
| 384 | return result; | 385 | if (ret) { |
| 385 | } else | 386 | kfree(table_attr); |
| 386 | list_add_tail(&table_attr->node, | 387 | return ret; |
| 387 | &acpi_table_attr_list); | ||
| 388 | } | 388 | } |
| 389 | } while (!result); | 389 | list_add_tail(&table_attr->node, &acpi_table_attr_list); |
| 390 | } | ||
| 391 | |||
| 390 | kobject_uevent(tables_kobj, KOBJ_ADD); | 392 | kobject_uevent(tables_kobj, KOBJ_ADD); |
| 391 | kobject_uevent(dynamic_tables_kobj, KOBJ_ADD); | 393 | kobject_uevent(dynamic_tables_kobj, KOBJ_ADD); |
| 392 | result = acpi_install_table_handler(acpi_sysfs_table_handler, NULL); | 394 | status = acpi_install_table_handler(acpi_sysfs_table_handler, NULL); |
| 393 | 395 | ||
| 394 | return result == AE_OK ? 0 : -EINVAL; | 396 | return ACPI_FAILURE(status) ? -EINVAL : 0; |
| 395 | err_dynamic_tables: | 397 | err_dynamic_tables: |
| 396 | kobject_put(tables_kobj); | 398 | kobject_put(tables_kobj); |
| 397 | err: | 399 | err: |
diff --git a/drivers/ata/ahci.c b/drivers/ata/ahci.c index e2903d03180e..14f1e9506338 100644 --- a/drivers/ata/ahci.c +++ b/drivers/ata/ahci.c | |||
| @@ -435,6 +435,8 @@ static const struct pci_device_id ahci_pci_tbl[] = { | |||
| 435 | .driver_data = board_ahci_yes_fbs }, /* 88se9172 on some Gigabyte */ | 435 | .driver_data = board_ahci_yes_fbs }, /* 88se9172 on some Gigabyte */ |
| 436 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL_EXT, 0x91a3), | 436 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL_EXT, 0x91a3), |
| 437 | .driver_data = board_ahci_yes_fbs }, | 437 | .driver_data = board_ahci_yes_fbs }, |
| 438 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL_EXT, 0x9230), | ||
| 439 | .driver_data = board_ahci_yes_fbs }, | ||
| 438 | 440 | ||
| 439 | /* Promise */ | 441 | /* Promise */ |
| 440 | { PCI_VDEVICE(PROMISE, 0x3f20), board_ahci }, /* PDC42819 */ | 442 | { PCI_VDEVICE(PROMISE, 0x3f20), board_ahci }, /* PDC42819 */ |
diff --git a/drivers/ata/ahci_platform.c b/drivers/ata/ahci_platform.c index f9554318504f..4b231baceb09 100644 --- a/drivers/ata/ahci_platform.c +++ b/drivers/ata/ahci_platform.c | |||
| @@ -329,6 +329,7 @@ static SIMPLE_DEV_PM_OPS(ahci_pm_ops, ahci_suspend, ahci_resume); | |||
| 329 | static const struct of_device_id ahci_of_match[] = { | 329 | static const struct of_device_id ahci_of_match[] = { |
| 330 | { .compatible = "snps,spear-ahci", }, | 330 | { .compatible = "snps,spear-ahci", }, |
| 331 | { .compatible = "snps,exynos5440-ahci", }, | 331 | { .compatible = "snps,exynos5440-ahci", }, |
| 332 | { .compatible = "ibm,476gtr-ahci", }, | ||
| 332 | {}, | 333 | {}, |
| 333 | }; | 334 | }; |
| 334 | MODULE_DEVICE_TABLE(of, ahci_of_match); | 335 | MODULE_DEVICE_TABLE(of, ahci_of_match); |
diff --git a/drivers/ata/libata-core.c b/drivers/ata/libata-core.c index 81a94a3919db..75b93678bbcd 100644 --- a/drivers/ata/libata-core.c +++ b/drivers/ata/libata-core.c | |||
| @@ -6304,10 +6304,9 @@ static void ata_port_detach(struct ata_port *ap) | |||
| 6304 | for (i = 0; i < SATA_PMP_MAX_PORTS; i++) | 6304 | for (i = 0; i < SATA_PMP_MAX_PORTS; i++) |
| 6305 | ata_tlink_delete(&ap->pmp_link[i]); | 6305 | ata_tlink_delete(&ap->pmp_link[i]); |
| 6306 | } | 6306 | } |
| 6307 | ata_tport_delete(ap); | ||
| 6308 | |||
| 6309 | /* remove the associated SCSI host */ | 6307 | /* remove the associated SCSI host */ |
| 6310 | scsi_remove_host(ap->scsi_host); | 6308 | scsi_remove_host(ap->scsi_host); |
| 6309 | ata_tport_delete(ap); | ||
| 6311 | } | 6310 | } |
| 6312 | 6311 | ||
| 6313 | /** | 6312 | /** |
diff --git a/drivers/ata/libata-scsi.c b/drivers/ata/libata-scsi.c index db6dfcfa3e2e..ab58556d347c 100644 --- a/drivers/ata/libata-scsi.c +++ b/drivers/ata/libata-scsi.c | |||
| @@ -3625,6 +3625,7 @@ int ata_scsi_add_hosts(struct ata_host *host, struct scsi_host_template *sht) | |||
| 3625 | shost->max_lun = 1; | 3625 | shost->max_lun = 1; |
| 3626 | shost->max_channel = 1; | 3626 | shost->max_channel = 1; |
| 3627 | shost->max_cmd_len = 16; | 3627 | shost->max_cmd_len = 16; |
| 3628 | shost->no_write_same = 1; | ||
| 3628 | 3629 | ||
| 3629 | /* Schedule policy is determined by ->qc_defer() | 3630 | /* Schedule policy is determined by ->qc_defer() |
| 3630 | * callback and it needs to see every deferred qc. | 3631 | * callback and it needs to see every deferred qc. |
diff --git a/drivers/ata/libata-zpodd.c b/drivers/ata/libata-zpodd.c index 68f9e3293e9c..88949c6d55dd 100644 --- a/drivers/ata/libata-zpodd.c +++ b/drivers/ata/libata-zpodd.c | |||
| @@ -88,15 +88,13 @@ static enum odd_mech_type zpodd_get_mech_type(struct ata_device *dev) | |||
| 88 | static bool odd_can_poweroff(struct ata_device *ata_dev) | 88 | static bool odd_can_poweroff(struct ata_device *ata_dev) |
| 89 | { | 89 | { |
| 90 | acpi_handle handle; | 90 | acpi_handle handle; |
| 91 | acpi_status status; | ||
| 92 | struct acpi_device *acpi_dev; | 91 | struct acpi_device *acpi_dev; |
| 93 | 92 | ||
| 94 | handle = ata_dev_acpi_handle(ata_dev); | 93 | handle = ata_dev_acpi_handle(ata_dev); |
| 95 | if (!handle) | 94 | if (!handle) |
| 96 | return false; | 95 | return false; |
| 97 | 96 | ||
| 98 | status = acpi_bus_get_device(handle, &acpi_dev); | 97 | if (acpi_bus_get_device(handle, &acpi_dev)) |
| 99 | if (ACPI_FAILURE(status)) | ||
| 100 | return false; | 98 | return false; |
| 101 | 99 | ||
| 102 | return acpi_device_can_poweroff(acpi_dev); | 100 | return acpi_device_can_poweroff(acpi_dev); |
diff --git a/drivers/ata/pata_arasan_cf.c b/drivers/ata/pata_arasan_cf.c index e88690ebfd82..73492dd4a4bc 100644 --- a/drivers/ata/pata_arasan_cf.c +++ b/drivers/ata/pata_arasan_cf.c | |||
| @@ -319,6 +319,7 @@ static int cf_init(struct arasan_cf_dev *acdev) | |||
| 319 | ret = clk_set_rate(acdev->clk, 166000000); | 319 | ret = clk_set_rate(acdev->clk, 166000000); |
| 320 | if (ret) { | 320 | if (ret) { |
| 321 | dev_warn(acdev->host->dev, "clock set rate failed"); | 321 | dev_warn(acdev->host->dev, "clock set rate failed"); |
| 322 | clk_disable_unprepare(acdev->clk); | ||
| 322 | return ret; | 323 | return ret; |
| 323 | } | 324 | } |
| 324 | 325 | ||
diff --git a/drivers/base/regmap/regmap-mmio.c b/drivers/base/regmap/regmap-mmio.c index 98745dd77e8c..81f977510775 100644 --- a/drivers/base/regmap/regmap-mmio.c +++ b/drivers/base/regmap/regmap-mmio.c | |||
| @@ -40,7 +40,7 @@ static int regmap_mmio_gather_write(void *context, | |||
| 40 | 40 | ||
| 41 | BUG_ON(reg_size != 4); | 41 | BUG_ON(reg_size != 4); |
| 42 | 42 | ||
| 43 | if (ctx->clk) { | 43 | if (!IS_ERR(ctx->clk)) { |
| 44 | ret = clk_enable(ctx->clk); | 44 | ret = clk_enable(ctx->clk); |
| 45 | if (ret < 0) | 45 | if (ret < 0) |
| 46 | return ret; | 46 | return ret; |
| @@ -73,7 +73,7 @@ static int regmap_mmio_gather_write(void *context, | |||
| 73 | offset += ctx->val_bytes; | 73 | offset += ctx->val_bytes; |
| 74 | } | 74 | } |
| 75 | 75 | ||
| 76 | if (ctx->clk) | 76 | if (!IS_ERR(ctx->clk)) |
| 77 | clk_disable(ctx->clk); | 77 | clk_disable(ctx->clk); |
| 78 | 78 | ||
| 79 | return 0; | 79 | return 0; |
| @@ -96,7 +96,7 @@ static int regmap_mmio_read(void *context, | |||
| 96 | 96 | ||
| 97 | BUG_ON(reg_size != 4); | 97 | BUG_ON(reg_size != 4); |
| 98 | 98 | ||
| 99 | if (ctx->clk) { | 99 | if (!IS_ERR(ctx->clk)) { |
| 100 | ret = clk_enable(ctx->clk); | 100 | ret = clk_enable(ctx->clk); |
| 101 | if (ret < 0) | 101 | if (ret < 0) |
| 102 | return ret; | 102 | return ret; |
| @@ -129,7 +129,7 @@ static int regmap_mmio_read(void *context, | |||
| 129 | offset += ctx->val_bytes; | 129 | offset += ctx->val_bytes; |
| 130 | } | 130 | } |
| 131 | 131 | ||
| 132 | if (ctx->clk) | 132 | if (!IS_ERR(ctx->clk)) |
| 133 | clk_disable(ctx->clk); | 133 | clk_disable(ctx->clk); |
| 134 | 134 | ||
| 135 | return 0; | 135 | return 0; |
| @@ -139,7 +139,7 @@ static void regmap_mmio_free_context(void *context) | |||
| 139 | { | 139 | { |
| 140 | struct regmap_mmio_context *ctx = context; | 140 | struct regmap_mmio_context *ctx = context; |
| 141 | 141 | ||
| 142 | if (ctx->clk) { | 142 | if (!IS_ERR(ctx->clk)) { |
| 143 | clk_unprepare(ctx->clk); | 143 | clk_unprepare(ctx->clk); |
| 144 | clk_put(ctx->clk); | 144 | clk_put(ctx->clk); |
| 145 | } | 145 | } |
| @@ -209,6 +209,7 @@ static struct regmap_mmio_context *regmap_mmio_gen_context(struct device *dev, | |||
| 209 | 209 | ||
| 210 | ctx->regs = regs; | 210 | ctx->regs = regs; |
| 211 | ctx->val_bytes = config->val_bits / 8; | 211 | ctx->val_bytes = config->val_bits / 8; |
| 212 | ctx->clk = ERR_PTR(-ENODEV); | ||
| 212 | 213 | ||
| 213 | if (clk_id == NULL) | 214 | if (clk_id == NULL) |
| 214 | return ctx; | 215 | return ctx; |
diff --git a/drivers/base/regmap/regmap.c b/drivers/base/regmap/regmap.c index 9c021d9cace0..c2e002100949 100644 --- a/drivers/base/regmap/regmap.c +++ b/drivers/base/regmap/regmap.c | |||
| @@ -1549,7 +1549,7 @@ int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val, | |||
| 1549 | val + (i * val_bytes), | 1549 | val + (i * val_bytes), |
| 1550 | val_bytes); | 1550 | val_bytes); |
| 1551 | if (ret != 0) | 1551 | if (ret != 0) |
| 1552 | return ret; | 1552 | goto out; |
| 1553 | } | 1553 | } |
| 1554 | } else { | 1554 | } else { |
| 1555 | ret = _regmap_raw_write(map, reg, wval, val_bytes * val_count); | 1555 | ret = _regmap_raw_write(map, reg, wval, val_bytes * val_count); |
| @@ -1743,7 +1743,7 @@ static int _regmap_read(struct regmap *map, unsigned int reg, | |||
| 1743 | /** | 1743 | /** |
| 1744 | * regmap_read(): Read a value from a single register | 1744 | * regmap_read(): Read a value from a single register |
| 1745 | * | 1745 | * |
| 1746 | * @map: Register map to write to | 1746 | * @map: Register map to read from |
| 1747 | * @reg: Register to be read from | 1747 | * @reg: Register to be read from |
| 1748 | * @val: Pointer to store read value | 1748 | * @val: Pointer to store read value |
| 1749 | * | 1749 | * |
| @@ -1770,7 +1770,7 @@ EXPORT_SYMBOL_GPL(regmap_read); | |||
| 1770 | /** | 1770 | /** |
| 1771 | * regmap_raw_read(): Read raw data from the device | 1771 | * regmap_raw_read(): Read raw data from the device |
| 1772 | * | 1772 | * |
| 1773 | * @map: Register map to write to | 1773 | * @map: Register map to read from |
| 1774 | * @reg: First register to be read from | 1774 | * @reg: First register to be read from |
| 1775 | * @val: Pointer to store read value | 1775 | * @val: Pointer to store read value |
| 1776 | * @val_len: Size of data to read | 1776 | * @val_len: Size of data to read |
| @@ -1882,7 +1882,7 @@ EXPORT_SYMBOL_GPL(regmap_fields_read); | |||
| 1882 | /** | 1882 | /** |
| 1883 | * regmap_bulk_read(): Read multiple registers from the device | 1883 | * regmap_bulk_read(): Read multiple registers from the device |
| 1884 | * | 1884 | * |
| 1885 | * @map: Register map to write to | 1885 | * @map: Register map to read from |
| 1886 | * @reg: First register to be read from | 1886 | * @reg: First register to be read from |
| 1887 | * @val: Pointer to store read value, in native register size for device | 1887 | * @val: Pointer to store read value, in native register size for device |
| 1888 | * @val_count: Number of registers to read | 1888 | * @val_count: Number of registers to read |
diff --git a/drivers/block/null_blk.c b/drivers/block/null_blk.c index ea192ec029c4..f370fc13aea5 100644 --- a/drivers/block/null_blk.c +++ b/drivers/block/null_blk.c | |||
| @@ -495,23 +495,23 @@ static int null_add_dev(void) | |||
| 495 | 495 | ||
| 496 | spin_lock_init(&nullb->lock); | 496 | spin_lock_init(&nullb->lock); |
| 497 | 497 | ||
| 498 | if (queue_mode == NULL_Q_MQ && use_per_node_hctx) | ||
| 499 | submit_queues = nr_online_nodes; | ||
| 500 | |||
| 498 | if (setup_queues(nullb)) | 501 | if (setup_queues(nullb)) |
| 499 | goto err; | 502 | goto err; |
| 500 | 503 | ||
| 501 | if (queue_mode == NULL_Q_MQ) { | 504 | if (queue_mode == NULL_Q_MQ) { |
| 502 | null_mq_reg.numa_node = home_node; | 505 | null_mq_reg.numa_node = home_node; |
| 503 | null_mq_reg.queue_depth = hw_queue_depth; | 506 | null_mq_reg.queue_depth = hw_queue_depth; |
| 507 | null_mq_reg.nr_hw_queues = submit_queues; | ||
| 504 | 508 | ||
| 505 | if (use_per_node_hctx) { | 509 | if (use_per_node_hctx) { |
| 506 | null_mq_reg.ops->alloc_hctx = null_alloc_hctx; | 510 | null_mq_reg.ops->alloc_hctx = null_alloc_hctx; |
| 507 | null_mq_reg.ops->free_hctx = null_free_hctx; | 511 | null_mq_reg.ops->free_hctx = null_free_hctx; |
| 508 | |||
| 509 | null_mq_reg.nr_hw_queues = nr_online_nodes; | ||
| 510 | } else { | 512 | } else { |
| 511 | null_mq_reg.ops->alloc_hctx = blk_mq_alloc_single_hw_queue; | 513 | null_mq_reg.ops->alloc_hctx = blk_mq_alloc_single_hw_queue; |
| 512 | null_mq_reg.ops->free_hctx = blk_mq_free_single_hw_queue; | 514 | null_mq_reg.ops->free_hctx = blk_mq_free_single_hw_queue; |
| 513 | |||
| 514 | null_mq_reg.nr_hw_queues = submit_queues; | ||
| 515 | } | 515 | } |
| 516 | 516 | ||
| 517 | nullb->q = blk_mq_init_queue(&null_mq_reg, nullb); | 517 | nullb->q = blk_mq_init_queue(&null_mq_reg, nullb); |
diff --git a/drivers/block/xen-blkfront.c b/drivers/block/xen-blkfront.c index 432db1b59b00..c4a4c9006288 100644 --- a/drivers/block/xen-blkfront.c +++ b/drivers/block/xen-blkfront.c | |||
| @@ -489,7 +489,7 @@ static int blkif_queue_request(struct request *req) | |||
| 489 | 489 | ||
| 490 | if ((ring_req->operation == BLKIF_OP_INDIRECT) && | 490 | if ((ring_req->operation == BLKIF_OP_INDIRECT) && |
| 491 | (i % SEGS_PER_INDIRECT_FRAME == 0)) { | 491 | (i % SEGS_PER_INDIRECT_FRAME == 0)) { |
| 492 | unsigned long pfn; | 492 | unsigned long uninitialized_var(pfn); |
| 493 | 493 | ||
| 494 | if (segments) | 494 | if (segments) |
| 495 | kunmap_atomic(segments); | 495 | kunmap_atomic(segments); |
| @@ -2011,6 +2011,10 @@ static void blkif_release(struct gendisk *disk, fmode_t mode) | |||
| 2011 | 2011 | ||
| 2012 | bdev = bdget_disk(disk, 0); | 2012 | bdev = bdget_disk(disk, 0); |
| 2013 | 2013 | ||
| 2014 | if (!bdev) { | ||
| 2015 | WARN(1, "Block device %s yanked out from us!\n", disk->disk_name); | ||
| 2016 | goto out_mutex; | ||
| 2017 | } | ||
| 2014 | if (bdev->bd_openers) | 2018 | if (bdev->bd_openers) |
| 2015 | goto out; | 2019 | goto out; |
| 2016 | 2020 | ||
| @@ -2041,6 +2045,7 @@ static void blkif_release(struct gendisk *disk, fmode_t mode) | |||
| 2041 | 2045 | ||
| 2042 | out: | 2046 | out: |
| 2043 | bdput(bdev); | 2047 | bdput(bdev); |
| 2048 | out_mutex: | ||
| 2044 | mutex_unlock(&blkfront_mutex); | 2049 | mutex_unlock(&blkfront_mutex); |
| 2045 | } | 2050 | } |
| 2046 | 2051 | ||
diff --git a/drivers/char/hw_random/Kconfig b/drivers/char/hw_random/Kconfig index c206de2951f2..2f2b08457c67 100644 --- a/drivers/char/hw_random/Kconfig +++ b/drivers/char/hw_random/Kconfig | |||
| @@ -165,6 +165,19 @@ config HW_RANDOM_OMAP | |||
| 165 | 165 | ||
| 166 | If unsure, say Y. | 166 | If unsure, say Y. |
| 167 | 167 | ||
| 168 | config HW_RANDOM_OMAP3_ROM | ||
| 169 | tristate "OMAP3 ROM Random Number Generator support" | ||
| 170 | depends on HW_RANDOM && ARCH_OMAP3 | ||
| 171 | default HW_RANDOM | ||
| 172 | ---help--- | ||
| 173 | This driver provides kernel-side support for the Random Number | ||
| 174 | Generator hardware found on OMAP34xx processors. | ||
| 175 | |||
| 176 | To compile this driver as a module, choose M here: the | ||
| 177 | module will be called omap3-rom-rng. | ||
| 178 | |||
| 179 | If unsure, say Y. | ||
| 180 | |||
| 168 | config HW_RANDOM_OCTEON | 181 | config HW_RANDOM_OCTEON |
| 169 | tristate "Octeon Random Number Generator support" | 182 | tristate "Octeon Random Number Generator support" |
| 170 | depends on HW_RANDOM && CAVIUM_OCTEON_SOC | 183 | depends on HW_RANDOM && CAVIUM_OCTEON_SOC |
| @@ -327,3 +340,15 @@ config HW_RANDOM_TPM | |||
| 327 | module will be called tpm-rng. | 340 | module will be called tpm-rng. |
| 328 | 341 | ||
| 329 | If unsure, say Y. | 342 | If unsure, say Y. |
| 343 | |||
| 344 | config HW_RANDOM_MSM | ||
| 345 | tristate "Qualcomm MSM Random Number Generator support" | ||
| 346 | depends on HW_RANDOM && ARCH_MSM | ||
| 347 | ---help--- | ||
| 348 | This driver provides kernel-side support for the Random Number | ||
| 349 | Generator hardware found on Qualcomm MSM SoCs. | ||
| 350 | |||
| 351 | To compile this driver as a module, choose M here. the | ||
| 352 | module will be called msm-rng. | ||
| 353 | |||
| 354 | If unsure, say Y. | ||
diff --git a/drivers/char/hw_random/Makefile b/drivers/char/hw_random/Makefile index d7d2435ff7fa..3ae7755a52e7 100644 --- a/drivers/char/hw_random/Makefile +++ b/drivers/char/hw_random/Makefile | |||
| @@ -15,6 +15,7 @@ n2-rng-y := n2-drv.o n2-asm.o | |||
| 15 | obj-$(CONFIG_HW_RANDOM_VIA) += via-rng.o | 15 | obj-$(CONFIG_HW_RANDOM_VIA) += via-rng.o |
| 16 | obj-$(CONFIG_HW_RANDOM_IXP4XX) += ixp4xx-rng.o | 16 | obj-$(CONFIG_HW_RANDOM_IXP4XX) += ixp4xx-rng.o |
| 17 | obj-$(CONFIG_HW_RANDOM_OMAP) += omap-rng.o | 17 | obj-$(CONFIG_HW_RANDOM_OMAP) += omap-rng.o |
| 18 | obj-$(CONFIG_HW_RANDOM_OMAP3_ROM) += omap3-rom-rng.o | ||
| 18 | obj-$(CONFIG_HW_RANDOM_PASEMI) += pasemi-rng.o | 19 | obj-$(CONFIG_HW_RANDOM_PASEMI) += pasemi-rng.o |
| 19 | obj-$(CONFIG_HW_RANDOM_VIRTIO) += virtio-rng.o | 20 | obj-$(CONFIG_HW_RANDOM_VIRTIO) += virtio-rng.o |
| 20 | obj-$(CONFIG_HW_RANDOM_TX4939) += tx4939-rng.o | 21 | obj-$(CONFIG_HW_RANDOM_TX4939) += tx4939-rng.o |
| @@ -28,3 +29,4 @@ obj-$(CONFIG_HW_RANDOM_POWERNV) += powernv-rng.o | |||
| 28 | obj-$(CONFIG_HW_RANDOM_EXYNOS) += exynos-rng.o | 29 | obj-$(CONFIG_HW_RANDOM_EXYNOS) += exynos-rng.o |
| 29 | obj-$(CONFIG_HW_RANDOM_TPM) += tpm-rng.o | 30 | obj-$(CONFIG_HW_RANDOM_TPM) += tpm-rng.o |
| 30 | obj-$(CONFIG_HW_RANDOM_BCM2835) += bcm2835-rng.o | 31 | obj-$(CONFIG_HW_RANDOM_BCM2835) += bcm2835-rng.o |
| 32 | obj-$(CONFIG_HW_RANDOM_MSM) += msm-rng.o | ||
diff --git a/drivers/char/hw_random/msm-rng.c b/drivers/char/hw_random/msm-rng.c new file mode 100644 index 000000000000..148521e51dc6 --- /dev/null +++ b/drivers/char/hw_random/msm-rng.c | |||
| @@ -0,0 +1,197 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2011-2013, The Linux Foundation. All rights reserved. | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or modify | ||
| 5 | * it under the terms of the GNU General Public License version 2 and | ||
| 6 | * only version 2 as published by the Free Software Foundation. | ||
| 7 | * | ||
| 8 | * This program is distributed in the hope that it will be useful, | ||
| 9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 11 | * GNU General Public License for more details. | ||
| 12 | * | ||
| 13 | */ | ||
| 14 | #include <linux/clk.h> | ||
| 15 | #include <linux/err.h> | ||
| 16 | #include <linux/hw_random.h> | ||
| 17 | #include <linux/io.h> | ||
| 18 | #include <linux/module.h> | ||
| 19 | #include <linux/of.h> | ||
| 20 | #include <linux/platform_device.h> | ||
| 21 | |||
| 22 | /* Device specific register offsets */ | ||
| 23 | #define PRNG_DATA_OUT 0x0000 | ||
| 24 | #define PRNG_STATUS 0x0004 | ||
| 25 | #define PRNG_LFSR_CFG 0x0100 | ||
| 26 | #define PRNG_CONFIG 0x0104 | ||
| 27 | |||
| 28 | /* Device specific register masks and config values */ | ||
| 29 | #define PRNG_LFSR_CFG_MASK 0x0000ffff | ||
| 30 | #define PRNG_LFSR_CFG_CLOCKS 0x0000dddd | ||
| 31 | #define PRNG_CONFIG_HW_ENABLE BIT(1) | ||
| 32 | #define PRNG_STATUS_DATA_AVAIL BIT(0) | ||
| 33 | |||
| 34 | #define MAX_HW_FIFO_DEPTH 16 | ||
| 35 | #define MAX_HW_FIFO_SIZE (MAX_HW_FIFO_DEPTH * 4) | ||
| 36 | #define WORD_SZ 4 | ||
| 37 | |||
| 38 | struct msm_rng { | ||
| 39 | void __iomem *base; | ||
| 40 | struct clk *clk; | ||
| 41 | struct hwrng hwrng; | ||
| 42 | }; | ||
| 43 | |||
| 44 | #define to_msm_rng(p) container_of(p, struct msm_rng, hwrng) | ||
| 45 | |||
| 46 | static int msm_rng_enable(struct hwrng *hwrng, int enable) | ||
| 47 | { | ||
| 48 | struct msm_rng *rng = to_msm_rng(hwrng); | ||
| 49 | u32 val; | ||
| 50 | int ret; | ||
| 51 | |||
| 52 | ret = clk_prepare_enable(rng->clk); | ||
| 53 | if (ret) | ||
| 54 | return ret; | ||
| 55 | |||
| 56 | if (enable) { | ||
| 57 | /* Enable PRNG only if it is not already enabled */ | ||
| 58 | val = readl_relaxed(rng->base + PRNG_CONFIG); | ||
| 59 | if (val & PRNG_CONFIG_HW_ENABLE) | ||
| 60 | goto already_enabled; | ||
| 61 | |||
| 62 | val = readl_relaxed(rng->base + PRNG_LFSR_CFG); | ||
| 63 | val &= ~PRNG_LFSR_CFG_MASK; | ||
| 64 | val |= PRNG_LFSR_CFG_CLOCKS; | ||
| 65 | writel(val, rng->base + PRNG_LFSR_CFG); | ||
| 66 | |||
| 67 | val = readl_relaxed(rng->base + PRNG_CONFIG); | ||
| 68 | val |= PRNG_CONFIG_HW_ENABLE; | ||
| 69 | writel(val, rng->base + PRNG_CONFIG); | ||
| 70 | } else { | ||
| 71 | val = readl_relaxed(rng->base + PRNG_CONFIG); | ||
| 72 | val &= ~PRNG_CONFIG_HW_ENABLE; | ||
| 73 | writel(val, rng->base + PRNG_CONFIG); | ||
| 74 | } | ||
| 75 | |||
| 76 | already_enabled: | ||
| 77 | clk_disable_unprepare(rng->clk); | ||
| 78 | return 0; | ||
| 79 | } | ||
| 80 | |||
| 81 | static int msm_rng_read(struct hwrng *hwrng, void *data, size_t max, bool wait) | ||
| 82 | { | ||
| 83 | struct msm_rng *rng = to_msm_rng(hwrng); | ||
| 84 | size_t currsize = 0; | ||
| 85 | u32 *retdata = data; | ||
| 86 | size_t maxsize; | ||
| 87 | int ret; | ||
| 88 | u32 val; | ||
| 89 | |||
| 90 | /* calculate max size bytes to transfer back to caller */ | ||
| 91 | maxsize = min_t(size_t, MAX_HW_FIFO_SIZE, max); | ||
| 92 | |||
| 93 | /* no room for word data */ | ||
| 94 | if (maxsize < WORD_SZ) | ||
| 95 | return 0; | ||
| 96 | |||
| 97 | ret = clk_prepare_enable(rng->clk); | ||
| 98 | if (ret) | ||
| 99 | return ret; | ||
| 100 | |||
| 101 | /* read random data from hardware */ | ||
| 102 | do { | ||
| 103 | val = readl_relaxed(rng->base + PRNG_STATUS); | ||
| 104 | if (!(val & PRNG_STATUS_DATA_AVAIL)) | ||
| 105 | break; | ||
| 106 | |||
| 107 | val = readl_relaxed(rng->base + PRNG_DATA_OUT); | ||
| 108 | if (!val) | ||
| 109 | break; | ||
| 110 | |||
| 111 | *retdata++ = val; | ||
| 112 | currsize += WORD_SZ; | ||
| 113 | |||
| 114 | /* make sure we stay on 32bit boundary */ | ||
| 115 | if ((maxsize - currsize) < WORD_SZ) | ||
| 116 | break; | ||
| 117 | } while (currsize < maxsize); | ||
| 118 | |||
| 119 | clk_disable_unprepare(rng->clk); | ||
| 120 | |||
| 121 | return currsize; | ||
| 122 | } | ||
| 123 | |||
| 124 | static int msm_rng_init(struct hwrng *hwrng) | ||
| 125 | { | ||
| 126 | return msm_rng_enable(hwrng, 1); | ||
| 127 | } | ||
| 128 | |||
| 129 | static void msm_rng_cleanup(struct hwrng *hwrng) | ||
| 130 | { | ||
| 131 | msm_rng_enable(hwrng, 0); | ||
| 132 | } | ||
| 133 | |||
| 134 | static int msm_rng_probe(struct platform_device *pdev) | ||
| 135 | { | ||
| 136 | struct resource *res; | ||
| 137 | struct msm_rng *rng; | ||
| 138 | int ret; | ||
| 139 | |||
| 140 | rng = devm_kzalloc(&pdev->dev, sizeof(*rng), GFP_KERNEL); | ||
| 141 | if (!rng) | ||
| 142 | return -ENOMEM; | ||
| 143 | |||
| 144 | platform_set_drvdata(pdev, rng); | ||
| 145 | |||
| 146 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
| 147 | rng->base = devm_ioremap_resource(&pdev->dev, res); | ||
| 148 | if (IS_ERR(rng->base)) | ||
| 149 | return PTR_ERR(rng->base); | ||
| 150 | |||
| 151 | rng->clk = devm_clk_get(&pdev->dev, "core"); | ||
| 152 | if (IS_ERR(rng->clk)) | ||
| 153 | return PTR_ERR(rng->clk); | ||
| 154 | |||
| 155 | rng->hwrng.name = KBUILD_MODNAME, | ||
| 156 | rng->hwrng.init = msm_rng_init, | ||
| 157 | rng->hwrng.cleanup = msm_rng_cleanup, | ||
| 158 | rng->hwrng.read = msm_rng_read, | ||
| 159 | |||
| 160 | ret = hwrng_register(&rng->hwrng); | ||
| 161 | if (ret) { | ||
| 162 | dev_err(&pdev->dev, "failed to register hwrng\n"); | ||
| 163 | return ret; | ||
| 164 | } | ||
| 165 | |||
| 166 | return 0; | ||
| 167 | } | ||
| 168 | |||
| 169 | static int msm_rng_remove(struct platform_device *pdev) | ||
| 170 | { | ||
| 171 | struct msm_rng *rng = platform_get_drvdata(pdev); | ||
| 172 | |||
| 173 | hwrng_unregister(&rng->hwrng); | ||
| 174 | return 0; | ||
| 175 | } | ||
| 176 | |||
| 177 | static const struct of_device_id msm_rng_of_match[] = { | ||
| 178 | { .compatible = "qcom,prng", }, | ||
| 179 | {} | ||
| 180 | }; | ||
| 181 | MODULE_DEVICE_TABLE(of, msm_rng_of_match); | ||
| 182 | |||
| 183 | static struct platform_driver msm_rng_driver = { | ||
| 184 | .probe = msm_rng_probe, | ||
| 185 | .remove = msm_rng_remove, | ||
| 186 | .driver = { | ||
| 187 | .name = KBUILD_MODNAME, | ||
| 188 | .owner = THIS_MODULE, | ||
| 189 | .of_match_table = of_match_ptr(msm_rng_of_match), | ||
| 190 | } | ||
| 191 | }; | ||
| 192 | module_platform_driver(msm_rng_driver); | ||
| 193 | |||
| 194 | MODULE_ALIAS("platform:" KBUILD_MODNAME); | ||
| 195 | MODULE_AUTHOR("The Linux Foundation"); | ||
| 196 | MODULE_DESCRIPTION("Qualcomm MSM random number generator driver"); | ||
| 197 | MODULE_LICENSE("GPL v2"); | ||
diff --git a/drivers/char/hw_random/omap3-rom-rng.c b/drivers/char/hw_random/omap3-rom-rng.c new file mode 100644 index 000000000000..c853e9e68573 --- /dev/null +++ b/drivers/char/hw_random/omap3-rom-rng.c | |||
| @@ -0,0 +1,141 @@ | |||
| 1 | /* | ||
| 2 | * omap3-rom-rng.c - RNG driver for TI OMAP3 CPU family | ||
| 3 | * | ||
| 4 | * Copyright (C) 2009 Nokia Corporation | ||
| 5 | * Author: Juha Yrjola <juha.yrjola@solidboot.com> | ||
| 6 | * | ||
| 7 | * Copyright (C) 2013 Pali Rohár <pali.rohar@gmail.com> | ||
| 8 | * | ||
| 9 | * This file is licensed under the terms of the GNU General Public | ||
| 10 | * License version 2. This program is licensed "as is" without any | ||
| 11 | * warranty of any kind, whether express or implied. | ||
| 12 | */ | ||
| 13 | |||
| 14 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
| 15 | |||
| 16 | #include <linux/module.h> | ||
| 17 | #include <linux/init.h> | ||
| 18 | #include <linux/random.h> | ||
| 19 | #include <linux/hw_random.h> | ||
| 20 | #include <linux/timer.h> | ||
| 21 | #include <linux/clk.h> | ||
| 22 | #include <linux/err.h> | ||
| 23 | #include <linux/platform_device.h> | ||
| 24 | |||
| 25 | #define RNG_RESET 0x01 | ||
| 26 | #define RNG_GEN_PRNG_HW_INIT 0x02 | ||
| 27 | #define RNG_GEN_HW 0x08 | ||
| 28 | |||
| 29 | /* param1: ptr, param2: count, param3: flag */ | ||
| 30 | static u32 (*omap3_rom_rng_call)(u32, u32, u32); | ||
| 31 | |||
| 32 | static struct timer_list idle_timer; | ||
| 33 | static int rng_idle; | ||
| 34 | static struct clk *rng_clk; | ||
| 35 | |||
| 36 | static void omap3_rom_rng_idle(unsigned long data) | ||
| 37 | { | ||
| 38 | int r; | ||
| 39 | |||
| 40 | r = omap3_rom_rng_call(0, 0, RNG_RESET); | ||
| 41 | if (r != 0) { | ||
| 42 | pr_err("reset failed: %d\n", r); | ||
| 43 | return; | ||
| 44 | } | ||
| 45 | clk_disable_unprepare(rng_clk); | ||
| 46 | rng_idle = 1; | ||
| 47 | } | ||
| 48 | |||
| 49 | static int omap3_rom_rng_get_random(void *buf, unsigned int count) | ||
| 50 | { | ||
| 51 | u32 r; | ||
| 52 | u32 ptr; | ||
| 53 | |||
| 54 | del_timer_sync(&idle_timer); | ||
| 55 | if (rng_idle) { | ||
| 56 | clk_prepare_enable(rng_clk); | ||
| 57 | r = omap3_rom_rng_call(0, 0, RNG_GEN_PRNG_HW_INIT); | ||
| 58 | if (r != 0) { | ||
| 59 | clk_disable_unprepare(rng_clk); | ||
| 60 | pr_err("HW init failed: %d\n", r); | ||
| 61 | return -EIO; | ||
| 62 | } | ||
| 63 | rng_idle = 0; | ||
| 64 | } | ||
| 65 | |||
| 66 | ptr = virt_to_phys(buf); | ||
| 67 | r = omap3_rom_rng_call(ptr, count, RNG_GEN_HW); | ||
| 68 | mod_timer(&idle_timer, jiffies + msecs_to_jiffies(500)); | ||
| 69 | if (r != 0) | ||
| 70 | return -EINVAL; | ||
| 71 | return 0; | ||
| 72 | } | ||
| 73 | |||
| 74 | static int omap3_rom_rng_data_present(struct hwrng *rng, int wait) | ||
| 75 | { | ||
| 76 | return 1; | ||
| 77 | } | ||
| 78 | |||
| 79 | static int omap3_rom_rng_data_read(struct hwrng *rng, u32 *data) | ||
| 80 | { | ||
| 81 | int r; | ||
| 82 | |||
| 83 | r = omap3_rom_rng_get_random(data, 4); | ||
| 84 | if (r < 0) | ||
| 85 | return r; | ||
| 86 | return 4; | ||
| 87 | } | ||
| 88 | |||
| 89 | static struct hwrng omap3_rom_rng_ops = { | ||
| 90 | .name = "omap3-rom", | ||
| 91 | .data_present = omap3_rom_rng_data_present, | ||
| 92 | .data_read = omap3_rom_rng_data_read, | ||
| 93 | }; | ||
| 94 | |||
| 95 | static int omap3_rom_rng_probe(struct platform_device *pdev) | ||
| 96 | { | ||
| 97 | pr_info("initializing\n"); | ||
| 98 | |||
| 99 | omap3_rom_rng_call = pdev->dev.platform_data; | ||
| 100 | if (!omap3_rom_rng_call) { | ||
| 101 | pr_err("omap3_rom_rng_call is NULL\n"); | ||
| 102 | return -EINVAL; | ||
| 103 | } | ||
| 104 | |||
| 105 | setup_timer(&idle_timer, omap3_rom_rng_idle, 0); | ||
| 106 | rng_clk = clk_get(&pdev->dev, "ick"); | ||
| 107 | if (IS_ERR(rng_clk)) { | ||
| 108 | pr_err("unable to get RNG clock\n"); | ||
| 109 | return PTR_ERR(rng_clk); | ||
| 110 | } | ||
| 111 | |||
| 112 | /* Leave the RNG in reset state. */ | ||
| 113 | clk_prepare_enable(rng_clk); | ||
| 114 | omap3_rom_rng_idle(0); | ||
| 115 | |||
| 116 | return hwrng_register(&omap3_rom_rng_ops); | ||
| 117 | } | ||
| 118 | |||
| 119 | static int omap3_rom_rng_remove(struct platform_device *pdev) | ||
| 120 | { | ||
| 121 | hwrng_unregister(&omap3_rom_rng_ops); | ||
| 122 | clk_disable_unprepare(rng_clk); | ||
| 123 | clk_put(rng_clk); | ||
| 124 | return 0; | ||
| 125 | } | ||
| 126 | |||
| 127 | static struct platform_driver omap3_rom_rng_driver = { | ||
| 128 | .driver = { | ||
| 129 | .name = "omap3-rom-rng", | ||
| 130 | .owner = THIS_MODULE, | ||
| 131 | }, | ||
| 132 | .probe = omap3_rom_rng_probe, | ||
| 133 | .remove = omap3_rom_rng_remove, | ||
| 134 | }; | ||
| 135 | |||
| 136 | module_platform_driver(omap3_rom_rng_driver); | ||
| 137 | |||
| 138 | MODULE_ALIAS("platform:omap3-rom-rng"); | ||
| 139 | MODULE_AUTHOR("Juha Yrjola"); | ||
| 140 | MODULE_AUTHOR("Pali Rohár <pali.rohar@gmail.com>"); | ||
| 141 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/char/hw_random/pseries-rng.c b/drivers/char/hw_random/pseries-rng.c index b761459a3436..ab7ffdec0ec3 100644 --- a/drivers/char/hw_random/pseries-rng.c +++ b/drivers/char/hw_random/pseries-rng.c | |||
| @@ -24,7 +24,6 @@ | |||
| 24 | #include <linux/hw_random.h> | 24 | #include <linux/hw_random.h> |
| 25 | #include <asm/vio.h> | 25 | #include <asm/vio.h> |
| 26 | 26 | ||
| 27 | #define MODULE_NAME "pseries-rng" | ||
| 28 | 27 | ||
| 29 | static int pseries_rng_data_read(struct hwrng *rng, u32 *data) | 28 | static int pseries_rng_data_read(struct hwrng *rng, u32 *data) |
| 30 | { | 29 | { |
| @@ -55,7 +54,7 @@ static unsigned long pseries_rng_get_desired_dma(struct vio_dev *vdev) | |||
| 55 | }; | 54 | }; |
| 56 | 55 | ||
| 57 | static struct hwrng pseries_rng = { | 56 | static struct hwrng pseries_rng = { |
| 58 | .name = MODULE_NAME, | 57 | .name = KBUILD_MODNAME, |
| 59 | .data_read = pseries_rng_data_read, | 58 | .data_read = pseries_rng_data_read, |
| 60 | }; | 59 | }; |
| 61 | 60 | ||
| @@ -78,7 +77,7 @@ static struct vio_device_id pseries_rng_driver_ids[] = { | |||
| 78 | MODULE_DEVICE_TABLE(vio, pseries_rng_driver_ids); | 77 | MODULE_DEVICE_TABLE(vio, pseries_rng_driver_ids); |
| 79 | 78 | ||
| 80 | static struct vio_driver pseries_rng_driver = { | 79 | static struct vio_driver pseries_rng_driver = { |
| 81 | .name = MODULE_NAME, | 80 | .name = KBUILD_MODNAME, |
| 82 | .probe = pseries_rng_probe, | 81 | .probe = pseries_rng_probe, |
| 83 | .remove = pseries_rng_remove, | 82 | .remove = pseries_rng_remove, |
| 84 | .get_desired_dma = pseries_rng_get_desired_dma, | 83 | .get_desired_dma = pseries_rng_get_desired_dma, |
diff --git a/drivers/char/hw_random/via-rng.c b/drivers/char/hw_random/via-rng.c index e737772ad69a..de5a6dcfb3e2 100644 --- a/drivers/char/hw_random/via-rng.c +++ b/drivers/char/hw_random/via-rng.c | |||
| @@ -221,7 +221,7 @@ static void __exit mod_exit(void) | |||
| 221 | module_init(mod_init); | 221 | module_init(mod_init); |
| 222 | module_exit(mod_exit); | 222 | module_exit(mod_exit); |
| 223 | 223 | ||
| 224 | static struct x86_cpu_id via_rng_cpu_id[] = { | 224 | static struct x86_cpu_id __maybe_unused via_rng_cpu_id[] = { |
| 225 | X86_FEATURE_MATCH(X86_FEATURE_XSTORE), | 225 | X86_FEATURE_MATCH(X86_FEATURE_XSTORE), |
| 226 | {} | 226 | {} |
| 227 | }; | 227 | }; |
diff --git a/drivers/char/i8k.c b/drivers/char/i8k.c index 40cc0cf2ded6..e6939e13e338 100644 --- a/drivers/char/i8k.c +++ b/drivers/char/i8k.c | |||
| @@ -664,6 +664,13 @@ static struct dmi_system_id __initdata i8k_dmi_table[] = { | |||
| 664 | DMI_MATCH(DMI_PRODUCT_NAME, "Vostro"), | 664 | DMI_MATCH(DMI_PRODUCT_NAME, "Vostro"), |
| 665 | }, | 665 | }, |
| 666 | }, | 666 | }, |
| 667 | { | ||
| 668 | .ident = "Dell XPS421", | ||
| 669 | .matches = { | ||
| 670 | DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."), | ||
| 671 | DMI_MATCH(DMI_PRODUCT_NAME, "XPS L421X"), | ||
| 672 | }, | ||
| 673 | }, | ||
| 667 | { } | 674 | { } |
| 668 | }; | 675 | }; |
| 669 | 676 | ||
diff --git a/drivers/clocksource/Kconfig b/drivers/clocksource/Kconfig index bdb953e15d2a..5c07a56962db 100644 --- a/drivers/clocksource/Kconfig +++ b/drivers/clocksource/Kconfig | |||
| @@ -87,6 +87,7 @@ config ARM_ARCH_TIMER | |||
| 87 | config ARM_ARCH_TIMER_EVTSTREAM | 87 | config ARM_ARCH_TIMER_EVTSTREAM |
| 88 | bool "Support for ARM architected timer event stream generation" | 88 | bool "Support for ARM architected timer event stream generation" |
| 89 | default y if ARM_ARCH_TIMER | 89 | default y if ARM_ARCH_TIMER |
| 90 | depends on ARM_ARCH_TIMER | ||
| 90 | help | 91 | help |
| 91 | This option enables support for event stream generation based on | 92 | This option enables support for event stream generation based on |
| 92 | the ARM architected timer. It is used for waking up CPUs executing | 93 | the ARM architected timer. It is used for waking up CPUs executing |
diff --git a/drivers/clocksource/sh_mtu2.c b/drivers/clocksource/sh_mtu2.c index 4aac9ee0d0c0..3cf12834681e 100644 --- a/drivers/clocksource/sh_mtu2.c +++ b/drivers/clocksource/sh_mtu2.c | |||
| @@ -313,8 +313,20 @@ static int sh_mtu2_setup(struct sh_mtu2_priv *p, struct platform_device *pdev) | |||
| 313 | goto err1; | 313 | goto err1; |
| 314 | } | 314 | } |
| 315 | 315 | ||
| 316 | return sh_mtu2_register(p, (char *)dev_name(&p->pdev->dev), | 316 | ret = clk_prepare(p->clk); |
| 317 | cfg->clockevent_rating); | 317 | if (ret < 0) |
| 318 | goto err2; | ||
| 319 | |||
| 320 | ret = sh_mtu2_register(p, (char *)dev_name(&p->pdev->dev), | ||
| 321 | cfg->clockevent_rating); | ||
| 322 | if (ret < 0) | ||
| 323 | goto err3; | ||
| 324 | |||
| 325 | return 0; | ||
| 326 | err3: | ||
| 327 | clk_unprepare(p->clk); | ||
| 328 | err2: | ||
| 329 | clk_put(p->clk); | ||
| 318 | err1: | 330 | err1: |
| 319 | iounmap(p->mapbase); | 331 | iounmap(p->mapbase); |
| 320 | err0: | 332 | err0: |
diff --git a/drivers/clocksource/sh_tmu.c b/drivers/clocksource/sh_tmu.c index 78b8dae49628..63557cda0a7d 100644 --- a/drivers/clocksource/sh_tmu.c +++ b/drivers/clocksource/sh_tmu.c | |||
| @@ -472,12 +472,26 @@ static int sh_tmu_setup(struct sh_tmu_priv *p, struct platform_device *pdev) | |||
| 472 | ret = PTR_ERR(p->clk); | 472 | ret = PTR_ERR(p->clk); |
| 473 | goto err1; | 473 | goto err1; |
| 474 | } | 474 | } |
| 475 | |||
| 476 | ret = clk_prepare(p->clk); | ||
| 477 | if (ret < 0) | ||
| 478 | goto err2; | ||
| 479 | |||
| 475 | p->cs_enabled = false; | 480 | p->cs_enabled = false; |
| 476 | p->enable_count = 0; | 481 | p->enable_count = 0; |
| 477 | 482 | ||
| 478 | return sh_tmu_register(p, (char *)dev_name(&p->pdev->dev), | 483 | ret = sh_tmu_register(p, (char *)dev_name(&p->pdev->dev), |
| 479 | cfg->clockevent_rating, | 484 | cfg->clockevent_rating, |
| 480 | cfg->clocksource_rating); | 485 | cfg->clocksource_rating); |
| 486 | if (ret < 0) | ||
| 487 | goto err3; | ||
| 488 | |||
| 489 | return 0; | ||
| 490 | |||
| 491 | err3: | ||
| 492 | clk_unprepare(p->clk); | ||
| 493 | err2: | ||
| 494 | clk_put(p->clk); | ||
| 481 | err1: | 495 | err1: |
| 482 | iounmap(p->mapbase); | 496 | iounmap(p->mapbase); |
| 483 | err0: | 497 | err0: |
diff --git a/drivers/cpufreq/at32ap-cpufreq.c b/drivers/cpufreq/at32ap-cpufreq.c index 856ad80418ae..7c03dd84f66a 100644 --- a/drivers/cpufreq/at32ap-cpufreq.c +++ b/drivers/cpufreq/at32ap-cpufreq.c | |||
| @@ -58,7 +58,7 @@ static int at32_set_target(struct cpufreq_policy *policy, unsigned int index) | |||
| 58 | return 0; | 58 | return 0; |
| 59 | } | 59 | } |
| 60 | 60 | ||
| 61 | static int __init at32_cpufreq_driver_init(struct cpufreq_policy *policy) | 61 | static int at32_cpufreq_driver_init(struct cpufreq_policy *policy) |
| 62 | { | 62 | { |
| 63 | unsigned int frequency, rate, min_freq; | 63 | unsigned int frequency, rate, min_freq; |
| 64 | int retval, steps, i; | 64 | int retval, steps, i; |
diff --git a/drivers/cpufreq/exynos4210-cpufreq.c b/drivers/cpufreq/exynos4210-cpufreq.c index f2c75065ce19..dfd1643b0b2f 100644 --- a/drivers/cpufreq/exynos4210-cpufreq.c +++ b/drivers/cpufreq/exynos4210-cpufreq.c | |||
| @@ -157,4 +157,3 @@ err_moutcore: | |||
| 157 | pr_debug("%s: failed initialization\n", __func__); | 157 | pr_debug("%s: failed initialization\n", __func__); |
| 158 | return -EINVAL; | 158 | return -EINVAL; |
| 159 | } | 159 | } |
| 160 | EXPORT_SYMBOL(exynos4210_cpufreq_init); | ||
diff --git a/drivers/cpufreq/exynos4x12-cpufreq.c b/drivers/cpufreq/exynos4x12-cpufreq.c index 8683304ce62c..efad5e657f6f 100644 --- a/drivers/cpufreq/exynos4x12-cpufreq.c +++ b/drivers/cpufreq/exynos4x12-cpufreq.c | |||
| @@ -211,4 +211,3 @@ err_moutcore: | |||
| 211 | pr_debug("%s: failed initialization\n", __func__); | 211 | pr_debug("%s: failed initialization\n", __func__); |
| 212 | return -EINVAL; | 212 | return -EINVAL; |
| 213 | } | 213 | } |
| 214 | EXPORT_SYMBOL(exynos4x12_cpufreq_init); | ||
diff --git a/drivers/cpufreq/exynos5250-cpufreq.c b/drivers/cpufreq/exynos5250-cpufreq.c index 9fae466d7746..8feda86fe42c 100644 --- a/drivers/cpufreq/exynos5250-cpufreq.c +++ b/drivers/cpufreq/exynos5250-cpufreq.c | |||
| @@ -236,4 +236,3 @@ err_moutcore: | |||
| 236 | pr_err("%s: failed initialization\n", __func__); | 236 | pr_err("%s: failed initialization\n", __func__); |
| 237 | return -EINVAL; | 237 | return -EINVAL; |
| 238 | } | 238 | } |
| 239 | EXPORT_SYMBOL(exynos5250_cpufreq_init); | ||
diff --git a/drivers/cpufreq/tegra-cpufreq.c b/drivers/cpufreq/tegra-cpufreq.c index f42df7ec03c5..b7309c37033d 100644 --- a/drivers/cpufreq/tegra-cpufreq.c +++ b/drivers/cpufreq/tegra-cpufreq.c | |||
| @@ -142,10 +142,8 @@ static int tegra_target(struct cpufreq_policy *policy, unsigned int index) | |||
| 142 | 142 | ||
| 143 | mutex_lock(&tegra_cpu_lock); | 143 | mutex_lock(&tegra_cpu_lock); |
| 144 | 144 | ||
| 145 | if (is_suspended) { | 145 | if (is_suspended) |
| 146 | ret = -EBUSY; | ||
| 147 | goto out; | 146 | goto out; |
| 148 | } | ||
| 149 | 147 | ||
| 150 | freq = freq_table[index].frequency; | 148 | freq = freq_table[index].frequency; |
| 151 | 149 | ||
diff --git a/drivers/cpuidle/cpuidle.c b/drivers/cpuidle/cpuidle.c index 2a991e468f78..a55e68f2cfc8 100644 --- a/drivers/cpuidle/cpuidle.c +++ b/drivers/cpuidle/cpuidle.c | |||
| @@ -400,7 +400,7 @@ EXPORT_SYMBOL_GPL(cpuidle_register_device); | |||
| 400 | */ | 400 | */ |
| 401 | void cpuidle_unregister_device(struct cpuidle_device *dev) | 401 | void cpuidle_unregister_device(struct cpuidle_device *dev) |
| 402 | { | 402 | { |
| 403 | if (dev->registered == 0) | 403 | if (!dev || dev->registered == 0) |
| 404 | return; | 404 | return; |
| 405 | 405 | ||
| 406 | cpuidle_pause_and_lock(); | 406 | cpuidle_pause_and_lock(); |
diff --git a/drivers/crypto/caam/Kconfig b/drivers/crypto/caam/Kconfig index ca89f6b84b06..e7555ff4cafd 100644 --- a/drivers/crypto/caam/Kconfig +++ b/drivers/crypto/caam/Kconfig | |||
| @@ -4,16 +4,29 @@ config CRYPTO_DEV_FSL_CAAM | |||
| 4 | help | 4 | help |
| 5 | Enables the driver module for Freescale's Cryptographic Accelerator | 5 | Enables the driver module for Freescale's Cryptographic Accelerator |
| 6 | and Assurance Module (CAAM), also known as the SEC version 4 (SEC4). | 6 | and Assurance Module (CAAM), also known as the SEC version 4 (SEC4). |
| 7 | This module adds a job ring operation interface, and configures h/w | 7 | This module creates job ring devices, and configures h/w |
| 8 | to operate as a DPAA component automatically, depending | 8 | to operate as a DPAA component automatically, depending |
| 9 | on h/w feature availability. | 9 | on h/w feature availability. |
| 10 | 10 | ||
| 11 | To compile this driver as a module, choose M here: the module | 11 | To compile this driver as a module, choose M here: the module |
| 12 | will be called caam. | 12 | will be called caam. |
| 13 | 13 | ||
| 14 | config CRYPTO_DEV_FSL_CAAM_JR | ||
| 15 | tristate "Freescale CAAM Job Ring driver backend" | ||
| 16 | depends on CRYPTO_DEV_FSL_CAAM | ||
| 17 | default y | ||
| 18 | help | ||
| 19 | Enables the driver module for Job Rings which are part of | ||
| 20 | Freescale's Cryptographic Accelerator | ||
| 21 | and Assurance Module (CAAM). This module adds a job ring operation | ||
| 22 | interface. | ||
| 23 | |||
| 24 | To compile this driver as a module, choose M here: the module | ||
| 25 | will be called caam_jr. | ||
| 26 | |||
| 14 | config CRYPTO_DEV_FSL_CAAM_RINGSIZE | 27 | config CRYPTO_DEV_FSL_CAAM_RINGSIZE |
| 15 | int "Job Ring size" | 28 | int "Job Ring size" |
| 16 | depends on CRYPTO_DEV_FSL_CAAM | 29 | depends on CRYPTO_DEV_FSL_CAAM_JR |
| 17 | range 2 9 | 30 | range 2 9 |
| 18 | default "9" | 31 | default "9" |
| 19 | help | 32 | help |
| @@ -31,7 +44,7 @@ config CRYPTO_DEV_FSL_CAAM_RINGSIZE | |||
| 31 | 44 | ||
| 32 | config CRYPTO_DEV_FSL_CAAM_INTC | 45 | config CRYPTO_DEV_FSL_CAAM_INTC |
| 33 | bool "Job Ring interrupt coalescing" | 46 | bool "Job Ring interrupt coalescing" |
| 34 | depends on CRYPTO_DEV_FSL_CAAM | 47 | depends on CRYPTO_DEV_FSL_CAAM_JR |
| 35 | default n | 48 | default n |
| 36 | help | 49 | help |
| 37 | Enable the Job Ring's interrupt coalescing feature. | 50 | Enable the Job Ring's interrupt coalescing feature. |
| @@ -62,7 +75,7 @@ config CRYPTO_DEV_FSL_CAAM_INTC_TIME_THLD | |||
| 62 | 75 | ||
| 63 | config CRYPTO_DEV_FSL_CAAM_CRYPTO_API | 76 | config CRYPTO_DEV_FSL_CAAM_CRYPTO_API |
| 64 | tristate "Register algorithm implementations with the Crypto API" | 77 | tristate "Register algorithm implementations with the Crypto API" |
| 65 | depends on CRYPTO_DEV_FSL_CAAM | 78 | depends on CRYPTO_DEV_FSL_CAAM && CRYPTO_DEV_FSL_CAAM_JR |
| 66 | default y | 79 | default y |
| 67 | select CRYPTO_ALGAPI | 80 | select CRYPTO_ALGAPI |
| 68 | select CRYPTO_AUTHENC | 81 | select CRYPTO_AUTHENC |
| @@ -76,7 +89,7 @@ config CRYPTO_DEV_FSL_CAAM_CRYPTO_API | |||
| 76 | 89 | ||
| 77 | config CRYPTO_DEV_FSL_CAAM_AHASH_API | 90 | config CRYPTO_DEV_FSL_CAAM_AHASH_API |
| 78 | tristate "Register hash algorithm implementations with Crypto API" | 91 | tristate "Register hash algorithm implementations with Crypto API" |
| 79 | depends on CRYPTO_DEV_FSL_CAAM | 92 | depends on CRYPTO_DEV_FSL_CAAM && CRYPTO_DEV_FSL_CAAM_JR |
| 80 | default y | 93 | default y |
| 81 | select CRYPTO_HASH | 94 | select CRYPTO_HASH |
| 82 | help | 95 | help |
| @@ -88,7 +101,7 @@ config CRYPTO_DEV_FSL_CAAM_AHASH_API | |||
| 88 | 101 | ||
| 89 | config CRYPTO_DEV_FSL_CAAM_RNG_API | 102 | config CRYPTO_DEV_FSL_CAAM_RNG_API |
| 90 | tristate "Register caam device for hwrng API" | 103 | tristate "Register caam device for hwrng API" |
| 91 | depends on CRYPTO_DEV_FSL_CAAM | 104 | depends on CRYPTO_DEV_FSL_CAAM && CRYPTO_DEV_FSL_CAAM_JR |
| 92 | default y | 105 | default y |
| 93 | select CRYPTO_RNG | 106 | select CRYPTO_RNG |
| 94 | select HW_RANDOM | 107 | select HW_RANDOM |
diff --git a/drivers/crypto/caam/Makefile b/drivers/crypto/caam/Makefile index d56bd0ec65d8..550758a333e7 100644 --- a/drivers/crypto/caam/Makefile +++ b/drivers/crypto/caam/Makefile | |||
| @@ -6,8 +6,10 @@ ifeq ($(CONFIG_CRYPTO_DEV_FSL_CAAM_DEBUG), y) | |||
| 6 | endif | 6 | endif |
| 7 | 7 | ||
| 8 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM) += caam.o | 8 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM) += caam.o |
| 9 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM_JR) += caam_jr.o | ||
| 9 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM_CRYPTO_API) += caamalg.o | 10 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM_CRYPTO_API) += caamalg.o |
| 10 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM_AHASH_API) += caamhash.o | 11 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM_AHASH_API) += caamhash.o |
| 11 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM_RNG_API) += caamrng.o | 12 | obj-$(CONFIG_CRYPTO_DEV_FSL_CAAM_RNG_API) += caamrng.o |
| 12 | 13 | ||
| 13 | caam-objs := ctrl.o jr.o error.o key_gen.o | 14 | caam-objs := ctrl.o |
| 15 | caam_jr-objs := jr.o key_gen.o error.o | ||
diff --git a/drivers/crypto/caam/caamalg.c b/drivers/crypto/caam/caamalg.c index 7c63b72ecd75..4cf5dec826e1 100644 --- a/drivers/crypto/caam/caamalg.c +++ b/drivers/crypto/caam/caamalg.c | |||
| @@ -86,6 +86,7 @@ | |||
| 86 | #else | 86 | #else |
| 87 | #define debug(format, arg...) | 87 | #define debug(format, arg...) |
| 88 | #endif | 88 | #endif |
| 89 | static struct list_head alg_list; | ||
| 89 | 90 | ||
| 90 | /* Set DK bit in class 1 operation if shared */ | 91 | /* Set DK bit in class 1 operation if shared */ |
| 91 | static inline void append_dec_op1(u32 *desc, u32 type) | 92 | static inline void append_dec_op1(u32 *desc, u32 type) |
| @@ -817,7 +818,7 @@ static void aead_decrypt_done(struct device *jrdev, u32 *desc, u32 err, | |||
| 817 | ivsize, 1); | 818 | ivsize, 1); |
| 818 | print_hex_dump(KERN_ERR, "dst @"__stringify(__LINE__)": ", | 819 | print_hex_dump(KERN_ERR, "dst @"__stringify(__LINE__)": ", |
| 819 | DUMP_PREFIX_ADDRESS, 16, 4, sg_virt(req->dst), | 820 | DUMP_PREFIX_ADDRESS, 16, 4, sg_virt(req->dst), |
| 820 | req->cryptlen, 1); | 821 | req->cryptlen - ctx->authsize, 1); |
| 821 | #endif | 822 | #endif |
| 822 | 823 | ||
| 823 | if (err) { | 824 | if (err) { |
| @@ -971,12 +972,9 @@ static void init_aead_job(u32 *sh_desc, dma_addr_t ptr, | |||
| 971 | (edesc->src_nents ? : 1); | 972 | (edesc->src_nents ? : 1); |
| 972 | in_options = LDST_SGF; | 973 | in_options = LDST_SGF; |
| 973 | } | 974 | } |
| 974 | if (encrypt) | 975 | |
| 975 | append_seq_in_ptr(desc, src_dma, req->assoclen + ivsize + | 976 | append_seq_in_ptr(desc, src_dma, req->assoclen + ivsize + req->cryptlen, |
| 976 | req->cryptlen - authsize, in_options); | 977 | in_options); |
| 977 | else | ||
| 978 | append_seq_in_ptr(desc, src_dma, req->assoclen + ivsize + | ||
| 979 | req->cryptlen, in_options); | ||
| 980 | 978 | ||
| 981 | if (likely(req->src == req->dst)) { | 979 | if (likely(req->src == req->dst)) { |
| 982 | if (all_contig) { | 980 | if (all_contig) { |
| @@ -997,7 +995,8 @@ static void init_aead_job(u32 *sh_desc, dma_addr_t ptr, | |||
| 997 | } | 995 | } |
| 998 | } | 996 | } |
| 999 | if (encrypt) | 997 | if (encrypt) |
| 1000 | append_seq_out_ptr(desc, dst_dma, req->cryptlen, out_options); | 998 | append_seq_out_ptr(desc, dst_dma, req->cryptlen + authsize, |
| 999 | out_options); | ||
| 1001 | else | 1000 | else |
| 1002 | append_seq_out_ptr(desc, dst_dma, req->cryptlen - authsize, | 1001 | append_seq_out_ptr(desc, dst_dma, req->cryptlen - authsize, |
| 1003 | out_options); | 1002 | out_options); |
| @@ -1047,8 +1046,8 @@ static void init_aead_giv_job(u32 *sh_desc, dma_addr_t ptr, | |||
| 1047 | sec4_sg_index += edesc->assoc_nents + 1 + edesc->src_nents; | 1046 | sec4_sg_index += edesc->assoc_nents + 1 + edesc->src_nents; |
| 1048 | in_options = LDST_SGF; | 1047 | in_options = LDST_SGF; |
| 1049 | } | 1048 | } |
| 1050 | append_seq_in_ptr(desc, src_dma, req->assoclen + ivsize + | 1049 | append_seq_in_ptr(desc, src_dma, req->assoclen + ivsize + req->cryptlen, |
| 1051 | req->cryptlen - authsize, in_options); | 1050 | in_options); |
| 1052 | 1051 | ||
| 1053 | if (contig & GIV_DST_CONTIG) { | 1052 | if (contig & GIV_DST_CONTIG) { |
| 1054 | dst_dma = edesc->iv_dma; | 1053 | dst_dma = edesc->iv_dma; |
| @@ -1065,7 +1064,8 @@ static void init_aead_giv_job(u32 *sh_desc, dma_addr_t ptr, | |||
| 1065 | } | 1064 | } |
| 1066 | } | 1065 | } |
| 1067 | 1066 | ||
| 1068 | append_seq_out_ptr(desc, dst_dma, ivsize + req->cryptlen, out_options); | 1067 | append_seq_out_ptr(desc, dst_dma, ivsize + req->cryptlen + authsize, |
| 1068 | out_options); | ||
| 1069 | } | 1069 | } |
| 1070 | 1070 | ||
| 1071 | /* | 1071 | /* |
| @@ -1129,7 +1129,8 @@ static void init_ablkcipher_job(u32 *sh_desc, dma_addr_t ptr, | |||
| 1129 | * allocate and map the aead extended descriptor | 1129 | * allocate and map the aead extended descriptor |
| 1130 | */ | 1130 | */ |
| 1131 | static struct aead_edesc *aead_edesc_alloc(struct aead_request *req, | 1131 | static struct aead_edesc *aead_edesc_alloc(struct aead_request *req, |
| 1132 | int desc_bytes, bool *all_contig_ptr) | 1132 | int desc_bytes, bool *all_contig_ptr, |
| 1133 | bool encrypt) | ||
| 1133 | { | 1134 | { |
| 1134 | struct crypto_aead *aead = crypto_aead_reqtfm(req); | 1135 | struct crypto_aead *aead = crypto_aead_reqtfm(req); |
| 1135 | struct caam_ctx *ctx = crypto_aead_ctx(aead); | 1136 | struct caam_ctx *ctx = crypto_aead_ctx(aead); |
| @@ -1144,12 +1145,22 @@ static struct aead_edesc *aead_edesc_alloc(struct aead_request *req, | |||
| 1144 | bool assoc_chained = false, src_chained = false, dst_chained = false; | 1145 | bool assoc_chained = false, src_chained = false, dst_chained = false; |
| 1145 | int ivsize = crypto_aead_ivsize(aead); | 1146 | int ivsize = crypto_aead_ivsize(aead); |
| 1146 | int sec4_sg_index, sec4_sg_len = 0, sec4_sg_bytes; | 1147 | int sec4_sg_index, sec4_sg_len = 0, sec4_sg_bytes; |
| 1148 | unsigned int authsize = ctx->authsize; | ||
| 1147 | 1149 | ||
| 1148 | assoc_nents = sg_count(req->assoc, req->assoclen, &assoc_chained); | 1150 | assoc_nents = sg_count(req->assoc, req->assoclen, &assoc_chained); |
| 1149 | src_nents = sg_count(req->src, req->cryptlen, &src_chained); | ||
| 1150 | 1151 | ||
| 1151 | if (unlikely(req->dst != req->src)) | 1152 | if (unlikely(req->dst != req->src)) { |
| 1152 | dst_nents = sg_count(req->dst, req->cryptlen, &dst_chained); | 1153 | src_nents = sg_count(req->src, req->cryptlen, &src_chained); |
| 1154 | dst_nents = sg_count(req->dst, | ||
| 1155 | req->cryptlen + | ||
| 1156 | (encrypt ? authsize : (-authsize)), | ||
| 1157 | &dst_chained); | ||
| 1158 | } else { | ||
| 1159 | src_nents = sg_count(req->src, | ||
| 1160 | req->cryptlen + | ||
| 1161 | (encrypt ? authsize : 0), | ||
| 1162 | &src_chained); | ||
| 1163 | } | ||
| 1153 | 1164 | ||
| 1154 | sgc = dma_map_sg_chained(jrdev, req->assoc, assoc_nents ? : 1, | 1165 | sgc = dma_map_sg_chained(jrdev, req->assoc, assoc_nents ? : 1, |
| 1155 | DMA_TO_DEVICE, assoc_chained); | 1166 | DMA_TO_DEVICE, assoc_chained); |
| @@ -1233,11 +1244,9 @@ static int aead_encrypt(struct aead_request *req) | |||
| 1233 | u32 *desc; | 1244 | u32 *desc; |
| 1234 | int ret = 0; | 1245 | int ret = 0; |
| 1235 | 1246 | ||
| 1236 | req->cryptlen += ctx->authsize; | ||
| 1237 | |||
| 1238 | /* allocate extended descriptor */ | 1247 | /* allocate extended descriptor */ |
| 1239 | edesc = aead_edesc_alloc(req, DESC_JOB_IO_LEN * | 1248 | edesc = aead_edesc_alloc(req, DESC_JOB_IO_LEN * |
| 1240 | CAAM_CMD_SZ, &all_contig); | 1249 | CAAM_CMD_SZ, &all_contig, true); |
| 1241 | if (IS_ERR(edesc)) | 1250 | if (IS_ERR(edesc)) |
| 1242 | return PTR_ERR(edesc); | 1251 | return PTR_ERR(edesc); |
| 1243 | 1252 | ||
| @@ -1274,7 +1283,7 @@ static int aead_decrypt(struct aead_request *req) | |||
| 1274 | 1283 | ||
| 1275 | /* allocate extended descriptor */ | 1284 | /* allocate extended descriptor */ |
| 1276 | edesc = aead_edesc_alloc(req, DESC_JOB_IO_LEN * | 1285 | edesc = aead_edesc_alloc(req, DESC_JOB_IO_LEN * |
| 1277 | CAAM_CMD_SZ, &all_contig); | 1286 | CAAM_CMD_SZ, &all_contig, false); |
| 1278 | if (IS_ERR(edesc)) | 1287 | if (IS_ERR(edesc)) |
| 1279 | return PTR_ERR(edesc); | 1288 | return PTR_ERR(edesc); |
| 1280 | 1289 | ||
| @@ -1331,7 +1340,8 @@ static struct aead_edesc *aead_giv_edesc_alloc(struct aead_givcrypt_request | |||
| 1331 | src_nents = sg_count(req->src, req->cryptlen, &src_chained); | 1340 | src_nents = sg_count(req->src, req->cryptlen, &src_chained); |
| 1332 | 1341 | ||
| 1333 | if (unlikely(req->dst != req->src)) | 1342 | if (unlikely(req->dst != req->src)) |
| 1334 | dst_nents = sg_count(req->dst, req->cryptlen, &dst_chained); | 1343 | dst_nents = sg_count(req->dst, req->cryptlen + ctx->authsize, |
| 1344 | &dst_chained); | ||
| 1335 | 1345 | ||
| 1336 | sgc = dma_map_sg_chained(jrdev, req->assoc, assoc_nents ? : 1, | 1346 | sgc = dma_map_sg_chained(jrdev, req->assoc, assoc_nents ? : 1, |
| 1337 | DMA_TO_DEVICE, assoc_chained); | 1347 | DMA_TO_DEVICE, assoc_chained); |
| @@ -1425,8 +1435,6 @@ static int aead_givencrypt(struct aead_givcrypt_request *areq) | |||
| 1425 | u32 *desc; | 1435 | u32 *desc; |
| 1426 | int ret = 0; | 1436 | int ret = 0; |
| 1427 | 1437 | ||
| 1428 | req->cryptlen += ctx->authsize; | ||
| 1429 | |||
| 1430 | /* allocate extended descriptor */ | 1438 | /* allocate extended descriptor */ |
| 1431 | edesc = aead_giv_edesc_alloc(areq, DESC_JOB_IO_LEN * | 1439 | edesc = aead_giv_edesc_alloc(areq, DESC_JOB_IO_LEN * |
| 1432 | CAAM_CMD_SZ, &contig); | 1440 | CAAM_CMD_SZ, &contig); |
| @@ -2057,7 +2065,6 @@ static struct caam_alg_template driver_algs[] = { | |||
| 2057 | 2065 | ||
| 2058 | struct caam_crypto_alg { | 2066 | struct caam_crypto_alg { |
| 2059 | struct list_head entry; | 2067 | struct list_head entry; |
| 2060 | struct device *ctrldev; | ||
| 2061 | int class1_alg_type; | 2068 | int class1_alg_type; |
| 2062 | int class2_alg_type; | 2069 | int class2_alg_type; |
| 2063 | int alg_op; | 2070 | int alg_op; |
| @@ -2070,14 +2077,12 @@ static int caam_cra_init(struct crypto_tfm *tfm) | |||
| 2070 | struct caam_crypto_alg *caam_alg = | 2077 | struct caam_crypto_alg *caam_alg = |
| 2071 | container_of(alg, struct caam_crypto_alg, crypto_alg); | 2078 | container_of(alg, struct caam_crypto_alg, crypto_alg); |
| 2072 | struct caam_ctx *ctx = crypto_tfm_ctx(tfm); | 2079 | struct caam_ctx *ctx = crypto_tfm_ctx(tfm); |
| 2073 | struct caam_drv_private *priv = dev_get_drvdata(caam_alg->ctrldev); | ||
| 2074 | int tgt_jr = atomic_inc_return(&priv->tfm_count); | ||
| 2075 | 2080 | ||
| 2076 | /* | 2081 | ctx->jrdev = caam_jr_alloc(); |
| 2077 | * distribute tfms across job rings to ensure in-order | 2082 | if (IS_ERR(ctx->jrdev)) { |
| 2078 | * crypto request processing per tfm | 2083 | pr_err("Job Ring Device allocation for transform failed\n"); |
| 2079 | */ | 2084 | return PTR_ERR(ctx->jrdev); |
| 2080 | ctx->jrdev = priv->jrdev[(tgt_jr / 2) % priv->total_jobrs]; | 2085 | } |
| 2081 | 2086 | ||
| 2082 | /* copy descriptor header template value */ | 2087 | /* copy descriptor header template value */ |
| 2083 | ctx->class1_alg_type = OP_TYPE_CLASS1_ALG | caam_alg->class1_alg_type; | 2088 | ctx->class1_alg_type = OP_TYPE_CLASS1_ALG | caam_alg->class1_alg_type; |
| @@ -2104,44 +2109,26 @@ static void caam_cra_exit(struct crypto_tfm *tfm) | |||
| 2104 | dma_unmap_single(ctx->jrdev, ctx->sh_desc_givenc_dma, | 2109 | dma_unmap_single(ctx->jrdev, ctx->sh_desc_givenc_dma, |
| 2105 | desc_bytes(ctx->sh_desc_givenc), | 2110 | desc_bytes(ctx->sh_desc_givenc), |
| 2106 | DMA_TO_DEVICE); | 2111 | DMA_TO_DEVICE); |
| 2112 | |||
| 2113 | caam_jr_free(ctx->jrdev); | ||
| 2107 | } | 2114 | } |
| 2108 | 2115 | ||
| 2109 | static void __exit caam_algapi_exit(void) | 2116 | static void __exit caam_algapi_exit(void) |
| 2110 | { | 2117 | { |
| 2111 | 2118 | ||
| 2112 | struct device_node *dev_node; | ||
| 2113 | struct platform_device *pdev; | ||
| 2114 | struct device *ctrldev; | ||
| 2115 | struct caam_drv_private *priv; | ||
| 2116 | struct caam_crypto_alg *t_alg, *n; | 2119 | struct caam_crypto_alg *t_alg, *n; |
| 2117 | 2120 | ||
| 2118 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec-v4.0"); | 2121 | if (!alg_list.next) |
| 2119 | if (!dev_node) { | ||
| 2120 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec4.0"); | ||
| 2121 | if (!dev_node) | ||
| 2122 | return; | ||
| 2123 | } | ||
| 2124 | |||
| 2125 | pdev = of_find_device_by_node(dev_node); | ||
| 2126 | if (!pdev) | ||
| 2127 | return; | ||
| 2128 | |||
| 2129 | ctrldev = &pdev->dev; | ||
| 2130 | of_node_put(dev_node); | ||
| 2131 | priv = dev_get_drvdata(ctrldev); | ||
| 2132 | |||
| 2133 | if (!priv->alg_list.next) | ||
| 2134 | return; | 2122 | return; |
| 2135 | 2123 | ||
| 2136 | list_for_each_entry_safe(t_alg, n, &priv->alg_list, entry) { | 2124 | list_for_each_entry_safe(t_alg, n, &alg_list, entry) { |
| 2137 | crypto_unregister_alg(&t_alg->crypto_alg); | 2125 | crypto_unregister_alg(&t_alg->crypto_alg); |
| 2138 | list_del(&t_alg->entry); | 2126 | list_del(&t_alg->entry); |
| 2139 | kfree(t_alg); | 2127 | kfree(t_alg); |
| 2140 | } | 2128 | } |
| 2141 | } | 2129 | } |
| 2142 | 2130 | ||
| 2143 | static struct caam_crypto_alg *caam_alg_alloc(struct device *ctrldev, | 2131 | static struct caam_crypto_alg *caam_alg_alloc(struct caam_alg_template |
| 2144 | struct caam_alg_template | ||
| 2145 | *template) | 2132 | *template) |
| 2146 | { | 2133 | { |
| 2147 | struct caam_crypto_alg *t_alg; | 2134 | struct caam_crypto_alg *t_alg; |
| @@ -2149,7 +2136,7 @@ static struct caam_crypto_alg *caam_alg_alloc(struct device *ctrldev, | |||
| 2149 | 2136 | ||
| 2150 | t_alg = kzalloc(sizeof(struct caam_crypto_alg), GFP_KERNEL); | 2137 | t_alg = kzalloc(sizeof(struct caam_crypto_alg), GFP_KERNEL); |
| 2151 | if (!t_alg) { | 2138 | if (!t_alg) { |
| 2152 | dev_err(ctrldev, "failed to allocate t_alg\n"); | 2139 | pr_err("failed to allocate t_alg\n"); |
| 2153 | return ERR_PTR(-ENOMEM); | 2140 | return ERR_PTR(-ENOMEM); |
| 2154 | } | 2141 | } |
| 2155 | 2142 | ||
| @@ -2181,62 +2168,39 @@ static struct caam_crypto_alg *caam_alg_alloc(struct device *ctrldev, | |||
| 2181 | t_alg->class1_alg_type = template->class1_alg_type; | 2168 | t_alg->class1_alg_type = template->class1_alg_type; |
| 2182 | t_alg->class2_alg_type = template->class2_alg_type; | 2169 | t_alg->class2_alg_type = template->class2_alg_type; |
| 2183 | t_alg->alg_op = template->alg_op; | 2170 | t_alg->alg_op = template->alg_op; |
| 2184 | t_alg->ctrldev = ctrldev; | ||
| 2185 | 2171 | ||
| 2186 | return t_alg; | 2172 | return t_alg; |
| 2187 | } | 2173 | } |
| 2188 | 2174 | ||
| 2189 | static int __init caam_algapi_init(void) | 2175 | static int __init caam_algapi_init(void) |
| 2190 | { | 2176 | { |
| 2191 | struct device_node *dev_node; | ||
| 2192 | struct platform_device *pdev; | ||
| 2193 | struct device *ctrldev; | ||
| 2194 | struct caam_drv_private *priv; | ||
| 2195 | int i = 0, err = 0; | 2177 | int i = 0, err = 0; |
| 2196 | 2178 | ||
| 2197 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec-v4.0"); | 2179 | INIT_LIST_HEAD(&alg_list); |
| 2198 | if (!dev_node) { | ||
| 2199 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec4.0"); | ||
| 2200 | if (!dev_node) | ||
| 2201 | return -ENODEV; | ||
| 2202 | } | ||
| 2203 | |||
| 2204 | pdev = of_find_device_by_node(dev_node); | ||
| 2205 | if (!pdev) | ||
| 2206 | return -ENODEV; | ||
| 2207 | |||
| 2208 | ctrldev = &pdev->dev; | ||
| 2209 | priv = dev_get_drvdata(ctrldev); | ||
| 2210 | of_node_put(dev_node); | ||
| 2211 | |||
| 2212 | INIT_LIST_HEAD(&priv->alg_list); | ||
| 2213 | |||
| 2214 | atomic_set(&priv->tfm_count, -1); | ||
| 2215 | 2180 | ||
| 2216 | /* register crypto algorithms the device supports */ | 2181 | /* register crypto algorithms the device supports */ |
| 2217 | for (i = 0; i < ARRAY_SIZE(driver_algs); i++) { | 2182 | for (i = 0; i < ARRAY_SIZE(driver_algs); i++) { |
| 2218 | /* TODO: check if h/w supports alg */ | 2183 | /* TODO: check if h/w supports alg */ |
| 2219 | struct caam_crypto_alg *t_alg; | 2184 | struct caam_crypto_alg *t_alg; |
| 2220 | 2185 | ||
| 2221 | t_alg = caam_alg_alloc(ctrldev, &driver_algs[i]); | 2186 | t_alg = caam_alg_alloc(&driver_algs[i]); |
| 2222 | if (IS_ERR(t_alg)) { | 2187 | if (IS_ERR(t_alg)) { |
| 2223 | err = PTR_ERR(t_alg); | 2188 | err = PTR_ERR(t_alg); |
| 2224 | dev_warn(ctrldev, "%s alg allocation failed\n", | 2189 | pr_warn("%s alg allocation failed\n", |
| 2225 | driver_algs[i].driver_name); | 2190 | driver_algs[i].driver_name); |
| 2226 | continue; | 2191 | continue; |
| 2227 | } | 2192 | } |
| 2228 | 2193 | ||
| 2229 | err = crypto_register_alg(&t_alg->crypto_alg); | 2194 | err = crypto_register_alg(&t_alg->crypto_alg); |
| 2230 | if (err) { | 2195 | if (err) { |
| 2231 | dev_warn(ctrldev, "%s alg registration failed\n", | 2196 | pr_warn("%s alg registration failed\n", |
| 2232 | t_alg->crypto_alg.cra_driver_name); | 2197 | t_alg->crypto_alg.cra_driver_name); |
| 2233 | kfree(t_alg); | 2198 | kfree(t_alg); |
| 2234 | } else | 2199 | } else |
| 2235 | list_add_tail(&t_alg->entry, &priv->alg_list); | 2200 | list_add_tail(&t_alg->entry, &alg_list); |
| 2236 | } | 2201 | } |
| 2237 | if (!list_empty(&priv->alg_list)) | 2202 | if (!list_empty(&alg_list)) |
| 2238 | dev_info(ctrldev, "%s algorithms registered in /proc/crypto\n", | 2203 | pr_info("caam algorithms registered in /proc/crypto\n"); |
| 2239 | (char *)of_get_property(dev_node, "compatible", NULL)); | ||
| 2240 | 2204 | ||
| 2241 | return err; | 2205 | return err; |
| 2242 | } | 2206 | } |
diff --git a/drivers/crypto/caam/caamhash.c b/drivers/crypto/caam/caamhash.c index e732bd962e98..0378328f47a7 100644 --- a/drivers/crypto/caam/caamhash.c +++ b/drivers/crypto/caam/caamhash.c | |||
| @@ -94,6 +94,9 @@ | |||
| 94 | #define debug(format, arg...) | 94 | #define debug(format, arg...) |
| 95 | #endif | 95 | #endif |
| 96 | 96 | ||
| 97 | |||
| 98 | static struct list_head hash_list; | ||
| 99 | |||
| 97 | /* ahash per-session context */ | 100 | /* ahash per-session context */ |
| 98 | struct caam_hash_ctx { | 101 | struct caam_hash_ctx { |
| 99 | struct device *jrdev; | 102 | struct device *jrdev; |
| @@ -1653,7 +1656,6 @@ static struct caam_hash_template driver_hash[] = { | |||
| 1653 | 1656 | ||
| 1654 | struct caam_hash_alg { | 1657 | struct caam_hash_alg { |
| 1655 | struct list_head entry; | 1658 | struct list_head entry; |
| 1656 | struct device *ctrldev; | ||
| 1657 | int alg_type; | 1659 | int alg_type; |
| 1658 | int alg_op; | 1660 | int alg_op; |
| 1659 | struct ahash_alg ahash_alg; | 1661 | struct ahash_alg ahash_alg; |
| @@ -1670,7 +1672,6 @@ static int caam_hash_cra_init(struct crypto_tfm *tfm) | |||
| 1670 | struct caam_hash_alg *caam_hash = | 1672 | struct caam_hash_alg *caam_hash = |
| 1671 | container_of(alg, struct caam_hash_alg, ahash_alg); | 1673 | container_of(alg, struct caam_hash_alg, ahash_alg); |
| 1672 | struct caam_hash_ctx *ctx = crypto_tfm_ctx(tfm); | 1674 | struct caam_hash_ctx *ctx = crypto_tfm_ctx(tfm); |
| 1673 | struct caam_drv_private *priv = dev_get_drvdata(caam_hash->ctrldev); | ||
| 1674 | /* Sizes for MDHA running digests: MD5, SHA1, 224, 256, 384, 512 */ | 1675 | /* Sizes for MDHA running digests: MD5, SHA1, 224, 256, 384, 512 */ |
| 1675 | static const u8 runninglen[] = { HASH_MSG_LEN + MD5_DIGEST_SIZE, | 1676 | static const u8 runninglen[] = { HASH_MSG_LEN + MD5_DIGEST_SIZE, |
| 1676 | HASH_MSG_LEN + SHA1_DIGEST_SIZE, | 1677 | HASH_MSG_LEN + SHA1_DIGEST_SIZE, |
| @@ -1678,15 +1679,17 @@ static int caam_hash_cra_init(struct crypto_tfm *tfm) | |||
| 1678 | HASH_MSG_LEN + SHA256_DIGEST_SIZE, | 1679 | HASH_MSG_LEN + SHA256_DIGEST_SIZE, |
| 1679 | HASH_MSG_LEN + 64, | 1680 | HASH_MSG_LEN + 64, |
| 1680 | HASH_MSG_LEN + SHA512_DIGEST_SIZE }; | 1681 | HASH_MSG_LEN + SHA512_DIGEST_SIZE }; |
| 1681 | int tgt_jr = atomic_inc_return(&priv->tfm_count); | ||
| 1682 | int ret = 0; | 1682 | int ret = 0; |
| 1683 | 1683 | ||
| 1684 | /* | 1684 | /* |
| 1685 | * distribute tfms across job rings to ensure in-order | 1685 | * Get a Job ring from Job Ring driver to ensure in-order |
| 1686 | * crypto request processing per tfm | 1686 | * crypto request processing per tfm |
| 1687 | */ | 1687 | */ |
| 1688 | ctx->jrdev = priv->jrdev[tgt_jr % priv->total_jobrs]; | 1688 | ctx->jrdev = caam_jr_alloc(); |
| 1689 | 1689 | if (IS_ERR(ctx->jrdev)) { | |
| 1690 | pr_err("Job Ring Device allocation for transform failed\n"); | ||
| 1691 | return PTR_ERR(ctx->jrdev); | ||
| 1692 | } | ||
| 1690 | /* copy descriptor header template value */ | 1693 | /* copy descriptor header template value */ |
| 1691 | ctx->alg_type = OP_TYPE_CLASS2_ALG | caam_hash->alg_type; | 1694 | ctx->alg_type = OP_TYPE_CLASS2_ALG | caam_hash->alg_type; |
| 1692 | ctx->alg_op = OP_TYPE_CLASS2_ALG | caam_hash->alg_op; | 1695 | ctx->alg_op = OP_TYPE_CLASS2_ALG | caam_hash->alg_op; |
| @@ -1729,35 +1732,18 @@ static void caam_hash_cra_exit(struct crypto_tfm *tfm) | |||
| 1729 | !dma_mapping_error(ctx->jrdev, ctx->sh_desc_finup_dma)) | 1732 | !dma_mapping_error(ctx->jrdev, ctx->sh_desc_finup_dma)) |
| 1730 | dma_unmap_single(ctx->jrdev, ctx->sh_desc_finup_dma, | 1733 | dma_unmap_single(ctx->jrdev, ctx->sh_desc_finup_dma, |
| 1731 | desc_bytes(ctx->sh_desc_finup), DMA_TO_DEVICE); | 1734 | desc_bytes(ctx->sh_desc_finup), DMA_TO_DEVICE); |
| 1735 | |||
| 1736 | caam_jr_free(ctx->jrdev); | ||
| 1732 | } | 1737 | } |
| 1733 | 1738 | ||
| 1734 | static void __exit caam_algapi_hash_exit(void) | 1739 | static void __exit caam_algapi_hash_exit(void) |
| 1735 | { | 1740 | { |
| 1736 | struct device_node *dev_node; | ||
| 1737 | struct platform_device *pdev; | ||
| 1738 | struct device *ctrldev; | ||
| 1739 | struct caam_drv_private *priv; | ||
| 1740 | struct caam_hash_alg *t_alg, *n; | 1741 | struct caam_hash_alg *t_alg, *n; |
| 1741 | 1742 | ||
| 1742 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec-v4.0"); | 1743 | if (!hash_list.next) |
| 1743 | if (!dev_node) { | ||
| 1744 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec4.0"); | ||
| 1745 | if (!dev_node) | ||
| 1746 | return; | ||
| 1747 | } | ||
| 1748 | |||
| 1749 | pdev = of_find_device_by_node(dev_node); | ||
| 1750 | if (!pdev) | ||
| 1751 | return; | 1744 | return; |
| 1752 | 1745 | ||
| 1753 | ctrldev = &pdev->dev; | 1746 | list_for_each_entry_safe(t_alg, n, &hash_list, entry) { |
| 1754 | of_node_put(dev_node); | ||
| 1755 | priv = dev_get_drvdata(ctrldev); | ||
| 1756 | |||
| 1757 | if (!priv->hash_list.next) | ||
| 1758 | return; | ||
| 1759 | |||
| 1760 | list_for_each_entry_safe(t_alg, n, &priv->hash_list, entry) { | ||
| 1761 | crypto_unregister_ahash(&t_alg->ahash_alg); | 1747 | crypto_unregister_ahash(&t_alg->ahash_alg); |
| 1762 | list_del(&t_alg->entry); | 1748 | list_del(&t_alg->entry); |
| 1763 | kfree(t_alg); | 1749 | kfree(t_alg); |
| @@ -1765,7 +1751,7 @@ static void __exit caam_algapi_hash_exit(void) | |||
| 1765 | } | 1751 | } |
| 1766 | 1752 | ||
| 1767 | static struct caam_hash_alg * | 1753 | static struct caam_hash_alg * |
| 1768 | caam_hash_alloc(struct device *ctrldev, struct caam_hash_template *template, | 1754 | caam_hash_alloc(struct caam_hash_template *template, |
| 1769 | bool keyed) | 1755 | bool keyed) |
| 1770 | { | 1756 | { |
| 1771 | struct caam_hash_alg *t_alg; | 1757 | struct caam_hash_alg *t_alg; |
| @@ -1774,7 +1760,7 @@ caam_hash_alloc(struct device *ctrldev, struct caam_hash_template *template, | |||
| 1774 | 1760 | ||
| 1775 | t_alg = kzalloc(sizeof(struct caam_hash_alg), GFP_KERNEL); | 1761 | t_alg = kzalloc(sizeof(struct caam_hash_alg), GFP_KERNEL); |
| 1776 | if (!t_alg) { | 1762 | if (!t_alg) { |
| 1777 | dev_err(ctrldev, "failed to allocate t_alg\n"); | 1763 | pr_err("failed to allocate t_alg\n"); |
| 1778 | return ERR_PTR(-ENOMEM); | 1764 | return ERR_PTR(-ENOMEM); |
| 1779 | } | 1765 | } |
| 1780 | 1766 | ||
| @@ -1805,37 +1791,15 @@ caam_hash_alloc(struct device *ctrldev, struct caam_hash_template *template, | |||
| 1805 | 1791 | ||
| 1806 | t_alg->alg_type = template->alg_type; | 1792 | t_alg->alg_type = template->alg_type; |
| 1807 | t_alg->alg_op = template->alg_op; | 1793 | t_alg->alg_op = template->alg_op; |
| 1808 | t_alg->ctrldev = ctrldev; | ||
| 1809 | 1794 | ||
| 1810 | return t_alg; | 1795 | return t_alg; |
| 1811 | } | 1796 | } |
| 1812 | 1797 | ||
| 1813 | static int __init caam_algapi_hash_init(void) | 1798 | static int __init caam_algapi_hash_init(void) |
| 1814 | { | 1799 | { |
| 1815 | struct device_node *dev_node; | ||
| 1816 | struct platform_device *pdev; | ||
| 1817 | struct device *ctrldev; | ||
| 1818 | struct caam_drv_private *priv; | ||
| 1819 | int i = 0, err = 0; | 1800 | int i = 0, err = 0; |
| 1820 | 1801 | ||
| 1821 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec-v4.0"); | 1802 | INIT_LIST_HEAD(&hash_list); |
| 1822 | if (!dev_node) { | ||
| 1823 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec4.0"); | ||
| 1824 | if (!dev_node) | ||
| 1825 | return -ENODEV; | ||
| 1826 | } | ||
| 1827 | |||
| 1828 | pdev = of_find_device_by_node(dev_node); | ||
| 1829 | if (!pdev) | ||
| 1830 | return -ENODEV; | ||
| 1831 | |||
| 1832 | ctrldev = &pdev->dev; | ||
| 1833 | priv = dev_get_drvdata(ctrldev); | ||
| 1834 | of_node_put(dev_node); | ||
| 1835 | |||
| 1836 | INIT_LIST_HEAD(&priv->hash_list); | ||
| 1837 | |||
| 1838 | atomic_set(&priv->tfm_count, -1); | ||
| 1839 | 1803 | ||
| 1840 | /* register crypto algorithms the device supports */ | 1804 | /* register crypto algorithms the device supports */ |
| 1841 | for (i = 0; i < ARRAY_SIZE(driver_hash); i++) { | 1805 | for (i = 0; i < ARRAY_SIZE(driver_hash); i++) { |
| @@ -1843,38 +1807,38 @@ static int __init caam_algapi_hash_init(void) | |||
| 1843 | struct caam_hash_alg *t_alg; | 1807 | struct caam_hash_alg *t_alg; |
| 1844 | 1808 | ||
| 1845 | /* register hmac version */ | 1809 | /* register hmac version */ |
| 1846 | t_alg = caam_hash_alloc(ctrldev, &driver_hash[i], true); | 1810 | t_alg = caam_hash_alloc(&driver_hash[i], true); |
| 1847 | if (IS_ERR(t_alg)) { | 1811 | if (IS_ERR(t_alg)) { |
| 1848 | err = PTR_ERR(t_alg); | 1812 | err = PTR_ERR(t_alg); |
| 1849 | dev_warn(ctrldev, "%s alg allocation failed\n", | 1813 | pr_warn("%s alg allocation failed\n", |
| 1850 | driver_hash[i].driver_name); | 1814 | driver_hash[i].driver_name); |
| 1851 | continue; | 1815 | continue; |
| 1852 | } | 1816 | } |
| 1853 | 1817 | ||
| 1854 | err = crypto_register_ahash(&t_alg->ahash_alg); | 1818 | err = crypto_register_ahash(&t_alg->ahash_alg); |
| 1855 | if (err) { | 1819 | if (err) { |
| 1856 | dev_warn(ctrldev, "%s alg registration failed\n", | 1820 | pr_warn("%s alg registration failed\n", |
| 1857 | t_alg->ahash_alg.halg.base.cra_driver_name); | 1821 | t_alg->ahash_alg.halg.base.cra_driver_name); |
| 1858 | kfree(t_alg); | 1822 | kfree(t_alg); |
| 1859 | } else | 1823 | } else |
| 1860 | list_add_tail(&t_alg->entry, &priv->hash_list); | 1824 | list_add_tail(&t_alg->entry, &hash_list); |
| 1861 | 1825 | ||
| 1862 | /* register unkeyed version */ | 1826 | /* register unkeyed version */ |
| 1863 | t_alg = caam_hash_alloc(ctrldev, &driver_hash[i], false); | 1827 | t_alg = caam_hash_alloc(&driver_hash[i], false); |
| 1864 | if (IS_ERR(t_alg)) { | 1828 | if (IS_ERR(t_alg)) { |
| 1865 | err = PTR_ERR(t_alg); | 1829 | err = PTR_ERR(t_alg); |
| 1866 | dev_warn(ctrldev, "%s alg allocation failed\n", | 1830 | pr_warn("%s alg allocation failed\n", |
| 1867 | driver_hash[i].driver_name); | 1831 | driver_hash[i].driver_name); |
| 1868 | continue; | 1832 | continue; |
| 1869 | } | 1833 | } |
| 1870 | 1834 | ||
| 1871 | err = crypto_register_ahash(&t_alg->ahash_alg); | 1835 | err = crypto_register_ahash(&t_alg->ahash_alg); |
| 1872 | if (err) { | 1836 | if (err) { |
| 1873 | dev_warn(ctrldev, "%s alg registration failed\n", | 1837 | pr_warn("%s alg registration failed\n", |
| 1874 | t_alg->ahash_alg.halg.base.cra_driver_name); | 1838 | t_alg->ahash_alg.halg.base.cra_driver_name); |
| 1875 | kfree(t_alg); | 1839 | kfree(t_alg); |
| 1876 | } else | 1840 | } else |
| 1877 | list_add_tail(&t_alg->entry, &priv->hash_list); | 1841 | list_add_tail(&t_alg->entry, &hash_list); |
| 1878 | } | 1842 | } |
| 1879 | 1843 | ||
| 1880 | return err; | 1844 | return err; |
diff --git a/drivers/crypto/caam/caamrng.c b/drivers/crypto/caam/caamrng.c index d1939a9539c0..28486b19fc36 100644 --- a/drivers/crypto/caam/caamrng.c +++ b/drivers/crypto/caam/caamrng.c | |||
| @@ -273,34 +273,23 @@ static struct hwrng caam_rng = { | |||
| 273 | 273 | ||
| 274 | static void __exit caam_rng_exit(void) | 274 | static void __exit caam_rng_exit(void) |
| 275 | { | 275 | { |
| 276 | caam_jr_free(rng_ctx.jrdev); | ||
| 276 | hwrng_unregister(&caam_rng); | 277 | hwrng_unregister(&caam_rng); |
| 277 | } | 278 | } |
| 278 | 279 | ||
| 279 | static int __init caam_rng_init(void) | 280 | static int __init caam_rng_init(void) |
| 280 | { | 281 | { |
| 281 | struct device_node *dev_node; | 282 | struct device *dev; |
| 282 | struct platform_device *pdev; | ||
| 283 | struct device *ctrldev; | ||
| 284 | struct caam_drv_private *priv; | ||
| 285 | |||
| 286 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec-v4.0"); | ||
| 287 | if (!dev_node) { | ||
| 288 | dev_node = of_find_compatible_node(NULL, NULL, "fsl,sec4.0"); | ||
| 289 | if (!dev_node) | ||
| 290 | return -ENODEV; | ||
| 291 | } | ||
| 292 | |||
| 293 | pdev = of_find_device_by_node(dev_node); | ||
| 294 | if (!pdev) | ||
| 295 | return -ENODEV; | ||
| 296 | 283 | ||
| 297 | ctrldev = &pdev->dev; | 284 | dev = caam_jr_alloc(); |
| 298 | priv = dev_get_drvdata(ctrldev); | 285 | if (IS_ERR(dev)) { |
| 299 | of_node_put(dev_node); | 286 | pr_err("Job Ring Device allocation for transform failed\n"); |
| 287 | return PTR_ERR(dev); | ||
| 288 | } | ||
| 300 | 289 | ||
| 301 | caam_init_rng(&rng_ctx, priv->jrdev[0]); | 290 | caam_init_rng(&rng_ctx, dev); |
| 302 | 291 | ||
| 303 | dev_info(priv->jrdev[0], "registering rng-caam\n"); | 292 | dev_info(dev, "registering rng-caam\n"); |
| 304 | return hwrng_register(&caam_rng); | 293 | return hwrng_register(&caam_rng); |
| 305 | } | 294 | } |
| 306 | 295 | ||
diff --git a/drivers/crypto/caam/ctrl.c b/drivers/crypto/caam/ctrl.c index bc6d820812b6..63fb1af2c431 100644 --- a/drivers/crypto/caam/ctrl.c +++ b/drivers/crypto/caam/ctrl.c | |||
| @@ -16,82 +16,75 @@ | |||
| 16 | #include "error.h" | 16 | #include "error.h" |
| 17 | #include "ctrl.h" | 17 | #include "ctrl.h" |
| 18 | 18 | ||
| 19 | static int caam_remove(struct platform_device *pdev) | ||
| 20 | { | ||
| 21 | struct device *ctrldev; | ||
| 22 | struct caam_drv_private *ctrlpriv; | ||
| 23 | struct caam_drv_private_jr *jrpriv; | ||
| 24 | struct caam_full __iomem *topregs; | ||
| 25 | int ring, ret = 0; | ||
| 26 | |||
| 27 | ctrldev = &pdev->dev; | ||
| 28 | ctrlpriv = dev_get_drvdata(ctrldev); | ||
| 29 | topregs = (struct caam_full __iomem *)ctrlpriv->ctrl; | ||
| 30 | |||
| 31 | /* shut down JobRs */ | ||
| 32 | for (ring = 0; ring < ctrlpriv->total_jobrs; ring++) { | ||
| 33 | ret |= caam_jr_shutdown(ctrlpriv->jrdev[ring]); | ||
| 34 | jrpriv = dev_get_drvdata(ctrlpriv->jrdev[ring]); | ||
| 35 | irq_dispose_mapping(jrpriv->irq); | ||
| 36 | } | ||
| 37 | |||
| 38 | /* Shut down debug views */ | ||
| 39 | #ifdef CONFIG_DEBUG_FS | ||
| 40 | debugfs_remove_recursive(ctrlpriv->dfs_root); | ||
| 41 | #endif | ||
| 42 | |||
| 43 | /* Unmap controller region */ | ||
| 44 | iounmap(&topregs->ctrl); | ||
| 45 | |||
| 46 | kfree(ctrlpriv->jrdev); | ||
| 47 | kfree(ctrlpriv); | ||
| 48 | |||
| 49 | return ret; | ||
| 50 | } | ||
| 51 | |||
| 52 | /* | 19 | /* |
| 53 | * Descriptor to instantiate RNG State Handle 0 in normal mode and | 20 | * Descriptor to instantiate RNG State Handle 0 in normal mode and |
| 54 | * load the JDKEK, TDKEK and TDSK registers | 21 | * load the JDKEK, TDKEK and TDSK registers |
| 55 | */ | 22 | */ |
| 56 | static void build_instantiation_desc(u32 *desc) | 23 | static void build_instantiation_desc(u32 *desc, int handle, int do_sk) |
| 57 | { | 24 | { |
| 58 | u32 *jump_cmd; | 25 | u32 *jump_cmd, op_flags; |
| 59 | 26 | ||
| 60 | init_job_desc(desc, 0); | 27 | init_job_desc(desc, 0); |
| 61 | 28 | ||
| 29 | op_flags = OP_TYPE_CLASS1_ALG | OP_ALG_ALGSEL_RNG | | ||
| 30 | (handle << OP_ALG_AAI_SHIFT) | OP_ALG_AS_INIT; | ||
| 31 | |||
| 62 | /* INIT RNG in non-test mode */ | 32 | /* INIT RNG in non-test mode */ |
| 63 | append_operation(desc, OP_TYPE_CLASS1_ALG | OP_ALG_ALGSEL_RNG | | 33 | append_operation(desc, op_flags); |
| 64 | OP_ALG_AS_INIT); | 34 | |
| 35 | if (!handle && do_sk) { | ||
| 36 | /* | ||
| 37 | * For SH0, Secure Keys must be generated as well | ||
| 38 | */ | ||
| 39 | |||
| 40 | /* wait for done */ | ||
| 41 | jump_cmd = append_jump(desc, JUMP_CLASS_CLASS1); | ||
| 42 | set_jump_tgt_here(desc, jump_cmd); | ||
| 43 | |||
| 44 | /* | ||
| 45 | * load 1 to clear written reg: | ||
| 46 | * resets the done interrrupt and returns the RNG to idle. | ||
| 47 | */ | ||
| 48 | append_load_imm_u32(desc, 1, LDST_SRCDST_WORD_CLRW); | ||
| 49 | |||
| 50 | /* Initialize State Handle */ | ||
| 51 | append_operation(desc, OP_TYPE_CLASS1_ALG | OP_ALG_ALGSEL_RNG | | ||
| 52 | OP_ALG_AAI_RNG4_SK); | ||
| 53 | } | ||
| 65 | 54 | ||
| 66 | /* wait for done */ | 55 | append_jump(desc, JUMP_CLASS_CLASS1 | JUMP_TYPE_HALT); |
| 67 | jump_cmd = append_jump(desc, JUMP_CLASS_CLASS1); | 56 | } |
| 68 | set_jump_tgt_here(desc, jump_cmd); | ||
| 69 | 57 | ||
| 70 | /* | 58 | /* Descriptor for deinstantiation of State Handle 0 of the RNG block. */ |
| 71 | * load 1 to clear written reg: | 59 | static void build_deinstantiation_desc(u32 *desc, int handle) |
| 72 | * resets the done interrupt and returns the RNG to idle. | 60 | { |
| 73 | */ | 61 | init_job_desc(desc, 0); |
| 74 | append_load_imm_u32(desc, 1, LDST_SRCDST_WORD_CLRW); | ||
| 75 | 62 | ||
| 76 | /* generate secure keys (non-test) */ | 63 | /* Uninstantiate State Handle 0 */ |
| 77 | append_operation(desc, OP_TYPE_CLASS1_ALG | OP_ALG_ALGSEL_RNG | | 64 | append_operation(desc, OP_TYPE_CLASS1_ALG | OP_ALG_ALGSEL_RNG | |
| 78 | OP_ALG_RNG4_SK); | 65 | (handle << OP_ALG_AAI_SHIFT) | OP_ALG_AS_INITFINAL); |
| 66 | |||
| 67 | append_jump(desc, JUMP_CLASS_CLASS1 | JUMP_TYPE_HALT); | ||
| 79 | } | 68 | } |
| 80 | 69 | ||
| 81 | static int instantiate_rng(struct device *ctrldev) | 70 | /* |
| 71 | * run_descriptor_deco0 - runs a descriptor on DECO0, under direct control of | ||
| 72 | * the software (no JR/QI used). | ||
| 73 | * @ctrldev - pointer to device | ||
| 74 | * @status - descriptor status, after being run | ||
| 75 | * | ||
| 76 | * Return: - 0 if no error occurred | ||
| 77 | * - -ENODEV if the DECO couldn't be acquired | ||
| 78 | * - -EAGAIN if an error occurred while executing the descriptor | ||
| 79 | */ | ||
| 80 | static inline int run_descriptor_deco0(struct device *ctrldev, u32 *desc, | ||
| 81 | u32 *status) | ||
| 82 | { | 82 | { |
| 83 | struct caam_drv_private *ctrlpriv = dev_get_drvdata(ctrldev); | 83 | struct caam_drv_private *ctrlpriv = dev_get_drvdata(ctrldev); |
| 84 | struct caam_full __iomem *topregs; | 84 | struct caam_full __iomem *topregs; |
| 85 | unsigned int timeout = 100000; | 85 | unsigned int timeout = 100000; |
| 86 | u32 *desc; | 86 | u32 deco_dbg_reg, flags; |
| 87 | int i, ret = 0; | 87 | int i; |
| 88 | |||
| 89 | desc = kmalloc(CAAM_CMD_SZ * 6, GFP_KERNEL | GFP_DMA); | ||
| 90 | if (!desc) { | ||
| 91 | dev_err(ctrldev, "can't allocate RNG init descriptor memory\n"); | ||
| 92 | return -ENOMEM; | ||
| 93 | } | ||
| 94 | build_instantiation_desc(desc); | ||
| 95 | 88 | ||
| 96 | /* Set the bit to request direct access to DECO0 */ | 89 | /* Set the bit to request direct access to DECO0 */ |
| 97 | topregs = (struct caam_full __iomem *)ctrlpriv->ctrl; | 90 | topregs = (struct caam_full __iomem *)ctrlpriv->ctrl; |
| @@ -103,36 +96,219 @@ static int instantiate_rng(struct device *ctrldev) | |||
| 103 | 96 | ||
| 104 | if (!timeout) { | 97 | if (!timeout) { |
| 105 | dev_err(ctrldev, "failed to acquire DECO 0\n"); | 98 | dev_err(ctrldev, "failed to acquire DECO 0\n"); |
| 106 | ret = -EIO; | 99 | clrbits32(&topregs->ctrl.deco_rq, DECORR_RQD0ENABLE); |
| 107 | goto out; | 100 | return -ENODEV; |
| 108 | } | 101 | } |
| 109 | 102 | ||
| 110 | for (i = 0; i < desc_len(desc); i++) | 103 | for (i = 0; i < desc_len(desc); i++) |
| 111 | topregs->deco.descbuf[i] = *(desc + i); | 104 | wr_reg32(&topregs->deco.descbuf[i], *(desc + i)); |
| 105 | |||
| 106 | flags = DECO_JQCR_WHL; | ||
| 107 | /* | ||
| 108 | * If the descriptor length is longer than 4 words, then the | ||
| 109 | * FOUR bit in JRCTRL register must be set. | ||
| 110 | */ | ||
| 111 | if (desc_len(desc) >= 4) | ||
| 112 | flags |= DECO_JQCR_FOUR; | ||
| 112 | 113 | ||
| 113 | wr_reg32(&topregs->deco.jr_ctl_hi, DECO_JQCR_WHL | DECO_JQCR_FOUR); | 114 | /* Instruct the DECO to execute it */ |
| 115 | wr_reg32(&topregs->deco.jr_ctl_hi, flags); | ||
| 114 | 116 | ||
| 115 | timeout = 10000000; | 117 | timeout = 10000000; |
| 116 | while ((rd_reg32(&topregs->deco.desc_dbg) & DECO_DBG_VALID) && | 118 | do { |
| 117 | --timeout) | 119 | deco_dbg_reg = rd_reg32(&topregs->deco.desc_dbg); |
| 120 | /* | ||
| 121 | * If an error occured in the descriptor, then | ||
| 122 | * the DECO status field will be set to 0x0D | ||
| 123 | */ | ||
| 124 | if ((deco_dbg_reg & DESC_DBG_DECO_STAT_MASK) == | ||
| 125 | DESC_DBG_DECO_STAT_HOST_ERR) | ||
| 126 | break; | ||
| 118 | cpu_relax(); | 127 | cpu_relax(); |
| 128 | } while ((deco_dbg_reg & DESC_DBG_DECO_STAT_VALID) && --timeout); | ||
| 119 | 129 | ||
| 120 | if (!timeout) { | 130 | *status = rd_reg32(&topregs->deco.op_status_hi) & |
| 121 | dev_err(ctrldev, "failed to instantiate RNG\n"); | 131 | DECO_OP_STATUS_HI_ERR_MASK; |
| 122 | ret = -EIO; | ||
| 123 | } | ||
| 124 | 132 | ||
| 133 | /* Mark the DECO as free */ | ||
| 125 | clrbits32(&topregs->ctrl.deco_rq, DECORR_RQD0ENABLE); | 134 | clrbits32(&topregs->ctrl.deco_rq, DECORR_RQD0ENABLE); |
| 126 | out: | 135 | |
| 136 | if (!timeout) | ||
| 137 | return -EAGAIN; | ||
| 138 | |||
| 139 | return 0; | ||
| 140 | } | ||
| 141 | |||
| 142 | /* | ||
| 143 | * instantiate_rng - builds and executes a descriptor on DECO0, | ||
| 144 | * which initializes the RNG block. | ||
| 145 | * @ctrldev - pointer to device | ||
| 146 | * @state_handle_mask - bitmask containing the instantiation status | ||
| 147 | * for the RNG4 state handles which exist in | ||
| 148 | * the RNG4 block: 1 if it's been instantiated | ||
| 149 | * by an external entry, 0 otherwise. | ||
| 150 | * @gen_sk - generate data to be loaded into the JDKEK, TDKEK and TDSK; | ||
| 151 | * Caution: this can be done only once; if the keys need to be | ||
| 152 | * regenerated, a POR is required | ||
| 153 | * | ||
| 154 | * Return: - 0 if no error occurred | ||
| 155 | * - -ENOMEM if there isn't enough memory to allocate the descriptor | ||
| 156 | * - -ENODEV if DECO0 couldn't be acquired | ||
| 157 | * - -EAGAIN if an error occurred when executing the descriptor | ||
| 158 | * f.i. there was a RNG hardware error due to not "good enough" | ||
| 159 | * entropy being aquired. | ||
| 160 | */ | ||
| 161 | static int instantiate_rng(struct device *ctrldev, int state_handle_mask, | ||
| 162 | int gen_sk) | ||
| 163 | { | ||
| 164 | struct caam_drv_private *ctrlpriv = dev_get_drvdata(ctrldev); | ||
| 165 | struct caam_full __iomem *topregs; | ||
| 166 | struct rng4tst __iomem *r4tst; | ||
| 167 | u32 *desc, status, rdsta_val; | ||
| 168 | int ret = 0, sh_idx; | ||
| 169 | |||
| 170 | topregs = (struct caam_full __iomem *)ctrlpriv->ctrl; | ||
| 171 | r4tst = &topregs->ctrl.r4tst[0]; | ||
| 172 | |||
| 173 | desc = kmalloc(CAAM_CMD_SZ * 7, GFP_KERNEL); | ||
| 174 | if (!desc) | ||
| 175 | return -ENOMEM; | ||
| 176 | |||
| 177 | for (sh_idx = 0; sh_idx < RNG4_MAX_HANDLES; sh_idx++) { | ||
| 178 | /* | ||
| 179 | * If the corresponding bit is set, this state handle | ||
| 180 | * was initialized by somebody else, so it's left alone. | ||
| 181 | */ | ||
| 182 | if ((1 << sh_idx) & state_handle_mask) | ||
| 183 | continue; | ||
| 184 | |||
| 185 | /* Create the descriptor for instantiating RNG State Handle */ | ||
| 186 | build_instantiation_desc(desc, sh_idx, gen_sk); | ||
| 187 | |||
| 188 | /* Try to run it through DECO0 */ | ||
| 189 | ret = run_descriptor_deco0(ctrldev, desc, &status); | ||
| 190 | |||
| 191 | /* | ||
| 192 | * If ret is not 0, or descriptor status is not 0, then | ||
| 193 | * something went wrong. No need to try the next state | ||
| 194 | * handle (if available), bail out here. | ||
| 195 | * Also, if for some reason, the State Handle didn't get | ||
| 196 | * instantiated although the descriptor has finished | ||
| 197 | * without any error (HW optimizations for later | ||
| 198 | * CAAM eras), then try again. | ||
| 199 | */ | ||
| 200 | rdsta_val = | ||
| 201 | rd_reg32(&topregs->ctrl.r4tst[0].rdsta) & RDSTA_IFMASK; | ||
| 202 | if (status || !(rdsta_val & (1 << sh_idx))) | ||
| 203 | ret = -EAGAIN; | ||
| 204 | if (ret) | ||
| 205 | break; | ||
| 206 | |||
| 207 | dev_info(ctrldev, "Instantiated RNG4 SH%d\n", sh_idx); | ||
| 208 | /* Clear the contents before recreating the descriptor */ | ||
| 209 | memset(desc, 0x00, CAAM_CMD_SZ * 7); | ||
| 210 | } | ||
| 211 | |||
| 127 | kfree(desc); | 212 | kfree(desc); |
| 213 | |||
| 128 | return ret; | 214 | return ret; |
| 129 | } | 215 | } |
| 130 | 216 | ||
| 131 | /* | 217 | /* |
| 132 | * By default, the TRNG runs for 200 clocks per sample; | 218 | * deinstantiate_rng - builds and executes a descriptor on DECO0, |
| 133 | * 1600 clocks per sample generates better entropy. | 219 | * which deinitializes the RNG block. |
| 220 | * @ctrldev - pointer to device | ||
| 221 | * @state_handle_mask - bitmask containing the instantiation status | ||
| 222 | * for the RNG4 state handles which exist in | ||
| 223 | * the RNG4 block: 1 if it's been instantiated | ||
| 224 | * | ||
| 225 | * Return: - 0 if no error occurred | ||
| 226 | * - -ENOMEM if there isn't enough memory to allocate the descriptor | ||
| 227 | * - -ENODEV if DECO0 couldn't be acquired | ||
| 228 | * - -EAGAIN if an error occurred when executing the descriptor | ||
| 134 | */ | 229 | */ |
| 135 | static void kick_trng(struct platform_device *pdev) | 230 | static int deinstantiate_rng(struct device *ctrldev, int state_handle_mask) |
| 231 | { | ||
| 232 | u32 *desc, status; | ||
| 233 | int sh_idx, ret = 0; | ||
| 234 | |||
| 235 | desc = kmalloc(CAAM_CMD_SZ * 3, GFP_KERNEL); | ||
| 236 | if (!desc) | ||
| 237 | return -ENOMEM; | ||
| 238 | |||
| 239 | for (sh_idx = 0; sh_idx < RNG4_MAX_HANDLES; sh_idx++) { | ||
| 240 | /* | ||
| 241 | * If the corresponding bit is set, then it means the state | ||
| 242 | * handle was initialized by us, and thus it needs to be | ||
| 243 | * deintialized as well | ||
| 244 | */ | ||
| 245 | if ((1 << sh_idx) & state_handle_mask) { | ||
| 246 | /* | ||
| 247 | * Create the descriptor for deinstantating this state | ||
| 248 | * handle | ||
| 249 | */ | ||
| 250 | build_deinstantiation_desc(desc, sh_idx); | ||
| 251 | |||
| 252 | /* Try to run it through DECO0 */ | ||
| 253 | ret = run_descriptor_deco0(ctrldev, desc, &status); | ||
| 254 | |||
| 255 | if (ret || status) { | ||
| 256 | dev_err(ctrldev, | ||
| 257 | "Failed to deinstantiate RNG4 SH%d\n", | ||
| 258 | sh_idx); | ||
| 259 | break; | ||
| 260 | } | ||
| 261 | dev_info(ctrldev, "Deinstantiated RNG4 SH%d\n", sh_idx); | ||
| 262 | } | ||
| 263 | } | ||
| 264 | |||
| 265 | kfree(desc); | ||
| 266 | |||
| 267 | return ret; | ||
| 268 | } | ||
| 269 | |||
| 270 | static int caam_remove(struct platform_device *pdev) | ||
| 271 | { | ||
| 272 | struct device *ctrldev; | ||
| 273 | struct caam_drv_private *ctrlpriv; | ||
| 274 | struct caam_full __iomem *topregs; | ||
| 275 | int ring, ret = 0; | ||
| 276 | |||
| 277 | ctrldev = &pdev->dev; | ||
| 278 | ctrlpriv = dev_get_drvdata(ctrldev); | ||
| 279 | topregs = (struct caam_full __iomem *)ctrlpriv->ctrl; | ||
| 280 | |||
| 281 | /* Remove platform devices for JobRs */ | ||
| 282 | for (ring = 0; ring < ctrlpriv->total_jobrs; ring++) { | ||
| 283 | if (ctrlpriv->jrpdev[ring]) | ||
| 284 | of_device_unregister(ctrlpriv->jrpdev[ring]); | ||
| 285 | } | ||
| 286 | |||
| 287 | /* De-initialize RNG state handles initialized by this driver. */ | ||
| 288 | if (ctrlpriv->rng4_sh_init) | ||
| 289 | deinstantiate_rng(ctrldev, ctrlpriv->rng4_sh_init); | ||
| 290 | |||
| 291 | /* Shut down debug views */ | ||
| 292 | #ifdef CONFIG_DEBUG_FS | ||
| 293 | debugfs_remove_recursive(ctrlpriv->dfs_root); | ||
| 294 | #endif | ||
| 295 | |||
| 296 | /* Unmap controller region */ | ||
| 297 | iounmap(&topregs->ctrl); | ||
| 298 | |||
| 299 | kfree(ctrlpriv->jrpdev); | ||
| 300 | kfree(ctrlpriv); | ||
| 301 | |||
| 302 | return ret; | ||
| 303 | } | ||
| 304 | |||
| 305 | /* | ||
| 306 | * kick_trng - sets the various parameters for enabling the initialization | ||
| 307 | * of the RNG4 block in CAAM | ||
| 308 | * @pdev - pointer to the platform device | ||
| 309 | * @ent_delay - Defines the length (in system clocks) of each entropy sample. | ||
| 310 | */ | ||
| 311 | static void kick_trng(struct platform_device *pdev, int ent_delay) | ||
| 136 | { | 312 | { |
| 137 | struct device *ctrldev = &pdev->dev; | 313 | struct device *ctrldev = &pdev->dev; |
| 138 | struct caam_drv_private *ctrlpriv = dev_get_drvdata(ctrldev); | 314 | struct caam_drv_private *ctrlpriv = dev_get_drvdata(ctrldev); |
| @@ -145,14 +321,31 @@ static void kick_trng(struct platform_device *pdev) | |||
| 145 | 321 | ||
| 146 | /* put RNG4 into program mode */ | 322 | /* put RNG4 into program mode */ |
| 147 | setbits32(&r4tst->rtmctl, RTMCTL_PRGM); | 323 | setbits32(&r4tst->rtmctl, RTMCTL_PRGM); |
| 148 | /* 1600 clocks per sample */ | 324 | |
| 325 | /* | ||
| 326 | * Performance-wise, it does not make sense to | ||
| 327 | * set the delay to a value that is lower | ||
| 328 | * than the last one that worked (i.e. the state handles | ||
| 329 | * were instantiated properly. Thus, instead of wasting | ||
| 330 | * time trying to set the values controlling the sample | ||
| 331 | * frequency, the function simply returns. | ||
| 332 | */ | ||
| 333 | val = (rd_reg32(&r4tst->rtsdctl) & RTSDCTL_ENT_DLY_MASK) | ||
| 334 | >> RTSDCTL_ENT_DLY_SHIFT; | ||
| 335 | if (ent_delay <= val) { | ||
| 336 | /* put RNG4 into run mode */ | ||
| 337 | clrbits32(&r4tst->rtmctl, RTMCTL_PRGM); | ||
| 338 | return; | ||
| 339 | } | ||
| 340 | |||
| 149 | val = rd_reg32(&r4tst->rtsdctl); | 341 | val = rd_reg32(&r4tst->rtsdctl); |
| 150 | val = (val & ~RTSDCTL_ENT_DLY_MASK) | (1600 << RTSDCTL_ENT_DLY_SHIFT); | 342 | val = (val & ~RTSDCTL_ENT_DLY_MASK) | |
| 343 | (ent_delay << RTSDCTL_ENT_DLY_SHIFT); | ||
| 151 | wr_reg32(&r4tst->rtsdctl, val); | 344 | wr_reg32(&r4tst->rtsdctl, val); |
| 152 | /* min. freq. count */ | 345 | /* min. freq. count, equal to 1/4 of the entropy sample length */ |
| 153 | wr_reg32(&r4tst->rtfrqmin, 400); | 346 | wr_reg32(&r4tst->rtfrqmin, ent_delay >> 2); |
| 154 | /* max. freq. count */ | 347 | /* max. freq. count, equal to 8 times the entropy sample length */ |
| 155 | wr_reg32(&r4tst->rtfrqmax, 6400); | 348 | wr_reg32(&r4tst->rtfrqmax, ent_delay << 3); |
| 156 | /* put RNG4 into run mode */ | 349 | /* put RNG4 into run mode */ |
| 157 | clrbits32(&r4tst->rtmctl, RTMCTL_PRGM); | 350 | clrbits32(&r4tst->rtmctl, RTMCTL_PRGM); |
| 158 | } | 351 | } |
| @@ -193,7 +386,7 @@ EXPORT_SYMBOL(caam_get_era); | |||
| 193 | /* Probe routine for CAAM top (controller) level */ | 386 | /* Probe routine for CAAM top (controller) level */ |
| 194 | static int caam_probe(struct platform_device *pdev) | 387 | static int caam_probe(struct platform_device *pdev) |
| 195 | { | 388 | { |
| 196 | int ret, ring, rspec; | 389 | int ret, ring, rspec, gen_sk, ent_delay = RTSDCTL_ENT_DLY_MIN; |
| 197 | u64 caam_id; | 390 | u64 caam_id; |
| 198 | struct device *dev; | 391 | struct device *dev; |
| 199 | struct device_node *nprop, *np; | 392 | struct device_node *nprop, *np; |
| @@ -258,8 +451,9 @@ static int caam_probe(struct platform_device *pdev) | |||
| 258 | rspec++; | 451 | rspec++; |
| 259 | } | 452 | } |
| 260 | 453 | ||
| 261 | ctrlpriv->jrdev = kzalloc(sizeof(struct device *) * rspec, GFP_KERNEL); | 454 | ctrlpriv->jrpdev = kzalloc(sizeof(struct platform_device *) * rspec, |
| 262 | if (ctrlpriv->jrdev == NULL) { | 455 | GFP_KERNEL); |
| 456 | if (ctrlpriv->jrpdev == NULL) { | ||
| 263 | iounmap(&topregs->ctrl); | 457 | iounmap(&topregs->ctrl); |
| 264 | return -ENOMEM; | 458 | return -ENOMEM; |
| 265 | } | 459 | } |
| @@ -267,13 +461,24 @@ static int caam_probe(struct platform_device *pdev) | |||
| 267 | ring = 0; | 461 | ring = 0; |
| 268 | ctrlpriv->total_jobrs = 0; | 462 | ctrlpriv->total_jobrs = 0; |
| 269 | for_each_compatible_node(np, NULL, "fsl,sec-v4.0-job-ring") { | 463 | for_each_compatible_node(np, NULL, "fsl,sec-v4.0-job-ring") { |
| 270 | caam_jr_probe(pdev, np, ring); | 464 | ctrlpriv->jrpdev[ring] = |
| 465 | of_platform_device_create(np, NULL, dev); | ||
| 466 | if (!ctrlpriv->jrpdev[ring]) { | ||
| 467 | pr_warn("JR%d Platform device creation error\n", ring); | ||
| 468 | continue; | ||
| 469 | } | ||
| 271 | ctrlpriv->total_jobrs++; | 470 | ctrlpriv->total_jobrs++; |
| 272 | ring++; | 471 | ring++; |
| 273 | } | 472 | } |
| 274 | if (!ring) { | 473 | if (!ring) { |
| 275 | for_each_compatible_node(np, NULL, "fsl,sec4.0-job-ring") { | 474 | for_each_compatible_node(np, NULL, "fsl,sec4.0-job-ring") { |
| 276 | caam_jr_probe(pdev, np, ring); | 475 | ctrlpriv->jrpdev[ring] = |
| 476 | of_platform_device_create(np, NULL, dev); | ||
| 477 | if (!ctrlpriv->jrpdev[ring]) { | ||
| 478 | pr_warn("JR%d Platform device creation error\n", | ||
| 479 | ring); | ||
| 480 | continue; | ||
| 481 | } | ||
| 277 | ctrlpriv->total_jobrs++; | 482 | ctrlpriv->total_jobrs++; |
| 278 | ring++; | 483 | ring++; |
| 279 | } | 484 | } |
| @@ -299,16 +504,55 @@ static int caam_probe(struct platform_device *pdev) | |||
| 299 | 504 | ||
| 300 | /* | 505 | /* |
| 301 | * If SEC has RNG version >= 4 and RNG state handle has not been | 506 | * If SEC has RNG version >= 4 and RNG state handle has not been |
| 302 | * already instantiated ,do RNG instantiation | 507 | * already instantiated, do RNG instantiation |
| 303 | */ | 508 | */ |
| 304 | if ((cha_vid & CHA_ID_RNG_MASK) >> CHA_ID_RNG_SHIFT >= 4 && | 509 | if ((cha_vid & CHA_ID_RNG_MASK) >> CHA_ID_RNG_SHIFT >= 4) { |
| 305 | !(rd_reg32(&topregs->ctrl.r4tst[0].rdsta) & RDSTA_IF0)) { | 510 | ctrlpriv->rng4_sh_init = |
| 306 | kick_trng(pdev); | 511 | rd_reg32(&topregs->ctrl.r4tst[0].rdsta); |
| 307 | ret = instantiate_rng(dev); | 512 | /* |
| 513 | * If the secure keys (TDKEK, JDKEK, TDSK), were already | ||
| 514 | * generated, signal this to the function that is instantiating | ||
| 515 | * the state handles. An error would occur if RNG4 attempts | ||
| 516 | * to regenerate these keys before the next POR. | ||
| 517 | */ | ||
| 518 | gen_sk = ctrlpriv->rng4_sh_init & RDSTA_SKVN ? 0 : 1; | ||
| 519 | ctrlpriv->rng4_sh_init &= RDSTA_IFMASK; | ||
| 520 | do { | ||
| 521 | int inst_handles = | ||
| 522 | rd_reg32(&topregs->ctrl.r4tst[0].rdsta) & | ||
| 523 | RDSTA_IFMASK; | ||
| 524 | /* | ||
| 525 | * If either SH were instantiated by somebody else | ||
| 526 | * (e.g. u-boot) then it is assumed that the entropy | ||
| 527 | * parameters are properly set and thus the function | ||
| 528 | * setting these (kick_trng(...)) is skipped. | ||
| 529 | * Also, if a handle was instantiated, do not change | ||
| 530 | * the TRNG parameters. | ||
| 531 | */ | ||
| 532 | if (!(ctrlpriv->rng4_sh_init || inst_handles)) { | ||
| 533 | kick_trng(pdev, ent_delay); | ||
| 534 | ent_delay += 400; | ||
| 535 | } | ||
| 536 | /* | ||
| 537 | * if instantiate_rng(...) fails, the loop will rerun | ||
| 538 | * and the kick_trng(...) function will modfiy the | ||
| 539 | * upper and lower limits of the entropy sampling | ||
| 540 | * interval, leading to a sucessful initialization of | ||
| 541 | * the RNG. | ||
| 542 | */ | ||
| 543 | ret = instantiate_rng(dev, inst_handles, | ||
| 544 | gen_sk); | ||
| 545 | } while ((ret == -EAGAIN) && (ent_delay < RTSDCTL_ENT_DLY_MAX)); | ||
| 308 | if (ret) { | 546 | if (ret) { |
| 547 | dev_err(dev, "failed to instantiate RNG"); | ||
| 309 | caam_remove(pdev); | 548 | caam_remove(pdev); |
| 310 | return ret; | 549 | return ret; |
| 311 | } | 550 | } |
| 551 | /* | ||
| 552 | * Set handles init'ed by this module as the complement of the | ||
| 553 | * already initialized ones | ||
| 554 | */ | ||
| 555 | ctrlpriv->rng4_sh_init = ~ctrlpriv->rng4_sh_init & RDSTA_IFMASK; | ||
| 312 | 556 | ||
| 313 | /* Enable RDB bit so that RNG works faster */ | 557 | /* Enable RDB bit so that RNG works faster */ |
| 314 | setbits32(&topregs->ctrl.scfgr, SCFGR_RDBENABLE); | 558 | setbits32(&topregs->ctrl.scfgr, SCFGR_RDBENABLE); |
diff --git a/drivers/crypto/caam/desc.h b/drivers/crypto/caam/desc.h index 53b296f78b0d..7e4500f18df6 100644 --- a/drivers/crypto/caam/desc.h +++ b/drivers/crypto/caam/desc.h | |||
| @@ -1155,8 +1155,15 @@ struct sec4_sg_entry { | |||
| 1155 | 1155 | ||
| 1156 | /* randomizer AAI set */ | 1156 | /* randomizer AAI set */ |
| 1157 | #define OP_ALG_AAI_RNG (0x00 << OP_ALG_AAI_SHIFT) | 1157 | #define OP_ALG_AAI_RNG (0x00 << OP_ALG_AAI_SHIFT) |
| 1158 | #define OP_ALG_AAI_RNG_NOZERO (0x10 << OP_ALG_AAI_SHIFT) | 1158 | #define OP_ALG_AAI_RNG_NZB (0x10 << OP_ALG_AAI_SHIFT) |
| 1159 | #define OP_ALG_AAI_RNG_ODD (0x20 << OP_ALG_AAI_SHIFT) | 1159 | #define OP_ALG_AAI_RNG_OBP (0x20 << OP_ALG_AAI_SHIFT) |
| 1160 | |||
| 1161 | /* RNG4 AAI set */ | ||
| 1162 | #define OP_ALG_AAI_RNG4_SH_0 (0x00 << OP_ALG_AAI_SHIFT) | ||
| 1163 | #define OP_ALG_AAI_RNG4_SH_1 (0x01 << OP_ALG_AAI_SHIFT) | ||
| 1164 | #define OP_ALG_AAI_RNG4_PS (0x40 << OP_ALG_AAI_SHIFT) | ||
| 1165 | #define OP_ALG_AAI_RNG4_AI (0x80 << OP_ALG_AAI_SHIFT) | ||
| 1166 | #define OP_ALG_AAI_RNG4_SK (0x100 << OP_ALG_AAI_SHIFT) | ||
| 1160 | 1167 | ||
| 1161 | /* hmac/smac AAI set */ | 1168 | /* hmac/smac AAI set */ |
| 1162 | #define OP_ALG_AAI_HASH (0x00 << OP_ALG_AAI_SHIFT) | 1169 | #define OP_ALG_AAI_HASH (0x00 << OP_ALG_AAI_SHIFT) |
| @@ -1178,12 +1185,6 @@ struct sec4_sg_entry { | |||
| 1178 | #define OP_ALG_AAI_GSM (0x10 << OP_ALG_AAI_SHIFT) | 1185 | #define OP_ALG_AAI_GSM (0x10 << OP_ALG_AAI_SHIFT) |
| 1179 | #define OP_ALG_AAI_EDGE (0x20 << OP_ALG_AAI_SHIFT) | 1186 | #define OP_ALG_AAI_EDGE (0x20 << OP_ALG_AAI_SHIFT) |
| 1180 | 1187 | ||
| 1181 | /* RNG4 set */ | ||
| 1182 | #define OP_ALG_RNG4_SHIFT 4 | ||
| 1183 | #define OP_ALG_RNG4_MASK (0x1f3 << OP_ALG_RNG4_SHIFT) | ||
| 1184 | |||
| 1185 | #define OP_ALG_RNG4_SK (0x100 << OP_ALG_RNG4_SHIFT) | ||
| 1186 | |||
| 1187 | #define OP_ALG_AS_SHIFT 2 | 1188 | #define OP_ALG_AS_SHIFT 2 |
| 1188 | #define OP_ALG_AS_MASK (0x3 << OP_ALG_AS_SHIFT) | 1189 | #define OP_ALG_AS_MASK (0x3 << OP_ALG_AS_SHIFT) |
| 1189 | #define OP_ALG_AS_UPDATE (0 << OP_ALG_AS_SHIFT) | 1190 | #define OP_ALG_AS_UPDATE (0 << OP_ALG_AS_SHIFT) |
diff --git a/drivers/crypto/caam/intern.h b/drivers/crypto/caam/intern.h index 34c4b9f7fbfa..6d85fcc5bd0a 100644 --- a/drivers/crypto/caam/intern.h +++ b/drivers/crypto/caam/intern.h | |||
| @@ -37,13 +37,16 @@ struct caam_jrentry_info { | |||
| 37 | 37 | ||
| 38 | /* Private sub-storage for a single JobR */ | 38 | /* Private sub-storage for a single JobR */ |
| 39 | struct caam_drv_private_jr { | 39 | struct caam_drv_private_jr { |
| 40 | struct device *parentdev; /* points back to controller dev */ | 40 | struct list_head list_node; /* Job Ring device list */ |
| 41 | struct platform_device *jr_pdev;/* points to platform device for JR */ | 41 | struct device *dev; |
| 42 | int ridx; | 42 | int ridx; |
| 43 | struct caam_job_ring __iomem *rregs; /* JobR's register space */ | 43 | struct caam_job_ring __iomem *rregs; /* JobR's register space */ |
| 44 | struct tasklet_struct irqtask; | 44 | struct tasklet_struct irqtask; |
| 45 | int irq; /* One per queue */ | 45 | int irq; /* One per queue */ |
| 46 | 46 | ||
| 47 | /* Number of scatterlist crypt transforms active on the JobR */ | ||
| 48 | atomic_t tfm_count ____cacheline_aligned; | ||
| 49 | |||
| 47 | /* Job ring info */ | 50 | /* Job ring info */ |
| 48 | int ringsize; /* Size of rings (assume input = output) */ | 51 | int ringsize; /* Size of rings (assume input = output) */ |
| 49 | struct caam_jrentry_info *entinfo; /* Alloc'ed 1 per ring entry */ | 52 | struct caam_jrentry_info *entinfo; /* Alloc'ed 1 per ring entry */ |
| @@ -63,7 +66,7 @@ struct caam_drv_private_jr { | |||
| 63 | struct caam_drv_private { | 66 | struct caam_drv_private { |
| 64 | 67 | ||
| 65 | struct device *dev; | 68 | struct device *dev; |
| 66 | struct device **jrdev; /* Alloc'ed array per sub-device */ | 69 | struct platform_device **jrpdev; /* Alloc'ed array per sub-device */ |
| 67 | struct platform_device *pdev; | 70 | struct platform_device *pdev; |
| 68 | 71 | ||
| 69 | /* Physical-presence section */ | 72 | /* Physical-presence section */ |
| @@ -80,12 +83,11 @@ struct caam_drv_private { | |||
| 80 | u8 qi_present; /* Nonzero if QI present in device */ | 83 | u8 qi_present; /* Nonzero if QI present in device */ |
| 81 | int secvio_irq; /* Security violation interrupt number */ | 84 | int secvio_irq; /* Security violation interrupt number */ |
| 82 | 85 | ||
| 83 | /* which jr allocated to scatterlist crypto */ | 86 | #define RNG4_MAX_HANDLES 2 |
| 84 | atomic_t tfm_count ____cacheline_aligned; | 87 | /* RNG4 block */ |
| 85 | /* list of registered crypto algorithms (mk generic context handle?) */ | 88 | u32 rng4_sh_init; /* This bitmap shows which of the State |
| 86 | struct list_head alg_list; | 89 | Handles of the RNG4 block are initialized |
| 87 | /* list of registered hash algorithms (mk generic context handle?) */ | 90 | by this driver */ |
| 88 | struct list_head hash_list; | ||
| 89 | 91 | ||
| 90 | /* | 92 | /* |
| 91 | * debugfs entries for developer view into driver/device | 93 | * debugfs entries for developer view into driver/device |
diff --git a/drivers/crypto/caam/jr.c b/drivers/crypto/caam/jr.c index bdb786d5a5e5..1d80bd3636c5 100644 --- a/drivers/crypto/caam/jr.c +++ b/drivers/crypto/caam/jr.c | |||
| @@ -6,6 +6,7 @@ | |||
| 6 | */ | 6 | */ |
| 7 | 7 | ||
| 8 | #include <linux/of_irq.h> | 8 | #include <linux/of_irq.h> |
| 9 | #include <linux/of_address.h> | ||
| 9 | 10 | ||
| 10 | #include "compat.h" | 11 | #include "compat.h" |
| 11 | #include "regs.h" | 12 | #include "regs.h" |
| @@ -13,6 +14,113 @@ | |||
| 13 | #include "desc.h" | 14 | #include "desc.h" |
| 14 | #include "intern.h" | 15 | #include "intern.h" |
| 15 | 16 | ||
| 17 | struct jr_driver_data { | ||
| 18 | /* List of Physical JobR's with the Driver */ | ||
| 19 | struct list_head jr_list; | ||
| 20 | spinlock_t jr_alloc_lock; /* jr_list lock */ | ||
| 21 | } ____cacheline_aligned; | ||
| 22 | |||
| 23 | static struct jr_driver_data driver_data; | ||
| 24 | |||
| 25 | static int caam_reset_hw_jr(struct device *dev) | ||
| 26 | { | ||
| 27 | struct caam_drv_private_jr *jrp = dev_get_drvdata(dev); | ||
| 28 | unsigned int timeout = 100000; | ||
| 29 | |||
| 30 | /* | ||
| 31 | * mask interrupts since we are going to poll | ||
| 32 | * for reset completion status | ||
| 33 | */ | ||
| 34 | setbits32(&jrp->rregs->rconfig_lo, JRCFG_IMSK); | ||
| 35 | |||
| 36 | /* initiate flush (required prior to reset) */ | ||
| 37 | wr_reg32(&jrp->rregs->jrcommand, JRCR_RESET); | ||
| 38 | while (((rd_reg32(&jrp->rregs->jrintstatus) & JRINT_ERR_HALT_MASK) == | ||
| 39 | JRINT_ERR_HALT_INPROGRESS) && --timeout) | ||
| 40 | cpu_relax(); | ||
| 41 | |||
| 42 | if ((rd_reg32(&jrp->rregs->jrintstatus) & JRINT_ERR_HALT_MASK) != | ||
| 43 | JRINT_ERR_HALT_COMPLETE || timeout == 0) { | ||
| 44 | dev_err(dev, "failed to flush job ring %d\n", jrp->ridx); | ||
| 45 | return -EIO; | ||
| 46 | } | ||
| 47 | |||
| 48 | /* initiate reset */ | ||
| 49 | timeout = 100000; | ||
| 50 | wr_reg32(&jrp->rregs->jrcommand, JRCR_RESET); | ||
| 51 | while ((rd_reg32(&jrp->rregs->jrcommand) & JRCR_RESET) && --timeout) | ||
| 52 | cpu_relax(); | ||
| 53 | |||
| 54 | if (timeout == 0) { | ||
| 55 | dev_err(dev, "failed to reset job ring %d\n", jrp->ridx); | ||
| 56 | return -EIO; | ||
| 57 | } | ||
| 58 | |||
| 59 | /* unmask interrupts */ | ||
| 60 | clrbits32(&jrp->rregs->rconfig_lo, JRCFG_IMSK); | ||
| 61 | |||
| 62 | return 0; | ||
| 63 | } | ||
| 64 | |||
| 65 | /* | ||
| 66 | * Shutdown JobR independent of platform property code | ||
| 67 | */ | ||
| 68 | int caam_jr_shutdown(struct device *dev) | ||
| 69 | { | ||
| 70 | struct caam_drv_private_jr *jrp = dev_get_drvdata(dev); | ||
| 71 | dma_addr_t inpbusaddr, outbusaddr; | ||
| 72 | int ret; | ||
| 73 | |||
| 74 | ret = caam_reset_hw_jr(dev); | ||
| 75 | |||
| 76 | tasklet_kill(&jrp->irqtask); | ||
| 77 | |||
| 78 | /* Release interrupt */ | ||
| 79 | free_irq(jrp->irq, dev); | ||
| 80 | |||
| 81 | /* Free rings */ | ||
| 82 | inpbusaddr = rd_reg64(&jrp->rregs->inpring_base); | ||
| 83 | outbusaddr = rd_reg64(&jrp->rregs->outring_base); | ||
| 84 | dma_free_coherent(dev, sizeof(dma_addr_t) * JOBR_DEPTH, | ||
| 85 | jrp->inpring, inpbusaddr); | ||
| 86 | dma_free_coherent(dev, sizeof(struct jr_outentry) * JOBR_DEPTH, | ||
| 87 | jrp->outring, outbusaddr); | ||
| 88 | kfree(jrp->entinfo); | ||
| 89 | |||
| 90 | return ret; | ||
| 91 | } | ||
| 92 | |||
| 93 | static int caam_jr_remove(struct platform_device *pdev) | ||
| 94 | { | ||
| 95 | int ret; | ||
| 96 | struct device *jrdev; | ||
| 97 | struct caam_drv_private_jr *jrpriv; | ||
| 98 | |||
| 99 | jrdev = &pdev->dev; | ||
| 100 | jrpriv = dev_get_drvdata(jrdev); | ||
| 101 | |||
| 102 | /* | ||
| 103 | * Return EBUSY if job ring already allocated. | ||
| 104 | */ | ||
| 105 | if (atomic_read(&jrpriv->tfm_count)) { | ||
| 106 | dev_err(jrdev, "Device is busy\n"); | ||
| 107 | return -EBUSY; | ||
| 108 | } | ||
| 109 | |||
| 110 | /* Remove the node from Physical JobR list maintained by driver */ | ||
| 111 | spin_lock(&driver_data.jr_alloc_lock); | ||
| 112 | list_del(&jrpriv->list_node); | ||
| 113 | spin_unlock(&driver_data.jr_alloc_lock); | ||
| 114 | |||
| 115 | /* Release ring */ | ||
| 116 | ret = caam_jr_shutdown(jrdev); | ||
| 117 | if (ret) | ||
| 118 | dev_err(jrdev, "Failed to shut down job ring\n"); | ||
| 119 | irq_dispose_mapping(jrpriv->irq); | ||
| 120 | |||
| 121 | return ret; | ||
| 122 | } | ||
| 123 | |||
| 16 | /* Main per-ring interrupt handler */ | 124 | /* Main per-ring interrupt handler */ |
| 17 | static irqreturn_t caam_jr_interrupt(int irq, void *st_dev) | 125 | static irqreturn_t caam_jr_interrupt(int irq, void *st_dev) |
| 18 | { | 126 | { |
| @@ -128,6 +236,59 @@ static void caam_jr_dequeue(unsigned long devarg) | |||
| 128 | } | 236 | } |
| 129 | 237 | ||
| 130 | /** | 238 | /** |
| 239 | * caam_jr_alloc() - Alloc a job ring for someone to use as needed. | ||
| 240 | * | ||
| 241 | * returns : pointer to the newly allocated physical | ||
| 242 | * JobR dev can be written to if successful. | ||
| 243 | **/ | ||
| 244 | struct device *caam_jr_alloc(void) | ||
| 245 | { | ||
| 246 | struct caam_drv_private_jr *jrpriv, *min_jrpriv = NULL; | ||
| 247 | struct device *dev = NULL; | ||
| 248 | int min_tfm_cnt = INT_MAX; | ||
| 249 | int tfm_cnt; | ||
| 250 | |||
| 251 | spin_lock(&driver_data.jr_alloc_lock); | ||
| 252 | |||
| 253 | if (list_empty(&driver_data.jr_list)) { | ||
| 254 | spin_unlock(&driver_data.jr_alloc_lock); | ||
| 255 | return ERR_PTR(-ENODEV); | ||
| 256 | } | ||
| 257 | |||
| 258 | list_for_each_entry(jrpriv, &driver_data.jr_list, list_node) { | ||
| 259 | tfm_cnt = atomic_read(&jrpriv->tfm_count); | ||
| 260 | if (tfm_cnt < min_tfm_cnt) { | ||
| 261 | min_tfm_cnt = tfm_cnt; | ||
| 262 | min_jrpriv = jrpriv; | ||
| 263 | } | ||
| 264 | if (!min_tfm_cnt) | ||
| 265 | break; | ||
| 266 | } | ||
| 267 | |||
| 268 | if (min_jrpriv) { | ||
| 269 | atomic_inc(&min_jrpriv->tfm_count); | ||
| 270 | dev = min_jrpriv->dev; | ||
| 271 | } | ||
| 272 | spin_unlock(&driver_data.jr_alloc_lock); | ||
| 273 | |||
| 274 | return dev; | ||
| 275 | } | ||
| 276 | EXPORT_SYMBOL(caam_jr_alloc); | ||
| 277 | |||
| 278 | /** | ||
| 279 | * caam_jr_free() - Free the Job Ring | ||
| 280 | * @rdev - points to the dev that identifies the Job ring to | ||
| 281 | * be released. | ||
| 282 | **/ | ||
| 283 | void caam_jr_free(struct device *rdev) | ||
| 284 | { | ||
| 285 | struct caam_drv_private_jr *jrpriv = dev_get_drvdata(rdev); | ||
| 286 | |||
| 287 | atomic_dec(&jrpriv->tfm_count); | ||
| 288 | } | ||
| 289 | EXPORT_SYMBOL(caam_jr_free); | ||
| 290 | |||
| 291 | /** | ||
| 131 | * caam_jr_enqueue() - Enqueue a job descriptor head. Returns 0 if OK, | 292 | * caam_jr_enqueue() - Enqueue a job descriptor head. Returns 0 if OK, |
| 132 | * -EBUSY if the queue is full, -EIO if it cannot map the caller's | 293 | * -EBUSY if the queue is full, -EIO if it cannot map the caller's |
| 133 | * descriptor. | 294 | * descriptor. |
| @@ -207,46 +368,6 @@ int caam_jr_enqueue(struct device *dev, u32 *desc, | |||
| 207 | } | 368 | } |
| 208 | EXPORT_SYMBOL(caam_jr_enqueue); | 369 | EXPORT_SYMBOL(caam_jr_enqueue); |
| 209 | 370 | ||
| 210 | static int caam_reset_hw_jr(struct device *dev) | ||
| 211 | { | ||
| 212 | struct caam_drv_private_jr *jrp = dev_get_drvdata(dev); | ||
| 213 | unsigned int timeout = 100000; | ||
| 214 | |||
| 215 | /* | ||
| 216 | * mask interrupts since we are going to poll | ||
| 217 | * for reset completion status | ||
| 218 | */ | ||
| 219 | setbits32(&jrp->rregs->rconfig_lo, JRCFG_IMSK); | ||
| 220 | |||
| 221 | /* initiate flush (required prior to reset) */ | ||
| 222 | wr_reg32(&jrp->rregs->jrcommand, JRCR_RESET); | ||
| 223 | while (((rd_reg32(&jrp->rregs->jrintstatus) & JRINT_ERR_HALT_MASK) == | ||
| 224 | JRINT_ERR_HALT_INPROGRESS) && --timeout) | ||
| 225 | cpu_relax(); | ||
| 226 | |||
| 227 | if ((rd_reg32(&jrp->rregs->jrintstatus) & JRINT_ERR_HALT_MASK) != | ||
| 228 | JRINT_ERR_HALT_COMPLETE || timeout == 0) { | ||
| 229 | dev_err(dev, "failed to flush job ring %d\n", jrp->ridx); | ||
| 230 | return -EIO; | ||
| 231 | } | ||
| 232 | |||
| 233 | /* initiate reset */ | ||
| 234 | timeout = 100000; | ||
| 235 | wr_reg32(&jrp->rregs->jrcommand, JRCR_RESET); | ||
| 236 | while ((rd_reg32(&jrp->rregs->jrcommand) & JRCR_RESET) && --timeout) | ||
| 237 | cpu_relax(); | ||
| 238 | |||
| 239 | if (timeout == 0) { | ||
| 240 | dev_err(dev, "failed to reset job ring %d\n", jrp->ridx); | ||
| 241 | return -EIO; | ||
| 242 | } | ||
| 243 | |||
| 244 | /* unmask interrupts */ | ||
| 245 | clrbits32(&jrp->rregs->rconfig_lo, JRCFG_IMSK); | ||
| 246 | |||
| 247 | return 0; | ||
| 248 | } | ||
| 249 | |||
| 250 | /* | 371 | /* |
| 251 | * Init JobR independent of platform property detection | 372 | * Init JobR independent of platform property detection |
| 252 | */ | 373 | */ |
| @@ -262,7 +383,7 @@ static int caam_jr_init(struct device *dev) | |||
| 262 | 383 | ||
| 263 | /* Connect job ring interrupt handler. */ | 384 | /* Connect job ring interrupt handler. */ |
| 264 | error = request_irq(jrp->irq, caam_jr_interrupt, IRQF_SHARED, | 385 | error = request_irq(jrp->irq, caam_jr_interrupt, IRQF_SHARED, |
| 265 | "caam-jobr", dev); | 386 | dev_name(dev), dev); |
| 266 | if (error) { | 387 | if (error) { |
| 267 | dev_err(dev, "can't connect JobR %d interrupt (%d)\n", | 388 | dev_err(dev, "can't connect JobR %d interrupt (%d)\n", |
| 268 | jrp->ridx, jrp->irq); | 389 | jrp->ridx, jrp->irq); |
| @@ -318,86 +439,43 @@ static int caam_jr_init(struct device *dev) | |||
| 318 | return 0; | 439 | return 0; |
| 319 | } | 440 | } |
| 320 | 441 | ||
| 321 | /* | ||
| 322 | * Shutdown JobR independent of platform property code | ||
| 323 | */ | ||
| 324 | int caam_jr_shutdown(struct device *dev) | ||
| 325 | { | ||
| 326 | struct caam_drv_private_jr *jrp = dev_get_drvdata(dev); | ||
| 327 | dma_addr_t inpbusaddr, outbusaddr; | ||
| 328 | int ret; | ||
| 329 | |||
| 330 | ret = caam_reset_hw_jr(dev); | ||
| 331 | |||
| 332 | tasklet_kill(&jrp->irqtask); | ||
| 333 | |||
| 334 | /* Release interrupt */ | ||
| 335 | free_irq(jrp->irq, dev); | ||
| 336 | |||
| 337 | /* Free rings */ | ||
| 338 | inpbusaddr = rd_reg64(&jrp->rregs->inpring_base); | ||
| 339 | outbusaddr = rd_reg64(&jrp->rregs->outring_base); | ||
| 340 | dma_free_coherent(dev, sizeof(dma_addr_t) * JOBR_DEPTH, | ||
| 341 | jrp->inpring, inpbusaddr); | ||
| 342 | dma_free_coherent(dev, sizeof(struct jr_outentry) * JOBR_DEPTH, | ||
| 343 | jrp->outring, outbusaddr); | ||
| 344 | kfree(jrp->entinfo); | ||
| 345 | of_device_unregister(jrp->jr_pdev); | ||
| 346 | |||
| 347 | return ret; | ||
| 348 | } | ||
| 349 | 442 | ||
| 350 | /* | 443 | /* |
| 351 | * Probe routine for each detected JobR subsystem. It assumes that | 444 | * Probe routine for each detected JobR subsystem. |
| 352 | * property detection was picked up externally. | ||
| 353 | */ | 445 | */ |
| 354 | int caam_jr_probe(struct platform_device *pdev, struct device_node *np, | 446 | static int caam_jr_probe(struct platform_device *pdev) |
| 355 | int ring) | ||
| 356 | { | 447 | { |
| 357 | struct device *ctrldev, *jrdev; | 448 | struct device *jrdev; |
| 358 | struct platform_device *jr_pdev; | 449 | struct device_node *nprop; |
| 359 | struct caam_drv_private *ctrlpriv; | 450 | struct caam_job_ring __iomem *ctrl; |
| 360 | struct caam_drv_private_jr *jrpriv; | 451 | struct caam_drv_private_jr *jrpriv; |
| 361 | u32 *jroffset; | 452 | static int total_jobrs; |
| 362 | int error; | 453 | int error; |
| 363 | 454 | ||
| 364 | ctrldev = &pdev->dev; | 455 | jrdev = &pdev->dev; |
| 365 | ctrlpriv = dev_get_drvdata(ctrldev); | ||
| 366 | |||
| 367 | jrpriv = kmalloc(sizeof(struct caam_drv_private_jr), | 456 | jrpriv = kmalloc(sizeof(struct caam_drv_private_jr), |
| 368 | GFP_KERNEL); | 457 | GFP_KERNEL); |
| 369 | if (jrpriv == NULL) { | 458 | if (!jrpriv) |
| 370 | dev_err(ctrldev, "can't alloc private mem for job ring %d\n", | ||
| 371 | ring); | ||
| 372 | return -ENOMEM; | 459 | return -ENOMEM; |
| 373 | } | ||
| 374 | jrpriv->parentdev = ctrldev; /* point back to parent */ | ||
| 375 | jrpriv->ridx = ring; /* save ring identity relative to detection */ | ||
| 376 | 460 | ||
| 377 | /* | 461 | dev_set_drvdata(jrdev, jrpriv); |
| 378 | * Derive a pointer to the detected JobRs regs | ||
| 379 | * Driver has already iomapped the entire space, we just | ||
| 380 | * need to add in the offset to this JobR. Don't know if I | ||
| 381 | * like this long-term, but it'll run | ||
| 382 | */ | ||
| 383 | jroffset = (u32 *)of_get_property(np, "reg", NULL); | ||
| 384 | jrpriv->rregs = (struct caam_job_ring __iomem *)((void *)ctrlpriv->ctrl | ||
| 385 | + *jroffset); | ||
| 386 | 462 | ||
| 387 | /* Build a local dev for each detected queue */ | 463 | /* save ring identity relative to detection */ |
| 388 | jr_pdev = of_platform_device_create(np, NULL, ctrldev); | 464 | jrpriv->ridx = total_jobrs++; |
| 389 | if (jr_pdev == NULL) { | 465 | |
| 390 | kfree(jrpriv); | 466 | nprop = pdev->dev.of_node; |
| 391 | return -EINVAL; | 467 | /* Get configuration properties from device tree */ |
| 468 | /* First, get register page */ | ||
| 469 | ctrl = of_iomap(nprop, 0); | ||
| 470 | if (!ctrl) { | ||
| 471 | dev_err(jrdev, "of_iomap() failed\n"); | ||
| 472 | return -ENOMEM; | ||
| 392 | } | 473 | } |
| 393 | 474 | ||
| 394 | jrpriv->jr_pdev = jr_pdev; | 475 | jrpriv->rregs = (struct caam_job_ring __force *)ctrl; |
| 395 | jrdev = &jr_pdev->dev; | ||
| 396 | dev_set_drvdata(jrdev, jrpriv); | ||
| 397 | ctrlpriv->jrdev[ring] = jrdev; | ||
| 398 | 476 | ||
| 399 | if (sizeof(dma_addr_t) == sizeof(u64)) | 477 | if (sizeof(dma_addr_t) == sizeof(u64)) |
| 400 | if (of_device_is_compatible(np, "fsl,sec-v5.0-job-ring")) | 478 | if (of_device_is_compatible(nprop, "fsl,sec-v5.0-job-ring")) |
| 401 | dma_set_mask(jrdev, DMA_BIT_MASK(40)); | 479 | dma_set_mask(jrdev, DMA_BIT_MASK(40)); |
| 402 | else | 480 | else |
| 403 | dma_set_mask(jrdev, DMA_BIT_MASK(36)); | 481 | dma_set_mask(jrdev, DMA_BIT_MASK(36)); |
| @@ -405,15 +483,61 @@ int caam_jr_probe(struct platform_device *pdev, struct device_node *np, | |||
| 405 | dma_set_mask(jrdev, DMA_BIT_MASK(32)); | 483 | dma_set_mask(jrdev, DMA_BIT_MASK(32)); |
| 406 | 484 | ||
| 407 | /* Identify the interrupt */ | 485 | /* Identify the interrupt */ |
| 408 | jrpriv->irq = irq_of_parse_and_map(np, 0); | 486 | jrpriv->irq = irq_of_parse_and_map(nprop, 0); |
| 409 | 487 | ||
| 410 | /* Now do the platform independent part */ | 488 | /* Now do the platform independent part */ |
| 411 | error = caam_jr_init(jrdev); /* now turn on hardware */ | 489 | error = caam_jr_init(jrdev); /* now turn on hardware */ |
| 412 | if (error) { | 490 | if (error) { |
| 413 | of_device_unregister(jr_pdev); | ||
| 414 | kfree(jrpriv); | 491 | kfree(jrpriv); |
| 415 | return error; | 492 | return error; |
| 416 | } | 493 | } |
| 417 | 494 | ||
| 418 | return error; | 495 | jrpriv->dev = jrdev; |
| 496 | spin_lock(&driver_data.jr_alloc_lock); | ||
| 497 | list_add_tail(&jrpriv->list_node, &driver_data.jr_list); | ||
| 498 | spin_unlock(&driver_data.jr_alloc_lock); | ||
| 499 | |||
| 500 | atomic_set(&jrpriv->tfm_count, 0); | ||
| 501 | |||
| 502 | return 0; | ||
| 503 | } | ||
| 504 | |||
| 505 | static struct of_device_id caam_jr_match[] = { | ||
| 506 | { | ||
| 507 | .compatible = "fsl,sec-v4.0-job-ring", | ||
| 508 | }, | ||
| 509 | { | ||
| 510 | .compatible = "fsl,sec4.0-job-ring", | ||
| 511 | }, | ||
| 512 | {}, | ||
| 513 | }; | ||
| 514 | MODULE_DEVICE_TABLE(of, caam_jr_match); | ||
| 515 | |||
| 516 | static struct platform_driver caam_jr_driver = { | ||
| 517 | .driver = { | ||
| 518 | .name = "caam_jr", | ||
| 519 | .owner = THIS_MODULE, | ||
| 520 | .of_match_table = caam_jr_match, | ||
| 521 | }, | ||
| 522 | .probe = caam_jr_probe, | ||
| 523 | .remove = caam_jr_remove, | ||
| 524 | }; | ||
| 525 | |||
| 526 | static int __init jr_driver_init(void) | ||
| 527 | { | ||
| 528 | spin_lock_init(&driver_data.jr_alloc_lock); | ||
| 529 | INIT_LIST_HEAD(&driver_data.jr_list); | ||
| 530 | return platform_driver_register(&caam_jr_driver); | ||
| 531 | } | ||
| 532 | |||
| 533 | static void __exit jr_driver_exit(void) | ||
| 534 | { | ||
| 535 | platform_driver_unregister(&caam_jr_driver); | ||
| 419 | } | 536 | } |
| 537 | |||
| 538 | module_init(jr_driver_init); | ||
| 539 | module_exit(jr_driver_exit); | ||
| 540 | |||
| 541 | MODULE_LICENSE("GPL"); | ||
| 542 | MODULE_DESCRIPTION("FSL CAAM JR request backend"); | ||
| 543 | MODULE_AUTHOR("Freescale Semiconductor - NMG/STC"); | ||
diff --git a/drivers/crypto/caam/jr.h b/drivers/crypto/caam/jr.h index 9d8741a59037..97113a6d6c58 100644 --- a/drivers/crypto/caam/jr.h +++ b/drivers/crypto/caam/jr.h | |||
| @@ -8,12 +8,11 @@ | |||
| 8 | #define JR_H | 8 | #define JR_H |
| 9 | 9 | ||
| 10 | /* Prototypes for backend-level services exposed to APIs */ | 10 | /* Prototypes for backend-level services exposed to APIs */ |
| 11 | struct device *caam_jr_alloc(void); | ||
| 12 | void caam_jr_free(struct device *rdev); | ||
| 11 | int caam_jr_enqueue(struct device *dev, u32 *desc, | 13 | int caam_jr_enqueue(struct device *dev, u32 *desc, |
| 12 | void (*cbk)(struct device *dev, u32 *desc, u32 status, | 14 | void (*cbk)(struct device *dev, u32 *desc, u32 status, |
| 13 | void *areq), | 15 | void *areq), |
| 14 | void *areq); | 16 | void *areq); |
| 15 | 17 | ||
| 16 | extern int caam_jr_probe(struct platform_device *pdev, struct device_node *np, | ||
| 17 | int ring); | ||
| 18 | extern int caam_jr_shutdown(struct device *dev); | ||
| 19 | #endif /* JR_H */ | 18 | #endif /* JR_H */ |
diff --git a/drivers/crypto/caam/regs.h b/drivers/crypto/caam/regs.h index 4455396918de..d50174f45b21 100644 --- a/drivers/crypto/caam/regs.h +++ b/drivers/crypto/caam/regs.h | |||
| @@ -245,7 +245,7 @@ struct rngtst { | |||
| 245 | 245 | ||
| 246 | /* RNG4 TRNG test registers */ | 246 | /* RNG4 TRNG test registers */ |
| 247 | struct rng4tst { | 247 | struct rng4tst { |
| 248 | #define RTMCTL_PRGM 0x00010000 /* 1 -> program mode, 0 -> run mode */ | 248 | #define RTMCTL_PRGM 0x00010000 /* 1 -> program mode, 0 -> run mode */ |
| 249 | u32 rtmctl; /* misc. control register */ | 249 | u32 rtmctl; /* misc. control register */ |
| 250 | u32 rtscmisc; /* statistical check misc. register */ | 250 | u32 rtscmisc; /* statistical check misc. register */ |
| 251 | u32 rtpkrrng; /* poker range register */ | 251 | u32 rtpkrrng; /* poker range register */ |
| @@ -255,6 +255,8 @@ struct rng4tst { | |||
| 255 | }; | 255 | }; |
| 256 | #define RTSDCTL_ENT_DLY_SHIFT 16 | 256 | #define RTSDCTL_ENT_DLY_SHIFT 16 |
| 257 | #define RTSDCTL_ENT_DLY_MASK (0xffff << RTSDCTL_ENT_DLY_SHIFT) | 257 | #define RTSDCTL_ENT_DLY_MASK (0xffff << RTSDCTL_ENT_DLY_SHIFT) |
| 258 | #define RTSDCTL_ENT_DLY_MIN 1200 | ||
| 259 | #define RTSDCTL_ENT_DLY_MAX 12800 | ||
| 258 | u32 rtsdctl; /* seed control register */ | 260 | u32 rtsdctl; /* seed control register */ |
| 259 | union { | 261 | union { |
| 260 | u32 rtsblim; /* PRGM=1: sparse bit limit register */ | 262 | u32 rtsblim; /* PRGM=1: sparse bit limit register */ |
| @@ -266,7 +268,11 @@ struct rng4tst { | |||
| 266 | u32 rtfrqcnt; /* PRGM=0: freq. count register */ | 268 | u32 rtfrqcnt; /* PRGM=0: freq. count register */ |
| 267 | }; | 269 | }; |
| 268 | u32 rsvd1[40]; | 270 | u32 rsvd1[40]; |
| 271 | #define RDSTA_SKVT 0x80000000 | ||
| 272 | #define RDSTA_SKVN 0x40000000 | ||
| 269 | #define RDSTA_IF0 0x00000001 | 273 | #define RDSTA_IF0 0x00000001 |
| 274 | #define RDSTA_IF1 0x00000002 | ||
| 275 | #define RDSTA_IFMASK (RDSTA_IF1 | RDSTA_IF0) | ||
| 270 | u32 rdsta; | 276 | u32 rdsta; |
| 271 | u32 rsvd2[15]; | 277 | u32 rsvd2[15]; |
| 272 | }; | 278 | }; |
| @@ -692,6 +698,7 @@ struct caam_deco { | |||
| 692 | u32 jr_ctl_hi; /* CxJRR - JobR Control Register @800 */ | 698 | u32 jr_ctl_hi; /* CxJRR - JobR Control Register @800 */ |
| 693 | u32 jr_ctl_lo; | 699 | u32 jr_ctl_lo; |
| 694 | u64 jr_descaddr; /* CxDADR - JobR Descriptor Address */ | 700 | u64 jr_descaddr; /* CxDADR - JobR Descriptor Address */ |
| 701 | #define DECO_OP_STATUS_HI_ERR_MASK 0xF00000FF | ||
| 695 | u32 op_status_hi; /* DxOPSTA - DECO Operation Status */ | 702 | u32 op_status_hi; /* DxOPSTA - DECO Operation Status */ |
| 696 | u32 op_status_lo; | 703 | u32 op_status_lo; |
| 697 | u32 rsvd24[2]; | 704 | u32 rsvd24[2]; |
| @@ -706,12 +713,13 @@ struct caam_deco { | |||
| 706 | u32 rsvd29[48]; | 713 | u32 rsvd29[48]; |
| 707 | u32 descbuf[64]; /* DxDESB - Descriptor buffer */ | 714 | u32 descbuf[64]; /* DxDESB - Descriptor buffer */ |
| 708 | u32 rscvd30[193]; | 715 | u32 rscvd30[193]; |
| 716 | #define DESC_DBG_DECO_STAT_HOST_ERR 0x00D00000 | ||
| 717 | #define DESC_DBG_DECO_STAT_VALID 0x80000000 | ||
| 718 | #define DESC_DBG_DECO_STAT_MASK 0x00F00000 | ||
| 709 | u32 desc_dbg; /* DxDDR - DECO Debug Register */ | 719 | u32 desc_dbg; /* DxDDR - DECO Debug Register */ |
| 710 | u32 rsvd31[126]; | 720 | u32 rsvd31[126]; |
| 711 | }; | 721 | }; |
| 712 | 722 | ||
| 713 | /* DECO DBG Register Valid Bit*/ | ||
| 714 | #define DECO_DBG_VALID 0x80000000 | ||
| 715 | #define DECO_JQCR_WHL 0x20000000 | 723 | #define DECO_JQCR_WHL 0x20000000 |
| 716 | #define DECO_JQCR_FOUR 0x10000000 | 724 | #define DECO_JQCR_FOUR 0x10000000 |
| 717 | 725 | ||
diff --git a/drivers/crypto/caam/sg_sw_sec4.h b/drivers/crypto/caam/sg_sw_sec4.h index e0037c8ee243..b12ff85f4241 100644 --- a/drivers/crypto/caam/sg_sw_sec4.h +++ b/drivers/crypto/caam/sg_sw_sec4.h | |||
| @@ -117,6 +117,21 @@ static int dma_unmap_sg_chained(struct device *dev, struct scatterlist *sg, | |||
| 117 | return nents; | 117 | return nents; |
| 118 | } | 118 | } |
| 119 | 119 | ||
| 120 | /* Map SG page in kernel virtual address space and copy */ | ||
| 121 | static inline void sg_map_copy(u8 *dest, struct scatterlist *sg, | ||
| 122 | int len, int offset) | ||
| 123 | { | ||
| 124 | u8 *mapped_addr; | ||
| 125 | |||
| 126 | /* | ||
| 127 | * Page here can be user-space pinned using get_user_pages | ||
| 128 | * Same must be kmapped before use and kunmapped subsequently | ||
| 129 | */ | ||
| 130 | mapped_addr = kmap_atomic(sg_page(sg)); | ||
| 131 | memcpy(dest, mapped_addr + offset, len); | ||
| 132 | kunmap_atomic(mapped_addr); | ||
| 133 | } | ||
| 134 | |||
| 120 | /* Copy from len bytes of sg to dest, starting from beginning */ | 135 | /* Copy from len bytes of sg to dest, starting from beginning */ |
| 121 | static inline void sg_copy(u8 *dest, struct scatterlist *sg, unsigned int len) | 136 | static inline void sg_copy(u8 *dest, struct scatterlist *sg, unsigned int len) |
| 122 | { | 137 | { |
| @@ -124,15 +139,15 @@ static inline void sg_copy(u8 *dest, struct scatterlist *sg, unsigned int len) | |||
| 124 | int cpy_index = 0, next_cpy_index = current_sg->length; | 139 | int cpy_index = 0, next_cpy_index = current_sg->length; |
| 125 | 140 | ||
| 126 | while (next_cpy_index < len) { | 141 | while (next_cpy_index < len) { |
| 127 | memcpy(dest + cpy_index, (u8 *) sg_virt(current_sg), | 142 | sg_map_copy(dest + cpy_index, current_sg, current_sg->length, |
| 128 | current_sg->length); | 143 | current_sg->offset); |
| 129 | current_sg = scatterwalk_sg_next(current_sg); | 144 | current_sg = scatterwalk_sg_next(current_sg); |
| 130 | cpy_index = next_cpy_index; | 145 | cpy_index = next_cpy_index; |
| 131 | next_cpy_index += current_sg->length; | 146 | next_cpy_index += current_sg->length; |
| 132 | } | 147 | } |
| 133 | if (cpy_index < len) | 148 | if (cpy_index < len) |
| 134 | memcpy(dest + cpy_index, (u8 *) sg_virt(current_sg), | 149 | sg_map_copy(dest + cpy_index, current_sg, len-cpy_index, |
| 135 | len - cpy_index); | 150 | current_sg->offset); |
| 136 | } | 151 | } |
| 137 | 152 | ||
| 138 | /* Copy sg data, from to_skip to end, to dest */ | 153 | /* Copy sg data, from to_skip to end, to dest */ |
| @@ -140,7 +155,7 @@ static inline void sg_copy_part(u8 *dest, struct scatterlist *sg, | |||
| 140 | int to_skip, unsigned int end) | 155 | int to_skip, unsigned int end) |
| 141 | { | 156 | { |
| 142 | struct scatterlist *current_sg = sg; | 157 | struct scatterlist *current_sg = sg; |
| 143 | int sg_index, cpy_index; | 158 | int sg_index, cpy_index, offset; |
| 144 | 159 | ||
| 145 | sg_index = current_sg->length; | 160 | sg_index = current_sg->length; |
| 146 | while (sg_index <= to_skip) { | 161 | while (sg_index <= to_skip) { |
| @@ -148,9 +163,10 @@ static inline void sg_copy_part(u8 *dest, struct scatterlist *sg, | |||
| 148 | sg_index += current_sg->length; | 163 | sg_index += current_sg->length; |
| 149 | } | 164 | } |
| 150 | cpy_index = sg_index - to_skip; | 165 | cpy_index = sg_index - to_skip; |
| 151 | memcpy(dest, (u8 *) sg_virt(current_sg) + | 166 | offset = current_sg->offset + current_sg->length - cpy_index; |
| 152 | current_sg->length - cpy_index, cpy_index); | 167 | sg_map_copy(dest, current_sg, cpy_index, offset); |
| 153 | current_sg = scatterwalk_sg_next(current_sg); | 168 | if (end - sg_index) { |
| 154 | if (end - sg_index) | 169 | current_sg = scatterwalk_sg_next(current_sg); |
| 155 | sg_copy(dest + cpy_index, current_sg, end - sg_index); | 170 | sg_copy(dest + cpy_index, current_sg, end - sg_index); |
| 171 | } | ||
| 156 | } | 172 | } |
diff --git a/drivers/crypto/dcp.c b/drivers/crypto/dcp.c index a8a7dd4b0d25..247ab8048f5b 100644 --- a/drivers/crypto/dcp.c +++ b/drivers/crypto/dcp.c | |||
| @@ -733,12 +733,9 @@ static int dcp_probe(struct platform_device *pdev) | |||
| 733 | platform_set_drvdata(pdev, dev); | 733 | platform_set_drvdata(pdev, dev); |
| 734 | 734 | ||
| 735 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 735 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 736 | if (!r) { | 736 | dev->dcp_regs_base = devm_ioremap_resource(&pdev->dev, r); |
| 737 | dev_err(&pdev->dev, "failed to get IORESOURCE_MEM\n"); | 737 | if (IS_ERR(dev->dcp_regs_base)) |
| 738 | return -ENXIO; | 738 | return PTR_ERR(dev->dcp_regs_base); |
| 739 | } | ||
| 740 | dev->dcp_regs_base = devm_ioremap(&pdev->dev, r->start, | ||
| 741 | resource_size(r)); | ||
| 742 | 739 | ||
| 743 | dcp_set(dev, DCP_CTRL_SFRST, DCP_REG_CTRL); | 740 | dcp_set(dev, DCP_CTRL_SFRST, DCP_REG_CTRL); |
| 744 | udelay(10); | 741 | udelay(10); |
| @@ -762,7 +759,8 @@ static int dcp_probe(struct platform_device *pdev) | |||
| 762 | return -EIO; | 759 | return -EIO; |
| 763 | } | 760 | } |
| 764 | dev->dcp_vmi_irq = r->start; | 761 | dev->dcp_vmi_irq = r->start; |
| 765 | ret = request_irq(dev->dcp_vmi_irq, dcp_vmi_irq, 0, "dcp", dev); | 762 | ret = devm_request_irq(&pdev->dev, dev->dcp_vmi_irq, dcp_vmi_irq, 0, |
| 763 | "dcp", dev); | ||
| 766 | if (ret != 0) { | 764 | if (ret != 0) { |
| 767 | dev_err(&pdev->dev, "can't request_irq (0)\n"); | 765 | dev_err(&pdev->dev, "can't request_irq (0)\n"); |
| 768 | return -EIO; | 766 | return -EIO; |
| @@ -771,15 +769,14 @@ static int dcp_probe(struct platform_device *pdev) | |||
| 771 | r = platform_get_resource(pdev, IORESOURCE_IRQ, 1); | 769 | r = platform_get_resource(pdev, IORESOURCE_IRQ, 1); |
| 772 | if (!r) { | 770 | if (!r) { |
| 773 | dev_err(&pdev->dev, "can't get IRQ resource (1)\n"); | 771 | dev_err(&pdev->dev, "can't get IRQ resource (1)\n"); |
| 774 | ret = -EIO; | 772 | return -EIO; |
| 775 | goto err_free_irq0; | ||
| 776 | } | 773 | } |
| 777 | dev->dcp_irq = r->start; | 774 | dev->dcp_irq = r->start; |
| 778 | ret = request_irq(dev->dcp_irq, dcp_irq, 0, "dcp", dev); | 775 | ret = devm_request_irq(&pdev->dev, dev->dcp_irq, dcp_irq, 0, "dcp", |
| 776 | dev); | ||
| 779 | if (ret != 0) { | 777 | if (ret != 0) { |
| 780 | dev_err(&pdev->dev, "can't request_irq (1)\n"); | 778 | dev_err(&pdev->dev, "can't request_irq (1)\n"); |
| 781 | ret = -EIO; | 779 | return -EIO; |
| 782 | goto err_free_irq0; | ||
| 783 | } | 780 | } |
| 784 | 781 | ||
| 785 | dev->hw_pkg[0] = dma_alloc_coherent(&pdev->dev, | 782 | dev->hw_pkg[0] = dma_alloc_coherent(&pdev->dev, |
| @@ -788,8 +785,7 @@ static int dcp_probe(struct platform_device *pdev) | |||
| 788 | GFP_KERNEL); | 785 | GFP_KERNEL); |
| 789 | if (!dev->hw_pkg[0]) { | 786 | if (!dev->hw_pkg[0]) { |
| 790 | dev_err(&pdev->dev, "Could not allocate hw descriptors\n"); | 787 | dev_err(&pdev->dev, "Could not allocate hw descriptors\n"); |
| 791 | ret = -ENOMEM; | 788 | return -ENOMEM; |
| 792 | goto err_free_irq1; | ||
| 793 | } | 789 | } |
| 794 | 790 | ||
| 795 | for (i = 1; i < DCP_MAX_PKG; i++) { | 791 | for (i = 1; i < DCP_MAX_PKG; i++) { |
| @@ -848,16 +844,14 @@ err_unregister: | |||
| 848 | for (j = 0; j < i; j++) | 844 | for (j = 0; j < i; j++) |
| 849 | crypto_unregister_alg(&algs[j]); | 845 | crypto_unregister_alg(&algs[j]); |
| 850 | err_free_key_iv: | 846 | err_free_key_iv: |
| 847 | tasklet_kill(&dev->done_task); | ||
| 848 | tasklet_kill(&dev->queue_task); | ||
| 851 | dma_free_coherent(&pdev->dev, 2 * AES_KEYSIZE_128, dev->payload_base, | 849 | dma_free_coherent(&pdev->dev, 2 * AES_KEYSIZE_128, dev->payload_base, |
| 852 | dev->payload_base_dma); | 850 | dev->payload_base_dma); |
| 853 | err_free_hw_packet: | 851 | err_free_hw_packet: |
| 854 | dma_free_coherent(&pdev->dev, DCP_MAX_PKG * | 852 | dma_free_coherent(&pdev->dev, DCP_MAX_PKG * |
| 855 | sizeof(struct dcp_hw_packet), dev->hw_pkg[0], | 853 | sizeof(struct dcp_hw_packet), dev->hw_pkg[0], |
| 856 | dev->hw_phys_pkg); | 854 | dev->hw_phys_pkg); |
| 857 | err_free_irq1: | ||
| 858 | free_irq(dev->dcp_irq, dev); | ||
| 859 | err_free_irq0: | ||
| 860 | free_irq(dev->dcp_vmi_irq, dev); | ||
| 861 | 855 | ||
| 862 | return ret; | 856 | return ret; |
| 863 | } | 857 | } |
| @@ -868,23 +862,20 @@ static int dcp_remove(struct platform_device *pdev) | |||
| 868 | int j; | 862 | int j; |
| 869 | dev = platform_get_drvdata(pdev); | 863 | dev = platform_get_drvdata(pdev); |
| 870 | 864 | ||
| 871 | dma_free_coherent(&pdev->dev, | 865 | misc_deregister(&dev->dcp_bootstream_misc); |
| 872 | DCP_MAX_PKG * sizeof(struct dcp_hw_packet), | ||
| 873 | dev->hw_pkg[0], dev->hw_phys_pkg); | ||
| 874 | |||
| 875 | dma_free_coherent(&pdev->dev, 2 * AES_KEYSIZE_128, dev->payload_base, | ||
| 876 | dev->payload_base_dma); | ||
| 877 | 866 | ||
| 878 | free_irq(dev->dcp_irq, dev); | 867 | for (j = 0; j < ARRAY_SIZE(algs); j++) |
| 879 | free_irq(dev->dcp_vmi_irq, dev); | 868 | crypto_unregister_alg(&algs[j]); |
| 880 | 869 | ||
| 881 | tasklet_kill(&dev->done_task); | 870 | tasklet_kill(&dev->done_task); |
| 882 | tasklet_kill(&dev->queue_task); | 871 | tasklet_kill(&dev->queue_task); |
| 883 | 872 | ||
| 884 | for (j = 0; j < ARRAY_SIZE(algs); j++) | 873 | dma_free_coherent(&pdev->dev, 2 * AES_KEYSIZE_128, dev->payload_base, |
| 885 | crypto_unregister_alg(&algs[j]); | 874 | dev->payload_base_dma); |
| 886 | 875 | ||
| 887 | misc_deregister(&dev->dcp_bootstream_misc); | 876 | dma_free_coherent(&pdev->dev, |
| 877 | DCP_MAX_PKG * sizeof(struct dcp_hw_packet), | ||
| 878 | dev->hw_pkg[0], dev->hw_phys_pkg); | ||
| 888 | 879 | ||
| 889 | return 0; | 880 | return 0; |
| 890 | } | 881 | } |
diff --git a/drivers/crypto/ixp4xx_crypto.c b/drivers/crypto/ixp4xx_crypto.c index 214357e12dc0..9dd6e01eac33 100644 --- a/drivers/crypto/ixp4xx_crypto.c +++ b/drivers/crypto/ixp4xx_crypto.c | |||
| @@ -1149,32 +1149,24 @@ static int aead_setkey(struct crypto_aead *tfm, const u8 *key, | |||
| 1149 | unsigned int keylen) | 1149 | unsigned int keylen) |
| 1150 | { | 1150 | { |
| 1151 | struct ixp_ctx *ctx = crypto_aead_ctx(tfm); | 1151 | struct ixp_ctx *ctx = crypto_aead_ctx(tfm); |
| 1152 | struct rtattr *rta = (struct rtattr *)key; | 1152 | struct crypto_authenc_keys keys; |
| 1153 | struct crypto_authenc_key_param *param; | ||
| 1154 | 1153 | ||
| 1155 | if (!RTA_OK(rta, keylen)) | 1154 | if (crypto_authenc_extractkeys(&keys, key, keylen) != 0) |
| 1156 | goto badkey; | ||
| 1157 | if (rta->rta_type != CRYPTO_AUTHENC_KEYA_PARAM) | ||
| 1158 | goto badkey; | ||
| 1159 | if (RTA_PAYLOAD(rta) < sizeof(*param)) | ||
| 1160 | goto badkey; | 1155 | goto badkey; |
| 1161 | 1156 | ||
| 1162 | param = RTA_DATA(rta); | 1157 | if (keys.authkeylen > sizeof(ctx->authkey)) |
| 1163 | ctx->enckey_len = be32_to_cpu(param->enckeylen); | 1158 | goto badkey; |
| 1164 | |||
| 1165 | key += RTA_ALIGN(rta->rta_len); | ||
| 1166 | keylen -= RTA_ALIGN(rta->rta_len); | ||
| 1167 | 1159 | ||
| 1168 | if (keylen < ctx->enckey_len) | 1160 | if (keys.enckeylen > sizeof(ctx->enckey)) |
| 1169 | goto badkey; | 1161 | goto badkey; |
| 1170 | 1162 | ||
| 1171 | ctx->authkey_len = keylen - ctx->enckey_len; | 1163 | memcpy(ctx->authkey, keys.authkey, keys.authkeylen); |
| 1172 | memcpy(ctx->enckey, key + ctx->authkey_len, ctx->enckey_len); | 1164 | memcpy(ctx->enckey, keys.enckey, keys.enckeylen); |
| 1173 | memcpy(ctx->authkey, key, ctx->authkey_len); | 1165 | ctx->authkey_len = keys.authkeylen; |
| 1166 | ctx->enckey_len = keys.enckeylen; | ||
| 1174 | 1167 | ||
| 1175 | return aead_setup(tfm, crypto_aead_authsize(tfm)); | 1168 | return aead_setup(tfm, crypto_aead_authsize(tfm)); |
| 1176 | badkey: | 1169 | badkey: |
| 1177 | ctx->enckey_len = 0; | ||
| 1178 | crypto_aead_set_flags(tfm, CRYPTO_TFM_RES_BAD_KEY_LEN); | 1170 | crypto_aead_set_flags(tfm, CRYPTO_TFM_RES_BAD_KEY_LEN); |
| 1179 | return -EINVAL; | 1171 | return -EINVAL; |
| 1180 | } | 1172 | } |
diff --git a/drivers/crypto/mv_cesa.c b/drivers/crypto/mv_cesa.c index 3374a3ebe4c7..8d1e6f8e9e9c 100644 --- a/drivers/crypto/mv_cesa.c +++ b/drivers/crypto/mv_cesa.c | |||
| @@ -907,7 +907,7 @@ static int mv_cra_hash_hmac_sha1_init(struct crypto_tfm *tfm) | |||
| 907 | return mv_cra_hash_init(tfm, "sha1", COP_HMAC_SHA1, SHA1_BLOCK_SIZE); | 907 | return mv_cra_hash_init(tfm, "sha1", COP_HMAC_SHA1, SHA1_BLOCK_SIZE); |
| 908 | } | 908 | } |
| 909 | 909 | ||
| 910 | irqreturn_t crypto_int(int irq, void *priv) | 910 | static irqreturn_t crypto_int(int irq, void *priv) |
| 911 | { | 911 | { |
| 912 | u32 val; | 912 | u32 val; |
| 913 | 913 | ||
| @@ -928,7 +928,7 @@ irqreturn_t crypto_int(int irq, void *priv) | |||
| 928 | return IRQ_HANDLED; | 928 | return IRQ_HANDLED; |
| 929 | } | 929 | } |
| 930 | 930 | ||
| 931 | struct crypto_alg mv_aes_alg_ecb = { | 931 | static struct crypto_alg mv_aes_alg_ecb = { |
| 932 | .cra_name = "ecb(aes)", | 932 | .cra_name = "ecb(aes)", |
| 933 | .cra_driver_name = "mv-ecb-aes", | 933 | .cra_driver_name = "mv-ecb-aes", |
| 934 | .cra_priority = 300, | 934 | .cra_priority = 300, |
| @@ -951,7 +951,7 @@ struct crypto_alg mv_aes_alg_ecb = { | |||
| 951 | }, | 951 | }, |
| 952 | }; | 952 | }; |
| 953 | 953 | ||
| 954 | struct crypto_alg mv_aes_alg_cbc = { | 954 | static struct crypto_alg mv_aes_alg_cbc = { |
| 955 | .cra_name = "cbc(aes)", | 955 | .cra_name = "cbc(aes)", |
| 956 | .cra_driver_name = "mv-cbc-aes", | 956 | .cra_driver_name = "mv-cbc-aes", |
| 957 | .cra_priority = 300, | 957 | .cra_priority = 300, |
| @@ -975,7 +975,7 @@ struct crypto_alg mv_aes_alg_cbc = { | |||
| 975 | }, | 975 | }, |
| 976 | }; | 976 | }; |
| 977 | 977 | ||
| 978 | struct ahash_alg mv_sha1_alg = { | 978 | static struct ahash_alg mv_sha1_alg = { |
| 979 | .init = mv_hash_init, | 979 | .init = mv_hash_init, |
| 980 | .update = mv_hash_update, | 980 | .update = mv_hash_update, |
| 981 | .final = mv_hash_final, | 981 | .final = mv_hash_final, |
| @@ -999,7 +999,7 @@ struct ahash_alg mv_sha1_alg = { | |||
| 999 | } | 999 | } |
| 1000 | }; | 1000 | }; |
| 1001 | 1001 | ||
| 1002 | struct ahash_alg mv_hmac_sha1_alg = { | 1002 | static struct ahash_alg mv_hmac_sha1_alg = { |
| 1003 | .init = mv_hash_init, | 1003 | .init = mv_hash_init, |
| 1004 | .update = mv_hash_update, | 1004 | .update = mv_hash_update, |
| 1005 | .final = mv_hash_final, | 1005 | .final = mv_hash_final, |
| @@ -1084,7 +1084,7 @@ static int mv_probe(struct platform_device *pdev) | |||
| 1084 | goto err_unmap_sram; | 1084 | goto err_unmap_sram; |
| 1085 | } | 1085 | } |
| 1086 | 1086 | ||
| 1087 | ret = request_irq(irq, crypto_int, IRQF_DISABLED, dev_name(&pdev->dev), | 1087 | ret = request_irq(irq, crypto_int, 0, dev_name(&pdev->dev), |
| 1088 | cp); | 1088 | cp); |
| 1089 | if (ret) | 1089 | if (ret) |
| 1090 | goto err_thread; | 1090 | goto err_thread; |
| @@ -1187,7 +1187,7 @@ static struct platform_driver marvell_crypto = { | |||
| 1187 | .driver = { | 1187 | .driver = { |
| 1188 | .owner = THIS_MODULE, | 1188 | .owner = THIS_MODULE, |
| 1189 | .name = "mv_crypto", | 1189 | .name = "mv_crypto", |
| 1190 | .of_match_table = of_match_ptr(mv_cesa_of_match_table), | 1190 | .of_match_table = mv_cesa_of_match_table, |
| 1191 | }, | 1191 | }, |
| 1192 | }; | 1192 | }; |
| 1193 | MODULE_ALIAS("platform:mv_crypto"); | 1193 | MODULE_ALIAS("platform:mv_crypto"); |
diff --git a/drivers/crypto/omap-aes.c b/drivers/crypto/omap-aes.c index ce791c2f81f7..a9ccbf14096e 100644 --- a/drivers/crypto/omap-aes.c +++ b/drivers/crypto/omap-aes.c | |||
| @@ -275,7 +275,7 @@ static int omap_aes_write_ctrl(struct omap_aes_dev *dd) | |||
| 275 | if (dd->flags & FLAGS_CBC) | 275 | if (dd->flags & FLAGS_CBC) |
| 276 | val |= AES_REG_CTRL_CBC; | 276 | val |= AES_REG_CTRL_CBC; |
| 277 | if (dd->flags & FLAGS_CTR) { | 277 | if (dd->flags & FLAGS_CTR) { |
| 278 | val |= AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_32; | 278 | val |= AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_128; |
| 279 | mask = AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_MASK; | 279 | mask = AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_MASK; |
| 280 | } | 280 | } |
| 281 | if (dd->flags & FLAGS_ENCRYPT) | 281 | if (dd->flags & FLAGS_ENCRYPT) |
| @@ -554,7 +554,7 @@ static int omap_aes_crypt_dma_stop(struct omap_aes_dev *dd) | |||
| 554 | return err; | 554 | return err; |
| 555 | } | 555 | } |
| 556 | 556 | ||
| 557 | int omap_aes_check_aligned(struct scatterlist *sg) | 557 | static int omap_aes_check_aligned(struct scatterlist *sg) |
| 558 | { | 558 | { |
| 559 | while (sg) { | 559 | while (sg) { |
| 560 | if (!IS_ALIGNED(sg->offset, 4)) | 560 | if (!IS_ALIGNED(sg->offset, 4)) |
| @@ -566,7 +566,7 @@ int omap_aes_check_aligned(struct scatterlist *sg) | |||
| 566 | return 0; | 566 | return 0; |
| 567 | } | 567 | } |
| 568 | 568 | ||
| 569 | int omap_aes_copy_sgs(struct omap_aes_dev *dd) | 569 | static int omap_aes_copy_sgs(struct omap_aes_dev *dd) |
| 570 | { | 570 | { |
| 571 | void *buf_in, *buf_out; | 571 | void *buf_in, *buf_out; |
| 572 | int pages; | 572 | int pages; |
diff --git a/drivers/crypto/omap-sham.c b/drivers/crypto/omap-sham.c index e28104b4aab0..e45aaaf0db30 100644 --- a/drivers/crypto/omap-sham.c +++ b/drivers/crypto/omap-sham.c | |||
| @@ -2033,3 +2033,4 @@ module_platform_driver(omap_sham_driver); | |||
| 2033 | MODULE_DESCRIPTION("OMAP SHA1/MD5 hw acceleration support."); | 2033 | MODULE_DESCRIPTION("OMAP SHA1/MD5 hw acceleration support."); |
| 2034 | MODULE_LICENSE("GPL v2"); | 2034 | MODULE_LICENSE("GPL v2"); |
| 2035 | MODULE_AUTHOR("Dmitry Kasatkin"); | 2035 | MODULE_AUTHOR("Dmitry Kasatkin"); |
| 2036 | MODULE_ALIAS("platform:omap-sham"); | ||
diff --git a/drivers/crypto/picoxcell_crypto.c b/drivers/crypto/picoxcell_crypto.c index 888f7f4a6d3f..a6175ba6d238 100644 --- a/drivers/crypto/picoxcell_crypto.c +++ b/drivers/crypto/picoxcell_crypto.c | |||
| @@ -495,45 +495,29 @@ static int spacc_aead_setkey(struct crypto_aead *tfm, const u8 *key, | |||
| 495 | { | 495 | { |
| 496 | struct spacc_aead_ctx *ctx = crypto_aead_ctx(tfm); | 496 | struct spacc_aead_ctx *ctx = crypto_aead_ctx(tfm); |
| 497 | struct spacc_alg *alg = to_spacc_alg(tfm->base.__crt_alg); | 497 | struct spacc_alg *alg = to_spacc_alg(tfm->base.__crt_alg); |
| 498 | struct rtattr *rta = (void *)key; | 498 | struct crypto_authenc_keys keys; |
| 499 | struct crypto_authenc_key_param *param; | ||
| 500 | unsigned int authkeylen, enckeylen; | ||
| 501 | int err = -EINVAL; | 499 | int err = -EINVAL; |
| 502 | 500 | ||
| 503 | if (!RTA_OK(rta, keylen)) | 501 | if (crypto_authenc_extractkeys(&keys, key, keylen) != 0) |
| 504 | goto badkey; | 502 | goto badkey; |
| 505 | 503 | ||
| 506 | if (rta->rta_type != CRYPTO_AUTHENC_KEYA_PARAM) | 504 | if (keys.enckeylen > AES_MAX_KEY_SIZE) |
| 507 | goto badkey; | 505 | goto badkey; |
| 508 | 506 | ||
| 509 | if (RTA_PAYLOAD(rta) < sizeof(*param)) | 507 | if (keys.authkeylen > sizeof(ctx->hash_ctx)) |
| 510 | goto badkey; | ||
| 511 | |||
| 512 | param = RTA_DATA(rta); | ||
| 513 | enckeylen = be32_to_cpu(param->enckeylen); | ||
| 514 | |||
| 515 | key += RTA_ALIGN(rta->rta_len); | ||
| 516 | keylen -= RTA_ALIGN(rta->rta_len); | ||
| 517 | |||
| 518 | if (keylen < enckeylen) | ||
| 519 | goto badkey; | ||
| 520 | |||
| 521 | authkeylen = keylen - enckeylen; | ||
| 522 | |||
| 523 | if (enckeylen > AES_MAX_KEY_SIZE) | ||
| 524 | goto badkey; | 508 | goto badkey; |
| 525 | 509 | ||
| 526 | if ((alg->ctrl_default & SPACC_CRYPTO_ALG_MASK) == | 510 | if ((alg->ctrl_default & SPACC_CRYPTO_ALG_MASK) == |
| 527 | SPA_CTRL_CIPH_ALG_AES) | 511 | SPA_CTRL_CIPH_ALG_AES) |
| 528 | err = spacc_aead_aes_setkey(tfm, key + authkeylen, enckeylen); | 512 | err = spacc_aead_aes_setkey(tfm, keys.enckey, keys.enckeylen); |
| 529 | else | 513 | else |
| 530 | err = spacc_aead_des_setkey(tfm, key + authkeylen, enckeylen); | 514 | err = spacc_aead_des_setkey(tfm, keys.enckey, keys.enckeylen); |
| 531 | 515 | ||
| 532 | if (err) | 516 | if (err) |
| 533 | goto badkey; | 517 | goto badkey; |
| 534 | 518 | ||
| 535 | memcpy(ctx->hash_ctx, key, authkeylen); | 519 | memcpy(ctx->hash_ctx, keys.authkey, keys.authkeylen); |
| 536 | ctx->hash_key_len = authkeylen; | 520 | ctx->hash_key_len = keys.authkeylen; |
| 537 | 521 | ||
| 538 | return 0; | 522 | return 0; |
| 539 | 523 | ||
diff --git a/drivers/crypto/sahara.c b/drivers/crypto/sahara.c index d7bb8bac36e9..785a9ded7bdf 100644 --- a/drivers/crypto/sahara.c +++ b/drivers/crypto/sahara.c | |||
| @@ -1058,7 +1058,7 @@ static struct platform_driver sahara_driver = { | |||
| 1058 | .driver = { | 1058 | .driver = { |
| 1059 | .name = SAHARA_NAME, | 1059 | .name = SAHARA_NAME, |
| 1060 | .owner = THIS_MODULE, | 1060 | .owner = THIS_MODULE, |
| 1061 | .of_match_table = of_match_ptr(sahara_dt_ids), | 1061 | .of_match_table = sahara_dt_ids, |
| 1062 | }, | 1062 | }, |
| 1063 | .id_table = sahara_platform_ids, | 1063 | .id_table = sahara_platform_ids, |
| 1064 | }; | 1064 | }; |
diff --git a/drivers/crypto/talitos.c b/drivers/crypto/talitos.c index 6cd0e6038583..b44f4ddc565c 100644 --- a/drivers/crypto/talitos.c +++ b/drivers/crypto/talitos.c | |||
| @@ -673,39 +673,20 @@ static int aead_setkey(struct crypto_aead *authenc, | |||
| 673 | const u8 *key, unsigned int keylen) | 673 | const u8 *key, unsigned int keylen) |
| 674 | { | 674 | { |
| 675 | struct talitos_ctx *ctx = crypto_aead_ctx(authenc); | 675 | struct talitos_ctx *ctx = crypto_aead_ctx(authenc); |
| 676 | struct rtattr *rta = (void *)key; | 676 | struct crypto_authenc_keys keys; |
| 677 | struct crypto_authenc_key_param *param; | ||
| 678 | unsigned int authkeylen; | ||
| 679 | unsigned int enckeylen; | ||
| 680 | |||
| 681 | if (!RTA_OK(rta, keylen)) | ||
| 682 | goto badkey; | ||
| 683 | 677 | ||
| 684 | if (rta->rta_type != CRYPTO_AUTHENC_KEYA_PARAM) | 678 | if (crypto_authenc_extractkeys(&keys, key, keylen) != 0) |
| 685 | goto badkey; | 679 | goto badkey; |
| 686 | 680 | ||
| 687 | if (RTA_PAYLOAD(rta) < sizeof(*param)) | 681 | if (keys.authkeylen + keys.enckeylen > TALITOS_MAX_KEY_SIZE) |
| 688 | goto badkey; | 682 | goto badkey; |
| 689 | 683 | ||
| 690 | param = RTA_DATA(rta); | 684 | memcpy(ctx->key, keys.authkey, keys.authkeylen); |
| 691 | enckeylen = be32_to_cpu(param->enckeylen); | 685 | memcpy(&ctx->key[keys.authkeylen], keys.enckey, keys.enckeylen); |
| 692 | |||
| 693 | key += RTA_ALIGN(rta->rta_len); | ||
| 694 | keylen -= RTA_ALIGN(rta->rta_len); | ||
| 695 | 686 | ||
| 696 | if (keylen < enckeylen) | 687 | ctx->keylen = keys.authkeylen + keys.enckeylen; |
| 697 | goto badkey; | 688 | ctx->enckeylen = keys.enckeylen; |
| 698 | 689 | ctx->authkeylen = keys.authkeylen; | |
| 699 | authkeylen = keylen - enckeylen; | ||
| 700 | |||
| 701 | if (keylen > TALITOS_MAX_KEY_SIZE) | ||
| 702 | goto badkey; | ||
| 703 | |||
| 704 | memcpy(&ctx->key, key, keylen); | ||
| 705 | |||
| 706 | ctx->keylen = keylen; | ||
| 707 | ctx->enckeylen = enckeylen; | ||
| 708 | ctx->authkeylen = authkeylen; | ||
| 709 | 690 | ||
| 710 | return 0; | 691 | return 0; |
| 711 | 692 | ||
| @@ -809,7 +790,7 @@ static void ipsec_esp_unmap(struct device *dev, | |||
| 809 | 790 | ||
| 810 | if (edesc->assoc_chained) | 791 | if (edesc->assoc_chained) |
| 811 | talitos_unmap_sg_chain(dev, areq->assoc, DMA_TO_DEVICE); | 792 | talitos_unmap_sg_chain(dev, areq->assoc, DMA_TO_DEVICE); |
| 812 | else | 793 | else if (areq->assoclen) |
| 813 | /* assoc_nents counts also for IV in non-contiguous cases */ | 794 | /* assoc_nents counts also for IV in non-contiguous cases */ |
| 814 | dma_unmap_sg(dev, areq->assoc, | 795 | dma_unmap_sg(dev, areq->assoc, |
| 815 | edesc->assoc_nents ? edesc->assoc_nents - 1 : 1, | 796 | edesc->assoc_nents ? edesc->assoc_nents - 1 : 1, |
| @@ -992,7 +973,11 @@ static int ipsec_esp(struct talitos_edesc *edesc, struct aead_request *areq, | |||
| 992 | dma_sync_single_for_device(dev, edesc->dma_link_tbl, | 973 | dma_sync_single_for_device(dev, edesc->dma_link_tbl, |
| 993 | edesc->dma_len, DMA_BIDIRECTIONAL); | 974 | edesc->dma_len, DMA_BIDIRECTIONAL); |
| 994 | } else { | 975 | } else { |
| 995 | to_talitos_ptr(&desc->ptr[1], sg_dma_address(areq->assoc)); | 976 | if (areq->assoclen) |
| 977 | to_talitos_ptr(&desc->ptr[1], | ||
| 978 | sg_dma_address(areq->assoc)); | ||
| 979 | else | ||
| 980 | to_talitos_ptr(&desc->ptr[1], edesc->iv_dma); | ||
| 996 | desc->ptr[1].j_extent = 0; | 981 | desc->ptr[1].j_extent = 0; |
| 997 | } | 982 | } |
| 998 | 983 | ||
| @@ -1127,7 +1112,8 @@ static struct talitos_edesc *talitos_edesc_alloc(struct device *dev, | |||
| 1127 | unsigned int authsize, | 1112 | unsigned int authsize, |
| 1128 | unsigned int ivsize, | 1113 | unsigned int ivsize, |
| 1129 | int icv_stashing, | 1114 | int icv_stashing, |
| 1130 | u32 cryptoflags) | 1115 | u32 cryptoflags, |
| 1116 | bool encrypt) | ||
| 1131 | { | 1117 | { |
| 1132 | struct talitos_edesc *edesc; | 1118 | struct talitos_edesc *edesc; |
| 1133 | int assoc_nents = 0, src_nents, dst_nents, alloc_len, dma_len; | 1119 | int assoc_nents = 0, src_nents, dst_nents, alloc_len, dma_len; |
| @@ -1141,10 +1127,10 @@ static struct talitos_edesc *talitos_edesc_alloc(struct device *dev, | |||
| 1141 | return ERR_PTR(-EINVAL); | 1127 | return ERR_PTR(-EINVAL); |
| 1142 | } | 1128 | } |
| 1143 | 1129 | ||
| 1144 | if (iv) | 1130 | if (ivsize) |
| 1145 | iv_dma = dma_map_single(dev, iv, ivsize, DMA_TO_DEVICE); | 1131 | iv_dma = dma_map_single(dev, iv, ivsize, DMA_TO_DEVICE); |
| 1146 | 1132 | ||
| 1147 | if (assoc) { | 1133 | if (assoclen) { |
| 1148 | /* | 1134 | /* |
| 1149 | * Currently it is assumed that iv is provided whenever assoc | 1135 | * Currently it is assumed that iv is provided whenever assoc |
| 1150 | * is. | 1136 | * is. |
| @@ -1160,19 +1146,17 @@ static struct talitos_edesc *talitos_edesc_alloc(struct device *dev, | |||
| 1160 | assoc_nents = assoc_nents ? assoc_nents + 1 : 2; | 1146 | assoc_nents = assoc_nents ? assoc_nents + 1 : 2; |
| 1161 | } | 1147 | } |
| 1162 | 1148 | ||
| 1163 | src_nents = sg_count(src, cryptlen + authsize, &src_chained); | 1149 | if (!dst || dst == src) { |
| 1164 | src_nents = (src_nents == 1) ? 0 : src_nents; | 1150 | src_nents = sg_count(src, cryptlen + authsize, &src_chained); |
| 1165 | 1151 | src_nents = (src_nents == 1) ? 0 : src_nents; | |
| 1166 | if (!dst) { | 1152 | dst_nents = dst ? src_nents : 0; |
| 1167 | dst_nents = 0; | 1153 | } else { /* dst && dst != src*/ |
| 1168 | } else { | 1154 | src_nents = sg_count(src, cryptlen + (encrypt ? 0 : authsize), |
| 1169 | if (dst == src) { | 1155 | &src_chained); |
| 1170 | dst_nents = src_nents; | 1156 | src_nents = (src_nents == 1) ? 0 : src_nents; |
| 1171 | } else { | 1157 | dst_nents = sg_count(dst, cryptlen + (encrypt ? authsize : 0), |
| 1172 | dst_nents = sg_count(dst, cryptlen + authsize, | 1158 | &dst_chained); |
| 1173 | &dst_chained); | 1159 | dst_nents = (dst_nents == 1) ? 0 : dst_nents; |
| 1174 | dst_nents = (dst_nents == 1) ? 0 : dst_nents; | ||
| 1175 | } | ||
| 1176 | } | 1160 | } |
| 1177 | 1161 | ||
| 1178 | /* | 1162 | /* |
| @@ -1192,9 +1176,16 @@ static struct talitos_edesc *talitos_edesc_alloc(struct device *dev, | |||
| 1192 | 1176 | ||
| 1193 | edesc = kmalloc(alloc_len, GFP_DMA | flags); | 1177 | edesc = kmalloc(alloc_len, GFP_DMA | flags); |
| 1194 | if (!edesc) { | 1178 | if (!edesc) { |
| 1195 | talitos_unmap_sg_chain(dev, assoc, DMA_TO_DEVICE); | 1179 | if (assoc_chained) |
| 1180 | talitos_unmap_sg_chain(dev, assoc, DMA_TO_DEVICE); | ||
| 1181 | else if (assoclen) | ||
| 1182 | dma_unmap_sg(dev, assoc, | ||
| 1183 | assoc_nents ? assoc_nents - 1 : 1, | ||
| 1184 | DMA_TO_DEVICE); | ||
| 1185 | |||
| 1196 | if (iv_dma) | 1186 | if (iv_dma) |
| 1197 | dma_unmap_single(dev, iv_dma, ivsize, DMA_TO_DEVICE); | 1187 | dma_unmap_single(dev, iv_dma, ivsize, DMA_TO_DEVICE); |
| 1188 | |||
| 1198 | dev_err(dev, "could not allocate edescriptor\n"); | 1189 | dev_err(dev, "could not allocate edescriptor\n"); |
| 1199 | return ERR_PTR(-ENOMEM); | 1190 | return ERR_PTR(-ENOMEM); |
| 1200 | } | 1191 | } |
| @@ -1216,7 +1207,7 @@ static struct talitos_edesc *talitos_edesc_alloc(struct device *dev, | |||
| 1216 | } | 1207 | } |
| 1217 | 1208 | ||
| 1218 | static struct talitos_edesc *aead_edesc_alloc(struct aead_request *areq, u8 *iv, | 1209 | static struct talitos_edesc *aead_edesc_alloc(struct aead_request *areq, u8 *iv, |
| 1219 | int icv_stashing) | 1210 | int icv_stashing, bool encrypt) |
| 1220 | { | 1211 | { |
| 1221 | struct crypto_aead *authenc = crypto_aead_reqtfm(areq); | 1212 | struct crypto_aead *authenc = crypto_aead_reqtfm(areq); |
| 1222 | struct talitos_ctx *ctx = crypto_aead_ctx(authenc); | 1213 | struct talitos_ctx *ctx = crypto_aead_ctx(authenc); |
| @@ -1225,7 +1216,7 @@ static struct talitos_edesc *aead_edesc_alloc(struct aead_request *areq, u8 *iv, | |||
| 1225 | return talitos_edesc_alloc(ctx->dev, areq->assoc, areq->src, areq->dst, | 1216 | return talitos_edesc_alloc(ctx->dev, areq->assoc, areq->src, areq->dst, |
| 1226 | iv, areq->assoclen, areq->cryptlen, | 1217 | iv, areq->assoclen, areq->cryptlen, |
| 1227 | ctx->authsize, ivsize, icv_stashing, | 1218 | ctx->authsize, ivsize, icv_stashing, |
| 1228 | areq->base.flags); | 1219 | areq->base.flags, encrypt); |
| 1229 | } | 1220 | } |
| 1230 | 1221 | ||
| 1231 | static int aead_encrypt(struct aead_request *req) | 1222 | static int aead_encrypt(struct aead_request *req) |
| @@ -1235,7 +1226,7 @@ static int aead_encrypt(struct aead_request *req) | |||
| 1235 | struct talitos_edesc *edesc; | 1226 | struct talitos_edesc *edesc; |
| 1236 | 1227 | ||
| 1237 | /* allocate extended descriptor */ | 1228 | /* allocate extended descriptor */ |
| 1238 | edesc = aead_edesc_alloc(req, req->iv, 0); | 1229 | edesc = aead_edesc_alloc(req, req->iv, 0, true); |
| 1239 | if (IS_ERR(edesc)) | 1230 | if (IS_ERR(edesc)) |
| 1240 | return PTR_ERR(edesc); | 1231 | return PTR_ERR(edesc); |
| 1241 | 1232 | ||
| @@ -1258,7 +1249,7 @@ static int aead_decrypt(struct aead_request *req) | |||
| 1258 | req->cryptlen -= authsize; | 1249 | req->cryptlen -= authsize; |
| 1259 | 1250 | ||
| 1260 | /* allocate extended descriptor */ | 1251 | /* allocate extended descriptor */ |
| 1261 | edesc = aead_edesc_alloc(req, req->iv, 1); | 1252 | edesc = aead_edesc_alloc(req, req->iv, 1, false); |
| 1262 | if (IS_ERR(edesc)) | 1253 | if (IS_ERR(edesc)) |
| 1263 | return PTR_ERR(edesc); | 1254 | return PTR_ERR(edesc); |
| 1264 | 1255 | ||
| @@ -1304,7 +1295,7 @@ static int aead_givencrypt(struct aead_givcrypt_request *req) | |||
| 1304 | struct talitos_edesc *edesc; | 1295 | struct talitos_edesc *edesc; |
| 1305 | 1296 | ||
| 1306 | /* allocate extended descriptor */ | 1297 | /* allocate extended descriptor */ |
| 1307 | edesc = aead_edesc_alloc(areq, req->giv, 0); | 1298 | edesc = aead_edesc_alloc(areq, req->giv, 0, true); |
| 1308 | if (IS_ERR(edesc)) | 1299 | if (IS_ERR(edesc)) |
| 1309 | return PTR_ERR(edesc); | 1300 | return PTR_ERR(edesc); |
| 1310 | 1301 | ||
| @@ -1460,7 +1451,7 @@ static int common_nonsnoop(struct talitos_edesc *edesc, | |||
| 1460 | } | 1451 | } |
| 1461 | 1452 | ||
| 1462 | static struct talitos_edesc *ablkcipher_edesc_alloc(struct ablkcipher_request * | 1453 | static struct talitos_edesc *ablkcipher_edesc_alloc(struct ablkcipher_request * |
| 1463 | areq) | 1454 | areq, bool encrypt) |
| 1464 | { | 1455 | { |
| 1465 | struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq); | 1456 | struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq); |
| 1466 | struct talitos_ctx *ctx = crypto_ablkcipher_ctx(cipher); | 1457 | struct talitos_ctx *ctx = crypto_ablkcipher_ctx(cipher); |
| @@ -1468,7 +1459,7 @@ static struct talitos_edesc *ablkcipher_edesc_alloc(struct ablkcipher_request * | |||
| 1468 | 1459 | ||
| 1469 | return talitos_edesc_alloc(ctx->dev, NULL, areq->src, areq->dst, | 1460 | return talitos_edesc_alloc(ctx->dev, NULL, areq->src, areq->dst, |
| 1470 | areq->info, 0, areq->nbytes, 0, ivsize, 0, | 1461 | areq->info, 0, areq->nbytes, 0, ivsize, 0, |
| 1471 | areq->base.flags); | 1462 | areq->base.flags, encrypt); |
| 1472 | } | 1463 | } |
| 1473 | 1464 | ||
| 1474 | static int ablkcipher_encrypt(struct ablkcipher_request *areq) | 1465 | static int ablkcipher_encrypt(struct ablkcipher_request *areq) |
| @@ -1478,7 +1469,7 @@ static int ablkcipher_encrypt(struct ablkcipher_request *areq) | |||
| 1478 | struct talitos_edesc *edesc; | 1469 | struct talitos_edesc *edesc; |
| 1479 | 1470 | ||
| 1480 | /* allocate extended descriptor */ | 1471 | /* allocate extended descriptor */ |
| 1481 | edesc = ablkcipher_edesc_alloc(areq); | 1472 | edesc = ablkcipher_edesc_alloc(areq, true); |
| 1482 | if (IS_ERR(edesc)) | 1473 | if (IS_ERR(edesc)) |
| 1483 | return PTR_ERR(edesc); | 1474 | return PTR_ERR(edesc); |
| 1484 | 1475 | ||
| @@ -1495,7 +1486,7 @@ static int ablkcipher_decrypt(struct ablkcipher_request *areq) | |||
| 1495 | struct talitos_edesc *edesc; | 1486 | struct talitos_edesc *edesc; |
| 1496 | 1487 | ||
| 1497 | /* allocate extended descriptor */ | 1488 | /* allocate extended descriptor */ |
| 1498 | edesc = ablkcipher_edesc_alloc(areq); | 1489 | edesc = ablkcipher_edesc_alloc(areq, false); |
| 1499 | if (IS_ERR(edesc)) | 1490 | if (IS_ERR(edesc)) |
| 1500 | return PTR_ERR(edesc); | 1491 | return PTR_ERR(edesc); |
| 1501 | 1492 | ||
| @@ -1647,7 +1638,7 @@ static struct talitos_edesc *ahash_edesc_alloc(struct ahash_request *areq, | |||
| 1647 | struct talitos_ahash_req_ctx *req_ctx = ahash_request_ctx(areq); | 1638 | struct talitos_ahash_req_ctx *req_ctx = ahash_request_ctx(areq); |
| 1648 | 1639 | ||
| 1649 | return talitos_edesc_alloc(ctx->dev, NULL, req_ctx->psrc, NULL, NULL, 0, | 1640 | return talitos_edesc_alloc(ctx->dev, NULL, req_ctx->psrc, NULL, NULL, 0, |
| 1650 | nbytes, 0, 0, 0, areq->base.flags); | 1641 | nbytes, 0, 0, 0, areq->base.flags, false); |
| 1651 | } | 1642 | } |
| 1652 | 1643 | ||
| 1653 | static int ahash_init(struct ahash_request *areq) | 1644 | static int ahash_init(struct ahash_request *areq) |
diff --git a/drivers/crypto/tegra-aes.c b/drivers/crypto/tegra-aes.c index fa05e3c329bd..060eecc5dbc3 100644 --- a/drivers/crypto/tegra-aes.c +++ b/drivers/crypto/tegra-aes.c | |||
| @@ -27,6 +27,8 @@ | |||
| 27 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. | 27 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. |
| 28 | */ | 28 | */ |
| 29 | 29 | ||
| 30 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
| 31 | |||
| 30 | #include <linux/module.h> | 32 | #include <linux/module.h> |
| 31 | #include <linux/init.h> | 33 | #include <linux/init.h> |
| 32 | #include <linux/errno.h> | 34 | #include <linux/errno.h> |
| @@ -199,8 +201,6 @@ static void aes_workqueue_handler(struct work_struct *work); | |||
| 199 | static DECLARE_WORK(aes_work, aes_workqueue_handler); | 201 | static DECLARE_WORK(aes_work, aes_workqueue_handler); |
| 200 | static struct workqueue_struct *aes_wq; | 202 | static struct workqueue_struct *aes_wq; |
| 201 | 203 | ||
| 202 | extern unsigned long long tegra_chip_uid(void); | ||
| 203 | |||
| 204 | static inline u32 aes_readl(struct tegra_aes_dev *dd, u32 offset) | 204 | static inline u32 aes_readl(struct tegra_aes_dev *dd, u32 offset) |
| 205 | { | 205 | { |
| 206 | return readl(dd->io_base + offset); | 206 | return readl(dd->io_base + offset); |
| @@ -713,13 +713,12 @@ static int tegra_aes_rng_reset(struct crypto_rng *tfm, u8 *seed, | |||
| 713 | struct tegra_aes_dev *dd = aes_dev; | 713 | struct tegra_aes_dev *dd = aes_dev; |
| 714 | struct tegra_aes_ctx *ctx = &rng_ctx; | 714 | struct tegra_aes_ctx *ctx = &rng_ctx; |
| 715 | struct tegra_aes_slot *key_slot; | 715 | struct tegra_aes_slot *key_slot; |
| 716 | struct timespec ts; | ||
| 717 | int ret = 0; | 716 | int ret = 0; |
| 718 | u64 nsec, tmp[2]; | 717 | u8 tmp[16]; /* 16 bytes = 128 bits of entropy */ |
| 719 | u8 *dt; | 718 | u8 *dt; |
| 720 | 719 | ||
| 721 | if (!ctx || !dd) { | 720 | if (!ctx || !dd) { |
| 722 | dev_err(dd->dev, "ctx=0x%x, dd=0x%x\n", | 721 | pr_err("ctx=0x%x, dd=0x%x\n", |
| 723 | (unsigned int)ctx, (unsigned int)dd); | 722 | (unsigned int)ctx, (unsigned int)dd); |
| 724 | return -EINVAL; | 723 | return -EINVAL; |
| 725 | } | 724 | } |
| @@ -778,14 +777,8 @@ static int tegra_aes_rng_reset(struct crypto_rng *tfm, u8 *seed, | |||
| 778 | if (dd->ivlen >= (2 * DEFAULT_RNG_BLK_SZ + AES_KEYSIZE_128)) { | 777 | if (dd->ivlen >= (2 * DEFAULT_RNG_BLK_SZ + AES_KEYSIZE_128)) { |
| 779 | dt = dd->iv + DEFAULT_RNG_BLK_SZ + AES_KEYSIZE_128; | 778 | dt = dd->iv + DEFAULT_RNG_BLK_SZ + AES_KEYSIZE_128; |
| 780 | } else { | 779 | } else { |
| 781 | getnstimeofday(&ts); | 780 | get_random_bytes(tmp, sizeof(tmp)); |
| 782 | nsec = timespec_to_ns(&ts); | 781 | dt = tmp; |
| 783 | do_div(nsec, 1000); | ||
| 784 | nsec ^= dd->ctr << 56; | ||
| 785 | dd->ctr++; | ||
| 786 | tmp[0] = nsec; | ||
| 787 | tmp[1] = tegra_chip_uid(); | ||
| 788 | dt = (u8 *)tmp; | ||
| 789 | } | 782 | } |
| 790 | memcpy(dd->dt, dt, DEFAULT_RNG_BLK_SZ); | 783 | memcpy(dd->dt, dt, DEFAULT_RNG_BLK_SZ); |
| 791 | 784 | ||
| @@ -804,7 +797,7 @@ static int tegra_aes_cra_init(struct crypto_tfm *tfm) | |||
| 804 | return 0; | 797 | return 0; |
| 805 | } | 798 | } |
| 806 | 799 | ||
| 807 | void tegra_aes_cra_exit(struct crypto_tfm *tfm) | 800 | static void tegra_aes_cra_exit(struct crypto_tfm *tfm) |
| 808 | { | 801 | { |
| 809 | struct tegra_aes_ctx *ctx = | 802 | struct tegra_aes_ctx *ctx = |
| 810 | crypto_ablkcipher_ctx((struct crypto_ablkcipher *)tfm); | 803 | crypto_ablkcipher_ctx((struct crypto_ablkcipher *)tfm); |
| @@ -924,7 +917,7 @@ static int tegra_aes_probe(struct platform_device *pdev) | |||
| 924 | } | 917 | } |
| 925 | 918 | ||
| 926 | /* Initialize the vde clock */ | 919 | /* Initialize the vde clock */ |
| 927 | dd->aes_clk = clk_get(dev, "vde"); | 920 | dd->aes_clk = devm_clk_get(dev, "vde"); |
| 928 | if (IS_ERR(dd->aes_clk)) { | 921 | if (IS_ERR(dd->aes_clk)) { |
| 929 | dev_err(dev, "iclock intialization failed.\n"); | 922 | dev_err(dev, "iclock intialization failed.\n"); |
| 930 | err = -ENODEV; | 923 | err = -ENODEV; |
| @@ -1033,8 +1026,6 @@ out: | |||
| 1033 | if (dd->buf_out) | 1026 | if (dd->buf_out) |
| 1034 | dma_free_coherent(dev, AES_HW_DMA_BUFFER_SIZE_BYTES, | 1027 | dma_free_coherent(dev, AES_HW_DMA_BUFFER_SIZE_BYTES, |
| 1035 | dd->buf_out, dd->dma_buf_out); | 1028 | dd->buf_out, dd->dma_buf_out); |
| 1036 | if (!IS_ERR(dd->aes_clk)) | ||
| 1037 | clk_put(dd->aes_clk); | ||
| 1038 | if (aes_wq) | 1029 | if (aes_wq) |
| 1039 | destroy_workqueue(aes_wq); | 1030 | destroy_workqueue(aes_wq); |
| 1040 | spin_lock(&list_lock); | 1031 | spin_lock(&list_lock); |
| @@ -1068,7 +1059,6 @@ static int tegra_aes_remove(struct platform_device *pdev) | |||
| 1068 | dd->buf_in, dd->dma_buf_in); | 1059 | dd->buf_in, dd->dma_buf_in); |
| 1069 | dma_free_coherent(dev, AES_HW_DMA_BUFFER_SIZE_BYTES, | 1060 | dma_free_coherent(dev, AES_HW_DMA_BUFFER_SIZE_BYTES, |
| 1070 | dd->buf_out, dd->dma_buf_out); | 1061 | dd->buf_out, dd->dma_buf_out); |
| 1071 | clk_put(dd->aes_clk); | ||
| 1072 | aes_dev = NULL; | 1062 | aes_dev = NULL; |
| 1073 | 1063 | ||
| 1074 | return 0; | 1064 | return 0; |
diff --git a/drivers/dma/amba-pl08x.c b/drivers/dma/amba-pl08x.c index 16a2aa28f856..ec4ee5c1fe9d 100644 --- a/drivers/dma/amba-pl08x.c +++ b/drivers/dma/amba-pl08x.c | |||
| @@ -1169,7 +1169,7 @@ static void pl08x_desc_free(struct virt_dma_desc *vd) | |||
| 1169 | struct pl08x_txd *txd = to_pl08x_txd(&vd->tx); | 1169 | struct pl08x_txd *txd = to_pl08x_txd(&vd->tx); |
| 1170 | struct pl08x_dma_chan *plchan = to_pl08x_chan(vd->tx.chan); | 1170 | struct pl08x_dma_chan *plchan = to_pl08x_chan(vd->tx.chan); |
| 1171 | 1171 | ||
| 1172 | dma_descriptor_unmap(txd); | 1172 | dma_descriptor_unmap(&vd->tx); |
| 1173 | if (!txd->done) | 1173 | if (!txd->done) |
| 1174 | pl08x_release_mux(plchan); | 1174 | pl08x_release_mux(plchan); |
| 1175 | 1175 | ||
diff --git a/drivers/dma/mmp_pdma.c b/drivers/dma/mmp_pdma.c index dcb1e05149a7..8869500ab92b 100644 --- a/drivers/dma/mmp_pdma.c +++ b/drivers/dma/mmp_pdma.c | |||
| @@ -1017,6 +1017,7 @@ static int mmp_pdma_probe(struct platform_device *op) | |||
| 1017 | } | 1017 | } |
| 1018 | } | 1018 | } |
| 1019 | 1019 | ||
| 1020 | platform_set_drvdata(op, pdev); | ||
| 1020 | dev_info(pdev->device.dev, "initialized %d channels\n", dma_channels); | 1021 | dev_info(pdev->device.dev, "initialized %d channels\n", dma_channels); |
| 1021 | return 0; | 1022 | return 0; |
| 1022 | } | 1023 | } |
diff --git a/drivers/dma/s3c24xx-dma.c b/drivers/dma/s3c24xx-dma.c index 4cb127978636..4eddedb6eb7d 100644 --- a/drivers/dma/s3c24xx-dma.c +++ b/drivers/dma/s3c24xx-dma.c | |||
| @@ -628,42 +628,13 @@ retry: | |||
| 628 | s3cchan->state = S3C24XX_DMA_CHAN_IDLE; | 628 | s3cchan->state = S3C24XX_DMA_CHAN_IDLE; |
| 629 | } | 629 | } |
| 630 | 630 | ||
| 631 | static void s3c24xx_dma_unmap_buffers(struct s3c24xx_txd *txd) | ||
| 632 | { | ||
| 633 | struct device *dev = txd->vd.tx.chan->device->dev; | ||
| 634 | struct s3c24xx_sg *dsg; | ||
| 635 | |||
| 636 | if (!(txd->vd.tx.flags & DMA_COMPL_SKIP_SRC_UNMAP)) { | ||
| 637 | if (txd->vd.tx.flags & DMA_COMPL_SRC_UNMAP_SINGLE) | ||
| 638 | list_for_each_entry(dsg, &txd->dsg_list, node) | ||
| 639 | dma_unmap_single(dev, dsg->src_addr, dsg->len, | ||
| 640 | DMA_TO_DEVICE); | ||
| 641 | else { | ||
| 642 | list_for_each_entry(dsg, &txd->dsg_list, node) | ||
| 643 | dma_unmap_page(dev, dsg->src_addr, dsg->len, | ||
| 644 | DMA_TO_DEVICE); | ||
| 645 | } | ||
| 646 | } | ||
| 647 | |||
| 648 | if (!(txd->vd.tx.flags & DMA_COMPL_SKIP_DEST_UNMAP)) { | ||
| 649 | if (txd->vd.tx.flags & DMA_COMPL_DEST_UNMAP_SINGLE) | ||
| 650 | list_for_each_entry(dsg, &txd->dsg_list, node) | ||
| 651 | dma_unmap_single(dev, dsg->dst_addr, dsg->len, | ||
| 652 | DMA_FROM_DEVICE); | ||
| 653 | else | ||
| 654 | list_for_each_entry(dsg, &txd->dsg_list, node) | ||
| 655 | dma_unmap_page(dev, dsg->dst_addr, dsg->len, | ||
| 656 | DMA_FROM_DEVICE); | ||
| 657 | } | ||
| 658 | } | ||
| 659 | |||
| 660 | static void s3c24xx_dma_desc_free(struct virt_dma_desc *vd) | 631 | static void s3c24xx_dma_desc_free(struct virt_dma_desc *vd) |
| 661 | { | 632 | { |
| 662 | struct s3c24xx_txd *txd = to_s3c24xx_txd(&vd->tx); | 633 | struct s3c24xx_txd *txd = to_s3c24xx_txd(&vd->tx); |
| 663 | struct s3c24xx_dma_chan *s3cchan = to_s3c24xx_dma_chan(vd->tx.chan); | 634 | struct s3c24xx_dma_chan *s3cchan = to_s3c24xx_dma_chan(vd->tx.chan); |
| 664 | 635 | ||
| 665 | if (!s3cchan->slave) | 636 | if (!s3cchan->slave) |
| 666 | s3c24xx_dma_unmap_buffers(txd); | 637 | dma_descriptor_unmap(&vd->tx); |
| 667 | 638 | ||
| 668 | s3c24xx_dma_free_txd(txd); | 639 | s3c24xx_dma_free_txd(txd); |
| 669 | } | 640 | } |
| @@ -795,7 +766,7 @@ static enum dma_status s3c24xx_dma_tx_status(struct dma_chan *chan, | |||
| 795 | 766 | ||
| 796 | spin_lock_irqsave(&s3cchan->vc.lock, flags); | 767 | spin_lock_irqsave(&s3cchan->vc.lock, flags); |
| 797 | ret = dma_cookie_status(chan, cookie, txstate); | 768 | ret = dma_cookie_status(chan, cookie, txstate); |
| 798 | if (ret == DMA_SUCCESS) { | 769 | if (ret == DMA_COMPLETE) { |
| 799 | spin_unlock_irqrestore(&s3cchan->vc.lock, flags); | 770 | spin_unlock_irqrestore(&s3cchan->vc.lock, flags); |
| 800 | return ret; | 771 | return ret; |
| 801 | } | 772 | } |
diff --git a/drivers/dma/sh/rcar-hpbdma.c b/drivers/dma/sh/rcar-hpbdma.c index ebad84591a6e..3083d901a414 100644 --- a/drivers/dma/sh/rcar-hpbdma.c +++ b/drivers/dma/sh/rcar-hpbdma.c | |||
| @@ -60,6 +60,7 @@ | |||
| 60 | #define HPB_DMAE_DSTPR_DMSTP BIT(0) | 60 | #define HPB_DMAE_DSTPR_DMSTP BIT(0) |
| 61 | 61 | ||
| 62 | /* DMA status register (DSTSR) bits */ | 62 | /* DMA status register (DSTSR) bits */ |
| 63 | #define HPB_DMAE_DSTSR_DQSTS BIT(2) | ||
| 63 | #define HPB_DMAE_DSTSR_DMSTS BIT(0) | 64 | #define HPB_DMAE_DSTSR_DMSTS BIT(0) |
| 64 | 65 | ||
| 65 | /* DMA common registers */ | 66 | /* DMA common registers */ |
| @@ -286,6 +287,9 @@ static void hpb_dmae_halt(struct shdma_chan *schan) | |||
| 286 | 287 | ||
| 287 | ch_reg_write(chan, HPB_DMAE_DCMDR_DQEND, HPB_DMAE_DCMDR); | 288 | ch_reg_write(chan, HPB_DMAE_DCMDR_DQEND, HPB_DMAE_DCMDR); |
| 288 | ch_reg_write(chan, HPB_DMAE_DSTPR_DMSTP, HPB_DMAE_DSTPR); | 289 | ch_reg_write(chan, HPB_DMAE_DSTPR_DMSTP, HPB_DMAE_DSTPR); |
| 290 | |||
| 291 | chan->plane_idx = 0; | ||
| 292 | chan->first_desc = true; | ||
| 289 | } | 293 | } |
| 290 | 294 | ||
| 291 | static const struct hpb_dmae_slave_config * | 295 | static const struct hpb_dmae_slave_config * |
| @@ -385,7 +389,10 @@ static bool hpb_dmae_channel_busy(struct shdma_chan *schan) | |||
| 385 | struct hpb_dmae_chan *chan = to_chan(schan); | 389 | struct hpb_dmae_chan *chan = to_chan(schan); |
| 386 | u32 dstsr = ch_reg_read(chan, HPB_DMAE_DSTSR); | 390 | u32 dstsr = ch_reg_read(chan, HPB_DMAE_DSTSR); |
| 387 | 391 | ||
| 388 | return (dstsr & HPB_DMAE_DSTSR_DMSTS) == HPB_DMAE_DSTSR_DMSTS; | 392 | if (chan->xfer_mode == XFER_DOUBLE) |
| 393 | return dstsr & HPB_DMAE_DSTSR_DQSTS; | ||
| 394 | else | ||
| 395 | return dstsr & HPB_DMAE_DSTSR_DMSTS; | ||
| 389 | } | 396 | } |
| 390 | 397 | ||
| 391 | static int | 398 | static int |
| @@ -510,6 +517,8 @@ static int hpb_dmae_chan_probe(struct hpb_dmae_device *hpbdev, int id) | |||
| 510 | } | 517 | } |
| 511 | 518 | ||
| 512 | schan = &new_hpb_chan->shdma_chan; | 519 | schan = &new_hpb_chan->shdma_chan; |
| 520 | schan->max_xfer_len = HPB_DMA_TCR_MAX; | ||
| 521 | |||
| 513 | shdma_chan_probe(sdev, schan, id); | 522 | shdma_chan_probe(sdev, schan, id); |
| 514 | 523 | ||
| 515 | if (pdev->id >= 0) | 524 | if (pdev->id >= 0) |
diff --git a/drivers/edac/sb_edac.c b/drivers/edac/sb_edac.c index 8472405c5586..d7f1b57bd3be 100644 --- a/drivers/edac/sb_edac.c +++ b/drivers/edac/sb_edac.c | |||
| @@ -945,7 +945,7 @@ static int get_memory_error_data(struct mem_ctl_info *mci, | |||
| 945 | u32 tad_offset; | 945 | u32 tad_offset; |
| 946 | u32 rir_way; | 946 | u32 rir_way; |
| 947 | u32 mb, kb; | 947 | u32 mb, kb; |
| 948 | u64 ch_addr, offset, limit, prv = 0; | 948 | u64 ch_addr, offset, limit = 0, prv = 0; |
| 949 | 949 | ||
| 950 | 950 | ||
| 951 | /* | 951 | /* |
diff --git a/drivers/extcon/extcon-arizona.c b/drivers/extcon/extcon-arizona.c index 3c55ec856e39..a287cece0593 100644 --- a/drivers/extcon/extcon-arizona.c +++ b/drivers/extcon/extcon-arizona.c | |||
| @@ -1082,7 +1082,7 @@ static void arizona_micd_set_level(struct arizona *arizona, int index, | |||
| 1082 | static int arizona_extcon_probe(struct platform_device *pdev) | 1082 | static int arizona_extcon_probe(struct platform_device *pdev) |
| 1083 | { | 1083 | { |
| 1084 | struct arizona *arizona = dev_get_drvdata(pdev->dev.parent); | 1084 | struct arizona *arizona = dev_get_drvdata(pdev->dev.parent); |
| 1085 | struct arizona_pdata *pdata; | 1085 | struct arizona_pdata *pdata = &arizona->pdata; |
| 1086 | struct arizona_extcon_info *info; | 1086 | struct arizona_extcon_info *info; |
| 1087 | unsigned int val; | 1087 | unsigned int val; |
| 1088 | int jack_irq_fall, jack_irq_rise; | 1088 | int jack_irq_fall, jack_irq_rise; |
| @@ -1091,8 +1091,6 @@ static int arizona_extcon_probe(struct platform_device *pdev) | |||
| 1091 | if (!arizona->dapm || !arizona->dapm->card) | 1091 | if (!arizona->dapm || !arizona->dapm->card) |
| 1092 | return -EPROBE_DEFER; | 1092 | return -EPROBE_DEFER; |
| 1093 | 1093 | ||
| 1094 | pdata = dev_get_platdata(arizona->dev); | ||
| 1095 | |||
| 1096 | info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL); | 1094 | info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL); |
| 1097 | if (!info) { | 1095 | if (!info) { |
| 1098 | dev_err(&pdev->dev, "Failed to allocate memory\n"); | 1096 | dev_err(&pdev->dev, "Failed to allocate memory\n"); |
diff --git a/drivers/extcon/extcon-class.c b/drivers/extcon/extcon-class.c index 15443d3b6be1..76322330cbd7 100644 --- a/drivers/extcon/extcon-class.c +++ b/drivers/extcon/extcon-class.c | |||
| @@ -792,6 +792,8 @@ void extcon_dev_unregister(struct extcon_dev *edev) | |||
| 792 | return; | 792 | return; |
| 793 | } | 793 | } |
| 794 | 794 | ||
| 795 | device_unregister(&edev->dev); | ||
| 796 | |||
| 795 | if (edev->mutually_exclusive && edev->max_supported) { | 797 | if (edev->mutually_exclusive && edev->max_supported) { |
| 796 | for (index = 0; edev->mutually_exclusive[index]; | 798 | for (index = 0; edev->mutually_exclusive[index]; |
| 797 | index++) | 799 | index++) |
| @@ -812,7 +814,6 @@ void extcon_dev_unregister(struct extcon_dev *edev) | |||
| 812 | if (switch_class) | 814 | if (switch_class) |
| 813 | class_compat_remove_link(switch_class, &edev->dev, NULL); | 815 | class_compat_remove_link(switch_class, &edev->dev, NULL); |
| 814 | #endif | 816 | #endif |
| 815 | device_unregister(&edev->dev); | ||
| 816 | put_device(&edev->dev); | 817 | put_device(&edev->dev); |
| 817 | } | 818 | } |
| 818 | EXPORT_SYMBOL_GPL(extcon_dev_unregister); | 819 | EXPORT_SYMBOL_GPL(extcon_dev_unregister); |
diff --git a/drivers/firewire/sbp2.c b/drivers/firewire/sbp2.c index 281029daf98c..b0bb056458a3 100644 --- a/drivers/firewire/sbp2.c +++ b/drivers/firewire/sbp2.c | |||
| @@ -1623,6 +1623,7 @@ static struct scsi_host_template scsi_driver_template = { | |||
| 1623 | .cmd_per_lun = 1, | 1623 | .cmd_per_lun = 1, |
| 1624 | .can_queue = 1, | 1624 | .can_queue = 1, |
| 1625 | .sdev_attrs = sbp2_scsi_sysfs_attrs, | 1625 | .sdev_attrs = sbp2_scsi_sysfs_attrs, |
| 1626 | .no_write_same = 1, | ||
| 1626 | }; | 1627 | }; |
| 1627 | 1628 | ||
| 1628 | MODULE_AUTHOR("Kristian Hoegsberg <krh@bitplanet.net>"); | 1629 | MODULE_AUTHOR("Kristian Hoegsberg <krh@bitplanet.net>"); |
diff --git a/drivers/firmware/efi/efi-pstore.c b/drivers/firmware/efi/efi-pstore.c index 5002d50e3781..743fd426f21b 100644 --- a/drivers/firmware/efi/efi-pstore.c +++ b/drivers/firmware/efi/efi-pstore.c | |||
| @@ -18,14 +18,12 @@ module_param_named(pstore_disable, efivars_pstore_disable, bool, 0644); | |||
| 18 | 18 | ||
| 19 | static int efi_pstore_open(struct pstore_info *psi) | 19 | static int efi_pstore_open(struct pstore_info *psi) |
| 20 | { | 20 | { |
| 21 | efivar_entry_iter_begin(); | ||
| 22 | psi->data = NULL; | 21 | psi->data = NULL; |
| 23 | return 0; | 22 | return 0; |
| 24 | } | 23 | } |
| 25 | 24 | ||
| 26 | static int efi_pstore_close(struct pstore_info *psi) | 25 | static int efi_pstore_close(struct pstore_info *psi) |
| 27 | { | 26 | { |
| 28 | efivar_entry_iter_end(); | ||
| 29 | psi->data = NULL; | 27 | psi->data = NULL; |
| 30 | return 0; | 28 | return 0; |
| 31 | } | 29 | } |
| @@ -39,6 +37,12 @@ struct pstore_read_data { | |||
| 39 | char **buf; | 37 | char **buf; |
| 40 | }; | 38 | }; |
| 41 | 39 | ||
| 40 | static inline u64 generic_id(unsigned long timestamp, | ||
| 41 | unsigned int part, int count) | ||
| 42 | { | ||
| 43 | return (timestamp * 100 + part) * 1000 + count; | ||
| 44 | } | ||
| 45 | |||
| 42 | static int efi_pstore_read_func(struct efivar_entry *entry, void *data) | 46 | static int efi_pstore_read_func(struct efivar_entry *entry, void *data) |
| 43 | { | 47 | { |
| 44 | efi_guid_t vendor = LINUX_EFI_CRASH_GUID; | 48 | efi_guid_t vendor = LINUX_EFI_CRASH_GUID; |
| @@ -57,7 +61,7 @@ static int efi_pstore_read_func(struct efivar_entry *entry, void *data) | |||
| 57 | 61 | ||
| 58 | if (sscanf(name, "dump-type%u-%u-%d-%lu-%c", | 62 | if (sscanf(name, "dump-type%u-%u-%d-%lu-%c", |
| 59 | cb_data->type, &part, &cnt, &time, &data_type) == 5) { | 63 | cb_data->type, &part, &cnt, &time, &data_type) == 5) { |
| 60 | *cb_data->id = part; | 64 | *cb_data->id = generic_id(time, part, cnt); |
| 61 | *cb_data->count = cnt; | 65 | *cb_data->count = cnt; |
| 62 | cb_data->timespec->tv_sec = time; | 66 | cb_data->timespec->tv_sec = time; |
| 63 | cb_data->timespec->tv_nsec = 0; | 67 | cb_data->timespec->tv_nsec = 0; |
| @@ -67,7 +71,7 @@ static int efi_pstore_read_func(struct efivar_entry *entry, void *data) | |||
| 67 | *cb_data->compressed = false; | 71 | *cb_data->compressed = false; |
| 68 | } else if (sscanf(name, "dump-type%u-%u-%d-%lu", | 72 | } else if (sscanf(name, "dump-type%u-%u-%d-%lu", |
| 69 | cb_data->type, &part, &cnt, &time) == 4) { | 73 | cb_data->type, &part, &cnt, &time) == 4) { |
| 70 | *cb_data->id = part; | 74 | *cb_data->id = generic_id(time, part, cnt); |
| 71 | *cb_data->count = cnt; | 75 | *cb_data->count = cnt; |
| 72 | cb_data->timespec->tv_sec = time; | 76 | cb_data->timespec->tv_sec = time; |
| 73 | cb_data->timespec->tv_nsec = 0; | 77 | cb_data->timespec->tv_nsec = 0; |
| @@ -79,7 +83,7 @@ static int efi_pstore_read_func(struct efivar_entry *entry, void *data) | |||
| 79 | * which doesn't support holding | 83 | * which doesn't support holding |
| 80 | * multiple logs, remains. | 84 | * multiple logs, remains. |
| 81 | */ | 85 | */ |
| 82 | *cb_data->id = part; | 86 | *cb_data->id = generic_id(time, part, 0); |
| 83 | *cb_data->count = 0; | 87 | *cb_data->count = 0; |
| 84 | cb_data->timespec->tv_sec = time; | 88 | cb_data->timespec->tv_sec = time; |
| 85 | cb_data->timespec->tv_nsec = 0; | 89 | cb_data->timespec->tv_nsec = 0; |
| @@ -91,19 +95,125 @@ static int efi_pstore_read_func(struct efivar_entry *entry, void *data) | |||
| 91 | __efivar_entry_get(entry, &entry->var.Attributes, | 95 | __efivar_entry_get(entry, &entry->var.Attributes, |
| 92 | &entry->var.DataSize, entry->var.Data); | 96 | &entry->var.DataSize, entry->var.Data); |
| 93 | size = entry->var.DataSize; | 97 | size = entry->var.DataSize; |
| 98 | memcpy(*cb_data->buf, entry->var.Data, | ||
| 99 | (size_t)min_t(unsigned long, EFIVARS_DATA_SIZE_MAX, size)); | ||
| 94 | 100 | ||
| 95 | *cb_data->buf = kmemdup(entry->var.Data, size, GFP_KERNEL); | ||
| 96 | if (*cb_data->buf == NULL) | ||
| 97 | return -ENOMEM; | ||
| 98 | return size; | 101 | return size; |
| 99 | } | 102 | } |
| 100 | 103 | ||
| 104 | /** | ||
| 105 | * efi_pstore_scan_sysfs_enter | ||
| 106 | * @entry: scanning entry | ||
| 107 | * @next: next entry | ||
| 108 | * @head: list head | ||
| 109 | */ | ||
| 110 | static void efi_pstore_scan_sysfs_enter(struct efivar_entry *pos, | ||
| 111 | struct efivar_entry *next, | ||
| 112 | struct list_head *head) | ||
| 113 | { | ||
| 114 | pos->scanning = true; | ||
| 115 | if (&next->list != head) | ||
| 116 | next->scanning = true; | ||
| 117 | } | ||
| 118 | |||
| 119 | /** | ||
| 120 | * __efi_pstore_scan_sysfs_exit | ||
| 121 | * @entry: deleting entry | ||
| 122 | * @turn_off_scanning: Check if a scanning flag should be turned off | ||
| 123 | */ | ||
| 124 | static inline void __efi_pstore_scan_sysfs_exit(struct efivar_entry *entry, | ||
| 125 | bool turn_off_scanning) | ||
| 126 | { | ||
| 127 | if (entry->deleting) { | ||
| 128 | list_del(&entry->list); | ||
| 129 | efivar_entry_iter_end(); | ||
| 130 | efivar_unregister(entry); | ||
| 131 | efivar_entry_iter_begin(); | ||
| 132 | } else if (turn_off_scanning) | ||
| 133 | entry->scanning = false; | ||
| 134 | } | ||
| 135 | |||
| 136 | /** | ||
| 137 | * efi_pstore_scan_sysfs_exit | ||
| 138 | * @pos: scanning entry | ||
| 139 | * @next: next entry | ||
| 140 | * @head: list head | ||
| 141 | * @stop: a flag checking if scanning will stop | ||
| 142 | */ | ||
| 143 | static void efi_pstore_scan_sysfs_exit(struct efivar_entry *pos, | ||
| 144 | struct efivar_entry *next, | ||
| 145 | struct list_head *head, bool stop) | ||
| 146 | { | ||
| 147 | __efi_pstore_scan_sysfs_exit(pos, true); | ||
| 148 | if (stop) | ||
| 149 | __efi_pstore_scan_sysfs_exit(next, &next->list != head); | ||
| 150 | } | ||
| 151 | |||
| 152 | /** | ||
| 153 | * efi_pstore_sysfs_entry_iter | ||
| 154 | * | ||
| 155 | * @data: function-specific data to pass to callback | ||
| 156 | * @pos: entry to begin iterating from | ||
| 157 | * | ||
| 158 | * You MUST call efivar_enter_iter_begin() before this function, and | ||
| 159 | * efivar_entry_iter_end() afterwards. | ||
| 160 | * | ||
| 161 | * It is possible to begin iteration from an arbitrary entry within | ||
| 162 | * the list by passing @pos. @pos is updated on return to point to | ||
| 163 | * the next entry of the last one passed to efi_pstore_read_func(). | ||
| 164 | * To begin iterating from the beginning of the list @pos must be %NULL. | ||
| 165 | */ | ||
| 166 | static int efi_pstore_sysfs_entry_iter(void *data, struct efivar_entry **pos) | ||
| 167 | { | ||
| 168 | struct efivar_entry *entry, *n; | ||
| 169 | struct list_head *head = &efivar_sysfs_list; | ||
| 170 | int size = 0; | ||
| 171 | |||
| 172 | if (!*pos) { | ||
| 173 | list_for_each_entry_safe(entry, n, head, list) { | ||
| 174 | efi_pstore_scan_sysfs_enter(entry, n, head); | ||
| 175 | |||
| 176 | size = efi_pstore_read_func(entry, data); | ||
| 177 | efi_pstore_scan_sysfs_exit(entry, n, head, size < 0); | ||
| 178 | if (size) | ||
| 179 | break; | ||
| 180 | } | ||
| 181 | *pos = n; | ||
| 182 | return size; | ||
| 183 | } | ||
| 184 | |||
| 185 | list_for_each_entry_safe_from((*pos), n, head, list) { | ||
| 186 | efi_pstore_scan_sysfs_enter((*pos), n, head); | ||
| 187 | |||
| 188 | size = efi_pstore_read_func((*pos), data); | ||
| 189 | efi_pstore_scan_sysfs_exit((*pos), n, head, size < 0); | ||
| 190 | if (size) | ||
| 191 | break; | ||
| 192 | } | ||
| 193 | *pos = n; | ||
| 194 | return size; | ||
| 195 | } | ||
| 196 | |||
| 197 | /** | ||
| 198 | * efi_pstore_read | ||
| 199 | * | ||
| 200 | * This function returns a size of NVRAM entry logged via efi_pstore_write(). | ||
| 201 | * The meaning and behavior of efi_pstore/pstore are as below. | ||
| 202 | * | ||
| 203 | * size > 0: Got data of an entry logged via efi_pstore_write() successfully, | ||
| 204 | * and pstore filesystem will continue reading subsequent entries. | ||
| 205 | * size == 0: Entry was not logged via efi_pstore_write(), | ||
| 206 | * and efi_pstore driver will continue reading subsequent entries. | ||
| 207 | * size < 0: Failed to get data of entry logging via efi_pstore_write(), | ||
| 208 | * and pstore will stop reading entry. | ||
| 209 | */ | ||
| 101 | static ssize_t efi_pstore_read(u64 *id, enum pstore_type_id *type, | 210 | static ssize_t efi_pstore_read(u64 *id, enum pstore_type_id *type, |
| 102 | int *count, struct timespec *timespec, | 211 | int *count, struct timespec *timespec, |
| 103 | char **buf, bool *compressed, | 212 | char **buf, bool *compressed, |
| 104 | struct pstore_info *psi) | 213 | struct pstore_info *psi) |
| 105 | { | 214 | { |
| 106 | struct pstore_read_data data; | 215 | struct pstore_read_data data; |
| 216 | ssize_t size; | ||
| 107 | 217 | ||
| 108 | data.id = id; | 218 | data.id = id; |
| 109 | data.type = type; | 219 | data.type = type; |
| @@ -112,8 +222,17 @@ static ssize_t efi_pstore_read(u64 *id, enum pstore_type_id *type, | |||
| 112 | data.compressed = compressed; | 222 | data.compressed = compressed; |
| 113 | data.buf = buf; | 223 | data.buf = buf; |
| 114 | 224 | ||
| 115 | return __efivar_entry_iter(efi_pstore_read_func, &efivar_sysfs_list, &data, | 225 | *data.buf = kzalloc(EFIVARS_DATA_SIZE_MAX, GFP_KERNEL); |
| 116 | (struct efivar_entry **)&psi->data); | 226 | if (!*data.buf) |
| 227 | return -ENOMEM; | ||
| 228 | |||
| 229 | efivar_entry_iter_begin(); | ||
| 230 | size = efi_pstore_sysfs_entry_iter(&data, | ||
| 231 | (struct efivar_entry **)&psi->data); | ||
| 232 | efivar_entry_iter_end(); | ||
| 233 | if (size <= 0) | ||
| 234 | kfree(*data.buf); | ||
| 235 | return size; | ||
| 117 | } | 236 | } |
| 118 | 237 | ||
| 119 | static int efi_pstore_write(enum pstore_type_id type, | 238 | static int efi_pstore_write(enum pstore_type_id type, |
| @@ -184,9 +303,17 @@ static int efi_pstore_erase_func(struct efivar_entry *entry, void *data) | |||
| 184 | return 0; | 303 | return 0; |
| 185 | } | 304 | } |
| 186 | 305 | ||
| 306 | if (entry->scanning) { | ||
| 307 | /* | ||
| 308 | * Skip deletion because this entry will be deleted | ||
| 309 | * after scanning is completed. | ||
| 310 | */ | ||
| 311 | entry->deleting = true; | ||
| 312 | } else | ||
| 313 | list_del(&entry->list); | ||
| 314 | |||
| 187 | /* found */ | 315 | /* found */ |
| 188 | __efivar_entry_delete(entry); | 316 | __efivar_entry_delete(entry); |
| 189 | list_del(&entry->list); | ||
| 190 | 317 | ||
| 191 | return 1; | 318 | return 1; |
| 192 | } | 319 | } |
| @@ -199,14 +326,16 @@ static int efi_pstore_erase(enum pstore_type_id type, u64 id, int count, | |||
| 199 | char name[DUMP_NAME_LEN]; | 326 | char name[DUMP_NAME_LEN]; |
| 200 | efi_char16_t efi_name[DUMP_NAME_LEN]; | 327 | efi_char16_t efi_name[DUMP_NAME_LEN]; |
| 201 | int found, i; | 328 | int found, i; |
| 329 | unsigned int part; | ||
| 202 | 330 | ||
| 203 | sprintf(name, "dump-type%u-%u-%d-%lu", type, (unsigned int)id, count, | 331 | do_div(id, 1000); |
| 204 | time.tv_sec); | 332 | part = do_div(id, 100); |
| 333 | sprintf(name, "dump-type%u-%u-%d-%lu", type, part, count, time.tv_sec); | ||
| 205 | 334 | ||
| 206 | for (i = 0; i < DUMP_NAME_LEN; i++) | 335 | for (i = 0; i < DUMP_NAME_LEN; i++) |
| 207 | efi_name[i] = name[i]; | 336 | efi_name[i] = name[i]; |
| 208 | 337 | ||
| 209 | edata.id = id; | 338 | edata.id = part; |
| 210 | edata.type = type; | 339 | edata.type = type; |
| 211 | edata.count = count; | 340 | edata.count = count; |
| 212 | edata.time = time; | 341 | edata.time = time; |
| @@ -214,10 +343,12 @@ static int efi_pstore_erase(enum pstore_type_id type, u64 id, int count, | |||
| 214 | 343 | ||
| 215 | efivar_entry_iter_begin(); | 344 | efivar_entry_iter_begin(); |
| 216 | found = __efivar_entry_iter(efi_pstore_erase_func, &efivar_sysfs_list, &edata, &entry); | 345 | found = __efivar_entry_iter(efi_pstore_erase_func, &efivar_sysfs_list, &edata, &entry); |
| 217 | efivar_entry_iter_end(); | ||
| 218 | 346 | ||
| 219 | if (found) | 347 | if (found && !entry->scanning) { |
| 348 | efivar_entry_iter_end(); | ||
| 220 | efivar_unregister(entry); | 349 | efivar_unregister(entry); |
| 350 | } else | ||
| 351 | efivar_entry_iter_end(); | ||
| 221 | 352 | ||
| 222 | return 0; | 353 | return 0; |
| 223 | } | 354 | } |
diff --git a/drivers/firmware/efi/efivars.c b/drivers/firmware/efi/efivars.c index 933eb027d527..3dc248239197 100644 --- a/drivers/firmware/efi/efivars.c +++ b/drivers/firmware/efi/efivars.c | |||
| @@ -383,12 +383,16 @@ static ssize_t efivar_delete(struct file *filp, struct kobject *kobj, | |||
| 383 | else if (__efivar_entry_delete(entry)) | 383 | else if (__efivar_entry_delete(entry)) |
| 384 | err = -EIO; | 384 | err = -EIO; |
| 385 | 385 | ||
| 386 | efivar_entry_iter_end(); | 386 | if (err) { |
| 387 | 387 | efivar_entry_iter_end(); | |
| 388 | if (err) | ||
| 389 | return err; | 388 | return err; |
| 389 | } | ||
| 390 | 390 | ||
| 391 | efivar_unregister(entry); | 391 | if (!entry->scanning) { |
| 392 | efivar_entry_iter_end(); | ||
| 393 | efivar_unregister(entry); | ||
| 394 | } else | ||
| 395 | efivar_entry_iter_end(); | ||
| 392 | 396 | ||
| 393 | /* It's dead Jim.... */ | 397 | /* It's dead Jim.... */ |
| 394 | return count; | 398 | return count; |
diff --git a/drivers/firmware/efi/vars.c b/drivers/firmware/efi/vars.c index 391c67b182d9..b22659cccca4 100644 --- a/drivers/firmware/efi/vars.c +++ b/drivers/firmware/efi/vars.c | |||
| @@ -683,8 +683,16 @@ struct efivar_entry *efivar_entry_find(efi_char16_t *name, efi_guid_t guid, | |||
| 683 | if (!found) | 683 | if (!found) |
| 684 | return NULL; | 684 | return NULL; |
| 685 | 685 | ||
| 686 | if (remove) | 686 | if (remove) { |
| 687 | list_del(&entry->list); | 687 | if (entry->scanning) { |
| 688 | /* | ||
| 689 | * The entry will be deleted | ||
| 690 | * after scanning is completed. | ||
| 691 | */ | ||
| 692 | entry->deleting = true; | ||
| 693 | } else | ||
| 694 | list_del(&entry->list); | ||
| 695 | } | ||
| 688 | 696 | ||
| 689 | return entry; | 697 | return entry; |
| 690 | } | 698 | } |
diff --git a/drivers/gpio/gpio-bcm-kona.c b/drivers/gpio/gpio-bcm-kona.c index 72c927dc3be1..54c18c220a60 100644 --- a/drivers/gpio/gpio-bcm-kona.c +++ b/drivers/gpio/gpio-bcm-kona.c | |||
| @@ -158,7 +158,7 @@ static int bcm_kona_gpio_get(struct gpio_chip *chip, unsigned gpio) | |||
| 158 | spin_unlock_irqrestore(&kona_gpio->lock, flags); | 158 | spin_unlock_irqrestore(&kona_gpio->lock, flags); |
| 159 | 159 | ||
| 160 | /* return the specified bit status */ | 160 | /* return the specified bit status */ |
| 161 | return !!(val & bit); | 161 | return !!(val & BIT(bit)); |
| 162 | } | 162 | } |
| 163 | 163 | ||
| 164 | static int bcm_kona_gpio_direction_input(struct gpio_chip *chip, unsigned gpio) | 164 | static int bcm_kona_gpio_direction_input(struct gpio_chip *chip, unsigned gpio) |
diff --git a/drivers/gpio/gpio-davinci.c b/drivers/gpio/gpio-davinci.c index 8847adf392b7..84be70157ad6 100644 --- a/drivers/gpio/gpio-davinci.c +++ b/drivers/gpio/gpio-davinci.c | |||
| @@ -327,7 +327,7 @@ static int gpio_to_irq_unbanked(struct gpio_chip *chip, unsigned offset) | |||
| 327 | * NOTE: we assume for now that only irqs in the first gpio_chip | 327 | * NOTE: we assume for now that only irqs in the first gpio_chip |
| 328 | * can provide direct-mapped IRQs to AINTC (up to 32 GPIOs). | 328 | * can provide direct-mapped IRQs to AINTC (up to 32 GPIOs). |
| 329 | */ | 329 | */ |
| 330 | if (offset < d->irq_base) | 330 | if (offset < d->gpio_unbanked) |
| 331 | return d->gpio_irq + offset; | 331 | return d->gpio_irq + offset; |
| 332 | else | 332 | else |
| 333 | return -ENODEV; | 333 | return -ENODEV; |
| @@ -419,6 +419,8 @@ static int davinci_gpio_irq_setup(struct platform_device *pdev) | |||
| 419 | 419 | ||
| 420 | /* pass "bank 0" GPIO IRQs to AINTC */ | 420 | /* pass "bank 0" GPIO IRQs to AINTC */ |
| 421 | chips[0].chip.to_irq = gpio_to_irq_unbanked; | 421 | chips[0].chip.to_irq = gpio_to_irq_unbanked; |
| 422 | chips[0].gpio_irq = bank_irq; | ||
| 423 | chips[0].gpio_unbanked = pdata->gpio_unbanked; | ||
| 422 | binten = BIT(0); | 424 | binten = BIT(0); |
| 423 | 425 | ||
| 424 | /* AINTC handles mask/unmask; GPIO handles triggering */ | 426 | /* AINTC handles mask/unmask; GPIO handles triggering */ |
diff --git a/drivers/gpio/gpio-mpc8xxx.c b/drivers/gpio/gpio-mpc8xxx.c index 914e859e3eda..d7d6d72eba33 100644 --- a/drivers/gpio/gpio-mpc8xxx.c +++ b/drivers/gpio/gpio-mpc8xxx.c | |||
| @@ -70,10 +70,14 @@ static int mpc8572_gpio_get(struct gpio_chip *gc, unsigned int gpio) | |||
| 70 | u32 val; | 70 | u32 val; |
| 71 | struct of_mm_gpio_chip *mm = to_of_mm_gpio_chip(gc); | 71 | struct of_mm_gpio_chip *mm = to_of_mm_gpio_chip(gc); |
| 72 | struct mpc8xxx_gpio_chip *mpc8xxx_gc = to_mpc8xxx_gpio_chip(mm); | 72 | struct mpc8xxx_gpio_chip *mpc8xxx_gc = to_mpc8xxx_gpio_chip(mm); |
| 73 | u32 out_mask, out_shadow; | ||
| 73 | 74 | ||
| 74 | val = in_be32(mm->regs + GPIO_DAT) & ~in_be32(mm->regs + GPIO_DIR); | 75 | out_mask = in_be32(mm->regs + GPIO_DIR); |
| 75 | 76 | ||
| 76 | return (val | mpc8xxx_gc->data) & mpc8xxx_gpio2mask(gpio); | 77 | val = in_be32(mm->regs + GPIO_DAT) & ~out_mask; |
| 78 | out_shadow = mpc8xxx_gc->data & out_mask; | ||
| 79 | |||
| 80 | return (val | out_shadow) & mpc8xxx_gpio2mask(gpio); | ||
| 77 | } | 81 | } |
| 78 | 82 | ||
| 79 | static int mpc8xxx_gpio_get(struct gpio_chip *gc, unsigned int gpio) | 83 | static int mpc8xxx_gpio_get(struct gpio_chip *gc, unsigned int gpio) |
diff --git a/drivers/gpio/gpio-msm-v2.c b/drivers/gpio/gpio-msm-v2.c index f7a0cc4da950..7b37300973db 100644 --- a/drivers/gpio/gpio-msm-v2.c +++ b/drivers/gpio/gpio-msm-v2.c | |||
| @@ -102,7 +102,7 @@ struct msm_gpio_dev { | |||
| 102 | DECLARE_BITMAP(wake_irqs, MAX_NR_GPIO); | 102 | DECLARE_BITMAP(wake_irqs, MAX_NR_GPIO); |
| 103 | DECLARE_BITMAP(dual_edge_irqs, MAX_NR_GPIO); | 103 | DECLARE_BITMAP(dual_edge_irqs, MAX_NR_GPIO); |
| 104 | struct irq_domain *domain; | 104 | struct irq_domain *domain; |
| 105 | unsigned int summary_irq; | 105 | int summary_irq; |
| 106 | void __iomem *msm_tlmm_base; | 106 | void __iomem *msm_tlmm_base; |
| 107 | }; | 107 | }; |
| 108 | 108 | ||
diff --git a/drivers/gpio/gpio-mvebu.c b/drivers/gpio/gpio-mvebu.c index 3c3321f94053..db3129043e63 100644 --- a/drivers/gpio/gpio-mvebu.c +++ b/drivers/gpio/gpio-mvebu.c | |||
| @@ -79,7 +79,7 @@ struct mvebu_gpio_chip { | |||
| 79 | spinlock_t lock; | 79 | spinlock_t lock; |
| 80 | void __iomem *membase; | 80 | void __iomem *membase; |
| 81 | void __iomem *percpu_membase; | 81 | void __iomem *percpu_membase; |
| 82 | unsigned int irqbase; | 82 | int irqbase; |
| 83 | struct irq_domain *domain; | 83 | struct irq_domain *domain; |
| 84 | int soc_variant; | 84 | int soc_variant; |
| 85 | }; | 85 | }; |
diff --git a/drivers/gpio/gpio-pl061.c b/drivers/gpio/gpio-pl061.c index f22f7f3e2e53..b4d42112d02d 100644 --- a/drivers/gpio/gpio-pl061.c +++ b/drivers/gpio/gpio-pl061.c | |||
| @@ -286,11 +286,6 @@ static int pl061_probe(struct amba_device *adev, const struct amba_id *id) | |||
| 286 | if (!chip->base) | 286 | if (!chip->base) |
| 287 | return -ENOMEM; | 287 | return -ENOMEM; |
| 288 | 288 | ||
| 289 | chip->domain = irq_domain_add_simple(adev->dev.of_node, PL061_GPIO_NR, | ||
| 290 | irq_base, &pl061_domain_ops, chip); | ||
| 291 | if (!chip->domain) | ||
| 292 | return -ENODEV; | ||
| 293 | |||
| 294 | spin_lock_init(&chip->lock); | 289 | spin_lock_init(&chip->lock); |
| 295 | 290 | ||
| 296 | chip->gc.request = pl061_gpio_request; | 291 | chip->gc.request = pl061_gpio_request; |
| @@ -320,6 +315,11 @@ static int pl061_probe(struct amba_device *adev, const struct amba_id *id) | |||
| 320 | irq_set_chained_handler(irq, pl061_irq_handler); | 315 | irq_set_chained_handler(irq, pl061_irq_handler); |
| 321 | irq_set_handler_data(irq, chip); | 316 | irq_set_handler_data(irq, chip); |
| 322 | 317 | ||
| 318 | chip->domain = irq_domain_add_simple(adev->dev.of_node, PL061_GPIO_NR, | ||
| 319 | irq_base, &pl061_domain_ops, chip); | ||
| 320 | if (!chip->domain) | ||
| 321 | return -ENODEV; | ||
| 322 | |||
| 323 | for (i = 0; i < PL061_GPIO_NR; i++) { | 323 | for (i = 0; i < PL061_GPIO_NR; i++) { |
| 324 | if (pdata) { | 324 | if (pdata) { |
| 325 | if (pdata->directions & (1 << i)) | 325 | if (pdata->directions & (1 << i)) |
diff --git a/drivers/gpio/gpio-rcar.c b/drivers/gpio/gpio-rcar.c index d3f15ae93bd3..fe088a30567a 100644 --- a/drivers/gpio/gpio-rcar.c +++ b/drivers/gpio/gpio-rcar.c | |||
| @@ -381,7 +381,7 @@ static int gpio_rcar_probe(struct platform_device *pdev) | |||
| 381 | if (!p->irq_domain) { | 381 | if (!p->irq_domain) { |
| 382 | ret = -ENXIO; | 382 | ret = -ENXIO; |
| 383 | dev_err(&pdev->dev, "cannot initialize irq domain\n"); | 383 | dev_err(&pdev->dev, "cannot initialize irq domain\n"); |
| 384 | goto err1; | 384 | goto err0; |
| 385 | } | 385 | } |
| 386 | 386 | ||
| 387 | if (devm_request_irq(&pdev->dev, irq->start, | 387 | if (devm_request_irq(&pdev->dev, irq->start, |
diff --git a/drivers/gpio/gpio-tb10x.c b/drivers/gpio/gpio-tb10x.c index 0502b9a041a5..da071ddbad99 100644 --- a/drivers/gpio/gpio-tb10x.c +++ b/drivers/gpio/gpio-tb10x.c | |||
| @@ -132,6 +132,7 @@ static int tb10x_gpio_direction_out(struct gpio_chip *chip, | |||
| 132 | int mask = BIT(offset); | 132 | int mask = BIT(offset); |
| 133 | int val = TB10X_GPIO_DIR_OUT << offset; | 133 | int val = TB10X_GPIO_DIR_OUT << offset; |
| 134 | 134 | ||
| 135 | tb10x_gpio_set(chip, offset, value); | ||
| 135 | tb10x_set_bits(tb10x_gpio, OFFSET_TO_REG_DDR, mask, val); | 136 | tb10x_set_bits(tb10x_gpio, OFFSET_TO_REG_DDR, mask, val); |
| 136 | 137 | ||
| 137 | return 0; | 138 | return 0; |
diff --git a/drivers/gpio/gpio-twl4030.c b/drivers/gpio/gpio-twl4030.c index 0c7e891c8651..b97d6a6577b9 100644 --- a/drivers/gpio/gpio-twl4030.c +++ b/drivers/gpio/gpio-twl4030.c | |||
| @@ -354,17 +354,18 @@ static void twl_set(struct gpio_chip *chip, unsigned offset, int value) | |||
| 354 | static int twl_direction_out(struct gpio_chip *chip, unsigned offset, int value) | 354 | static int twl_direction_out(struct gpio_chip *chip, unsigned offset, int value) |
| 355 | { | 355 | { |
| 356 | struct gpio_twl4030_priv *priv = to_gpio_twl4030(chip); | 356 | struct gpio_twl4030_priv *priv = to_gpio_twl4030(chip); |
| 357 | int ret = -EINVAL; | ||
| 357 | 358 | ||
| 358 | mutex_lock(&priv->mutex); | 359 | mutex_lock(&priv->mutex); |
| 359 | if (offset < TWL4030_GPIO_MAX) | 360 | if (offset < TWL4030_GPIO_MAX) |
| 360 | twl4030_set_gpio_dataout(offset, value); | 361 | ret = twl4030_set_gpio_direction(offset, 0); |
| 361 | 362 | ||
| 362 | priv->direction |= BIT(offset); | 363 | priv->direction |= BIT(offset); |
| 363 | mutex_unlock(&priv->mutex); | 364 | mutex_unlock(&priv->mutex); |
| 364 | 365 | ||
| 365 | twl_set(chip, offset, value); | 366 | twl_set(chip, offset, value); |
| 366 | 367 | ||
| 367 | return 0; | 368 | return ret; |
| 368 | } | 369 | } |
| 369 | 370 | ||
| 370 | static int twl_to_irq(struct gpio_chip *chip, unsigned offset) | 371 | static int twl_to_irq(struct gpio_chip *chip, unsigned offset) |
| @@ -435,7 +436,8 @@ static int gpio_twl4030_debounce(u32 debounce, u8 mmc_cd) | |||
| 435 | 436 | ||
| 436 | static int gpio_twl4030_remove(struct platform_device *pdev); | 437 | static int gpio_twl4030_remove(struct platform_device *pdev); |
| 437 | 438 | ||
| 438 | static struct twl4030_gpio_platform_data *of_gpio_twl4030(struct device *dev) | 439 | static struct twl4030_gpio_platform_data *of_gpio_twl4030(struct device *dev, |
| 440 | struct twl4030_gpio_platform_data *pdata) | ||
| 439 | { | 441 | { |
| 440 | struct twl4030_gpio_platform_data *omap_twl_info; | 442 | struct twl4030_gpio_platform_data *omap_twl_info; |
| 441 | 443 | ||
| @@ -443,6 +445,9 @@ static struct twl4030_gpio_platform_data *of_gpio_twl4030(struct device *dev) | |||
| 443 | if (!omap_twl_info) | 445 | if (!omap_twl_info) |
| 444 | return NULL; | 446 | return NULL; |
| 445 | 447 | ||
| 448 | if (pdata) | ||
| 449 | *omap_twl_info = *pdata; | ||
| 450 | |||
| 446 | omap_twl_info->use_leds = of_property_read_bool(dev->of_node, | 451 | omap_twl_info->use_leds = of_property_read_bool(dev->of_node, |
| 447 | "ti,use-leds"); | 452 | "ti,use-leds"); |
| 448 | 453 | ||
| @@ -500,7 +505,7 @@ no_irqs: | |||
| 500 | mutex_init(&priv->mutex); | 505 | mutex_init(&priv->mutex); |
| 501 | 506 | ||
| 502 | if (node) | 507 | if (node) |
| 503 | pdata = of_gpio_twl4030(&pdev->dev); | 508 | pdata = of_gpio_twl4030(&pdev->dev, pdata); |
| 504 | 509 | ||
| 505 | if (pdata == NULL) { | 510 | if (pdata == NULL) { |
| 506 | dev_err(&pdev->dev, "Platform data is missing\n"); | 511 | dev_err(&pdev->dev, "Platform data is missing\n"); |
diff --git a/drivers/gpio/gpio-ucb1400.c b/drivers/gpio/gpio-ucb1400.c index 1a605f2a0f55..06fb5cf99ded 100644 --- a/drivers/gpio/gpio-ucb1400.c +++ b/drivers/gpio/gpio-ucb1400.c | |||
| @@ -105,3 +105,4 @@ module_platform_driver(ucb1400_gpio_driver); | |||
| 105 | 105 | ||
| 106 | MODULE_DESCRIPTION("Philips UCB1400 GPIO driver"); | 106 | MODULE_DESCRIPTION("Philips UCB1400 GPIO driver"); |
| 107 | MODULE_LICENSE("GPL"); | 107 | MODULE_LICENSE("GPL"); |
| 108 | MODULE_ALIAS("platform:ucb1400_gpio"); | ||
diff --git a/drivers/gpio/gpiolib.c b/drivers/gpio/gpiolib.c index 4e10b10d3ddd..85f772c0b26a 100644 --- a/drivers/gpio/gpiolib.c +++ b/drivers/gpio/gpiolib.c | |||
| @@ -14,6 +14,7 @@ | |||
| 14 | #include <linux/idr.h> | 14 | #include <linux/idr.h> |
| 15 | #include <linux/slab.h> | 15 | #include <linux/slab.h> |
| 16 | #include <linux/acpi.h> | 16 | #include <linux/acpi.h> |
| 17 | #include <linux/gpio/driver.h> | ||
| 17 | 18 | ||
| 18 | #define CREATE_TRACE_POINTS | 19 | #define CREATE_TRACE_POINTS |
| 19 | #include <trace/events/gpio.h> | 20 | #include <trace/events/gpio.h> |
| @@ -1308,6 +1309,18 @@ struct gpio_chip *gpiochip_find(void *data, | |||
| 1308 | } | 1309 | } |
| 1309 | EXPORT_SYMBOL_GPL(gpiochip_find); | 1310 | EXPORT_SYMBOL_GPL(gpiochip_find); |
| 1310 | 1311 | ||
| 1312 | static int gpiochip_match_name(struct gpio_chip *chip, void *data) | ||
| 1313 | { | ||
| 1314 | const char *name = data; | ||
| 1315 | |||
| 1316 | return !strcmp(chip->label, name); | ||
| 1317 | } | ||
| 1318 | |||
| 1319 | static struct gpio_chip *find_chip_by_name(const char *name) | ||
| 1320 | { | ||
| 1321 | return gpiochip_find((void *)name, gpiochip_match_name); | ||
| 1322 | } | ||
| 1323 | |||
| 1311 | #ifdef CONFIG_PINCTRL | 1324 | #ifdef CONFIG_PINCTRL |
| 1312 | 1325 | ||
| 1313 | /** | 1326 | /** |
| @@ -1341,8 +1354,10 @@ int gpiochip_add_pingroup_range(struct gpio_chip *chip, | |||
| 1341 | ret = pinctrl_get_group_pins(pctldev, pin_group, | 1354 | ret = pinctrl_get_group_pins(pctldev, pin_group, |
| 1342 | &pin_range->range.pins, | 1355 | &pin_range->range.pins, |
| 1343 | &pin_range->range.npins); | 1356 | &pin_range->range.npins); |
| 1344 | if (ret < 0) | 1357 | if (ret < 0) { |
| 1358 | kfree(pin_range); | ||
| 1345 | return ret; | 1359 | return ret; |
| 1360 | } | ||
| 1346 | 1361 | ||
| 1347 | pinctrl_add_gpio_range(pctldev, &pin_range->range); | 1362 | pinctrl_add_gpio_range(pctldev, &pin_range->range); |
| 1348 | 1363 | ||
| @@ -2260,26 +2275,10 @@ void gpiod_add_table(struct gpiod_lookup *table, size_t size) | |||
| 2260 | mutex_unlock(&gpio_lookup_lock); | 2275 | mutex_unlock(&gpio_lookup_lock); |
| 2261 | } | 2276 | } |
| 2262 | 2277 | ||
| 2263 | /* | ||
| 2264 | * Caller must have a acquired gpio_lookup_lock | ||
| 2265 | */ | ||
| 2266 | static struct gpio_chip *find_chip_by_name(const char *name) | ||
| 2267 | { | ||
| 2268 | struct gpio_chip *chip = NULL; | ||
| 2269 | |||
| 2270 | list_for_each_entry(chip, &gpio_lookup_list, list) { | ||
| 2271 | if (chip->label == NULL) | ||
| 2272 | continue; | ||
| 2273 | if (!strcmp(chip->label, name)) | ||
| 2274 | break; | ||
| 2275 | } | ||
| 2276 | |||
| 2277 | return chip; | ||
| 2278 | } | ||
| 2279 | |||
| 2280 | #ifdef CONFIG_OF | 2278 | #ifdef CONFIG_OF |
| 2281 | static struct gpio_desc *of_find_gpio(struct device *dev, const char *con_id, | 2279 | static struct gpio_desc *of_find_gpio(struct device *dev, const char *con_id, |
| 2282 | unsigned int idx, unsigned long *flags) | 2280 | unsigned int idx, |
| 2281 | enum gpio_lookup_flags *flags) | ||
| 2283 | { | 2282 | { |
| 2284 | char prop_name[32]; /* 32 is max size of property name */ | 2283 | char prop_name[32]; /* 32 is max size of property name */ |
| 2285 | enum of_gpio_flags of_flags; | 2284 | enum of_gpio_flags of_flags; |
| @@ -2297,20 +2296,22 @@ static struct gpio_desc *of_find_gpio(struct device *dev, const char *con_id, | |||
| 2297 | return desc; | 2296 | return desc; |
| 2298 | 2297 | ||
| 2299 | if (of_flags & OF_GPIO_ACTIVE_LOW) | 2298 | if (of_flags & OF_GPIO_ACTIVE_LOW) |
| 2300 | *flags |= GPIOF_ACTIVE_LOW; | 2299 | *flags |= GPIO_ACTIVE_LOW; |
| 2301 | 2300 | ||
| 2302 | return desc; | 2301 | return desc; |
| 2303 | } | 2302 | } |
| 2304 | #else | 2303 | #else |
| 2305 | static struct gpio_desc *of_find_gpio(struct device *dev, const char *con_id, | 2304 | static struct gpio_desc *of_find_gpio(struct device *dev, const char *con_id, |
| 2306 | unsigned int idx, unsigned long *flags) | 2305 | unsigned int idx, |
| 2306 | enum gpio_lookup_flags *flags) | ||
| 2307 | { | 2307 | { |
| 2308 | return ERR_PTR(-ENODEV); | 2308 | return ERR_PTR(-ENODEV); |
| 2309 | } | 2309 | } |
| 2310 | #endif | 2310 | #endif |
| 2311 | 2311 | ||
| 2312 | static struct gpio_desc *acpi_find_gpio(struct device *dev, const char *con_id, | 2312 | static struct gpio_desc *acpi_find_gpio(struct device *dev, const char *con_id, |
| 2313 | unsigned int idx, unsigned long *flags) | 2313 | unsigned int idx, |
| 2314 | enum gpio_lookup_flags *flags) | ||
| 2314 | { | 2315 | { |
| 2315 | struct acpi_gpio_info info; | 2316 | struct acpi_gpio_info info; |
| 2316 | struct gpio_desc *desc; | 2317 | struct gpio_desc *desc; |
| @@ -2320,13 +2321,14 @@ static struct gpio_desc *acpi_find_gpio(struct device *dev, const char *con_id, | |||
| 2320 | return desc; | 2321 | return desc; |
| 2321 | 2322 | ||
| 2322 | if (info.gpioint && info.active_low) | 2323 | if (info.gpioint && info.active_low) |
| 2323 | *flags |= GPIOF_ACTIVE_LOW; | 2324 | *flags |= GPIO_ACTIVE_LOW; |
| 2324 | 2325 | ||
| 2325 | return desc; | 2326 | return desc; |
| 2326 | } | 2327 | } |
| 2327 | 2328 | ||
| 2328 | static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id, | 2329 | static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id, |
| 2329 | unsigned int idx, unsigned long *flags) | 2330 | unsigned int idx, |
| 2331 | enum gpio_lookup_flags *flags) | ||
| 2330 | { | 2332 | { |
| 2331 | const char *dev_id = dev ? dev_name(dev) : NULL; | 2333 | const char *dev_id = dev ? dev_name(dev) : NULL; |
| 2332 | struct gpio_desc *desc = ERR_PTR(-ENODEV); | 2334 | struct gpio_desc *desc = ERR_PTR(-ENODEV); |
| @@ -2366,7 +2368,7 @@ static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id, | |||
| 2366 | continue; | 2368 | continue; |
| 2367 | } | 2369 | } |
| 2368 | 2370 | ||
| 2369 | if (chip->ngpio >= p->chip_hwnum) { | 2371 | if (chip->ngpio <= p->chip_hwnum) { |
| 2370 | dev_warn(dev, "GPIO chip %s has %d GPIOs\n", | 2372 | dev_warn(dev, "GPIO chip %s has %d GPIOs\n", |
| 2371 | chip->label, chip->ngpio); | 2373 | chip->label, chip->ngpio); |
| 2372 | continue; | 2374 | continue; |
| @@ -2416,9 +2418,9 @@ struct gpio_desc *__must_check gpiod_get_index(struct device *dev, | |||
| 2416 | const char *con_id, | 2418 | const char *con_id, |
| 2417 | unsigned int idx) | 2419 | unsigned int idx) |
| 2418 | { | 2420 | { |
| 2419 | struct gpio_desc *desc; | 2421 | struct gpio_desc *desc = NULL; |
| 2420 | int status; | 2422 | int status; |
| 2421 | unsigned long flags = 0; | 2423 | enum gpio_lookup_flags flags = 0; |
| 2422 | 2424 | ||
| 2423 | dev_dbg(dev, "GPIO lookup for consumer %s\n", con_id); | 2425 | dev_dbg(dev, "GPIO lookup for consumer %s\n", con_id); |
| 2424 | 2426 | ||
| @@ -2429,13 +2431,23 @@ struct gpio_desc *__must_check gpiod_get_index(struct device *dev, | |||
| 2429 | } else if (IS_ENABLED(CONFIG_ACPI) && dev && ACPI_HANDLE(dev)) { | 2431 | } else if (IS_ENABLED(CONFIG_ACPI) && dev && ACPI_HANDLE(dev)) { |
| 2430 | dev_dbg(dev, "using ACPI for GPIO lookup\n"); | 2432 | dev_dbg(dev, "using ACPI for GPIO lookup\n"); |
| 2431 | desc = acpi_find_gpio(dev, con_id, idx, &flags); | 2433 | desc = acpi_find_gpio(dev, con_id, idx, &flags); |
| 2432 | } else { | 2434 | } |
| 2435 | |||
| 2436 | /* | ||
| 2437 | * Either we are not using DT or ACPI, or their lookup did not return | ||
| 2438 | * a result. In that case, use platform lookup as a fallback. | ||
| 2439 | */ | ||
| 2440 | if (!desc || IS_ERR(desc)) { | ||
| 2441 | struct gpio_desc *pdesc; | ||
| 2433 | dev_dbg(dev, "using lookup tables for GPIO lookup"); | 2442 | dev_dbg(dev, "using lookup tables for GPIO lookup"); |
| 2434 | desc = gpiod_find(dev, con_id, idx, &flags); | 2443 | pdesc = gpiod_find(dev, con_id, idx, &flags); |
| 2444 | /* If used as fallback, do not replace the previous error */ | ||
| 2445 | if (!IS_ERR(pdesc) || !desc) | ||
| 2446 | desc = pdesc; | ||
| 2435 | } | 2447 | } |
| 2436 | 2448 | ||
| 2437 | if (IS_ERR(desc)) { | 2449 | if (IS_ERR(desc)) { |
| 2438 | dev_warn(dev, "lookup for GPIO %s failed\n", con_id); | 2450 | dev_dbg(dev, "lookup for GPIO %s failed\n", con_id); |
| 2439 | return desc; | 2451 | return desc; |
| 2440 | } | 2452 | } |
| 2441 | 2453 | ||
| @@ -2444,8 +2456,12 @@ struct gpio_desc *__must_check gpiod_get_index(struct device *dev, | |||
| 2444 | if (status < 0) | 2456 | if (status < 0) |
| 2445 | return ERR_PTR(status); | 2457 | return ERR_PTR(status); |
| 2446 | 2458 | ||
| 2447 | if (flags & GPIOF_ACTIVE_LOW) | 2459 | if (flags & GPIO_ACTIVE_LOW) |
| 2448 | set_bit(FLAG_ACTIVE_LOW, &desc->flags); | 2460 | set_bit(FLAG_ACTIVE_LOW, &desc->flags); |
| 2461 | if (flags & GPIO_OPEN_DRAIN) | ||
| 2462 | set_bit(FLAG_OPEN_DRAIN, &desc->flags); | ||
| 2463 | if (flags & GPIO_OPEN_SOURCE) | ||
| 2464 | set_bit(FLAG_OPEN_SOURCE, &desc->flags); | ||
| 2449 | 2465 | ||
| 2450 | return desc; | 2466 | return desc; |
| 2451 | } | 2467 | } |
diff --git a/drivers/gpu/drm/drm_edid.c b/drivers/gpu/drm/drm_edid.c index fb7cf0e796f6..0a1e4a5f4234 100644 --- a/drivers/gpu/drm/drm_edid.c +++ b/drivers/gpu/drm/drm_edid.c | |||
| @@ -2674,7 +2674,7 @@ static int add_3d_struct_modes(struct drm_connector *connector, u16 structure, | |||
| 2674 | int modes = 0; | 2674 | int modes = 0; |
| 2675 | u8 cea_mode; | 2675 | u8 cea_mode; |
| 2676 | 2676 | ||
| 2677 | if (video_db == NULL || video_index > video_len) | 2677 | if (video_db == NULL || video_index >= video_len) |
| 2678 | return 0; | 2678 | return 0; |
| 2679 | 2679 | ||
| 2680 | /* CEA modes are numbered 1..127 */ | 2680 | /* CEA modes are numbered 1..127 */ |
| @@ -2701,7 +2701,7 @@ static int add_3d_struct_modes(struct drm_connector *connector, u16 structure, | |||
| 2701 | if (structure & (1 << 8)) { | 2701 | if (structure & (1 << 8)) { |
| 2702 | newmode = drm_mode_duplicate(dev, &edid_cea_modes[cea_mode]); | 2702 | newmode = drm_mode_duplicate(dev, &edid_cea_modes[cea_mode]); |
| 2703 | if (newmode) { | 2703 | if (newmode) { |
| 2704 | newmode->flags = DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF; | 2704 | newmode->flags |= DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF; |
| 2705 | drm_mode_probed_add(connector, newmode); | 2705 | drm_mode_probed_add(connector, newmode); |
| 2706 | modes++; | 2706 | modes++; |
| 2707 | } | 2707 | } |
diff --git a/drivers/gpu/drm/drm_sysfs.c b/drivers/gpu/drm/drm_sysfs.c index bd2bca395792..c22c3097c3e8 100644 --- a/drivers/gpu/drm/drm_sysfs.c +++ b/drivers/gpu/drm/drm_sysfs.c | |||
| @@ -516,7 +516,7 @@ int drm_sysfs_device_add(struct drm_minor *minor) | |||
| 516 | minor_str = "card%d"; | 516 | minor_str = "card%d"; |
| 517 | 517 | ||
| 518 | minor->kdev = kzalloc(sizeof(*minor->kdev), GFP_KERNEL); | 518 | minor->kdev = kzalloc(sizeof(*minor->kdev), GFP_KERNEL); |
| 519 | if (!minor->dev) { | 519 | if (!minor->kdev) { |
| 520 | r = -ENOMEM; | 520 | r = -ENOMEM; |
| 521 | goto error; | 521 | goto error; |
| 522 | } | 522 | } |
diff --git a/drivers/gpu/drm/exynos/exynos_drm_drv.c b/drivers/gpu/drm/exynos/exynos_drm_drv.c index b676006a95a0..22b8f5eced80 100644 --- a/drivers/gpu/drm/exynos/exynos_drm_drv.c +++ b/drivers/gpu/drm/exynos/exynos_drm_drv.c | |||
| @@ -173,28 +173,37 @@ static int exynos_drm_open(struct drm_device *dev, struct drm_file *file) | |||
| 173 | static void exynos_drm_preclose(struct drm_device *dev, | 173 | static void exynos_drm_preclose(struct drm_device *dev, |
| 174 | struct drm_file *file) | 174 | struct drm_file *file) |
| 175 | { | 175 | { |
| 176 | exynos_drm_subdrv_close(dev, file); | ||
| 177 | } | ||
| 178 | |||
| 179 | static void exynos_drm_postclose(struct drm_device *dev, struct drm_file *file) | ||
| 180 | { | ||
| 176 | struct exynos_drm_private *private = dev->dev_private; | 181 | struct exynos_drm_private *private = dev->dev_private; |
| 177 | struct drm_pending_vblank_event *e, *t; | 182 | struct drm_pending_vblank_event *v, *vt; |
| 183 | struct drm_pending_event *e, *et; | ||
| 178 | unsigned long flags; | 184 | unsigned long flags; |
| 179 | 185 | ||
| 180 | /* release events of current file */ | 186 | if (!file->driver_priv) |
| 187 | return; | ||
| 188 | |||
| 189 | /* Release all events not unhandled by page flip handler. */ | ||
| 181 | spin_lock_irqsave(&dev->event_lock, flags); | 190 | spin_lock_irqsave(&dev->event_lock, flags); |
| 182 | list_for_each_entry_safe(e, t, &private->pageflip_event_list, | 191 | list_for_each_entry_safe(v, vt, &private->pageflip_event_list, |
| 183 | base.link) { | 192 | base.link) { |
| 184 | if (e->base.file_priv == file) { | 193 | if (v->base.file_priv == file) { |
| 185 | list_del(&e->base.link); | 194 | list_del(&v->base.link); |
| 186 | e->base.destroy(&e->base); | 195 | drm_vblank_put(dev, v->pipe); |
| 196 | v->base.destroy(&v->base); | ||
| 187 | } | 197 | } |
| 188 | } | 198 | } |
| 189 | spin_unlock_irqrestore(&dev->event_lock, flags); | ||
| 190 | 199 | ||
| 191 | exynos_drm_subdrv_close(dev, file); | 200 | /* Release all events handled by page flip handler but not freed. */ |
| 192 | } | 201 | list_for_each_entry_safe(e, et, &file->event_list, link) { |
| 202 | list_del(&e->link); | ||
| 203 | e->destroy(e); | ||
| 204 | } | ||
| 205 | spin_unlock_irqrestore(&dev->event_lock, flags); | ||
| 193 | 206 | ||
| 194 | static void exynos_drm_postclose(struct drm_device *dev, struct drm_file *file) | ||
| 195 | { | ||
| 196 | if (!file->driver_priv) | ||
| 197 | return; | ||
| 198 | 207 | ||
| 199 | kfree(file->driver_priv); | 208 | kfree(file->driver_priv); |
| 200 | file->driver_priv = NULL; | 209 | file->driver_priv = NULL; |
diff --git a/drivers/gpu/drm/exynos/exynos_drm_fimd.c b/drivers/gpu/drm/exynos/exynos_drm_fimd.c index 23da72b5eae9..a61878bf5dcd 100644 --- a/drivers/gpu/drm/exynos/exynos_drm_fimd.c +++ b/drivers/gpu/drm/exynos/exynos_drm_fimd.c | |||
| @@ -31,7 +31,7 @@ | |||
| 31 | #include "exynos_drm_iommu.h" | 31 | #include "exynos_drm_iommu.h" |
| 32 | 32 | ||
| 33 | /* | 33 | /* |
| 34 | * FIMD is stand for Fully Interactive Mobile Display and | 34 | * FIMD stands for Fully Interactive Mobile Display and |
| 35 | * as a display controller, it transfers contents drawn on memory | 35 | * as a display controller, it transfers contents drawn on memory |
| 36 | * to a LCD Panel through Display Interfaces such as RGB or | 36 | * to a LCD Panel through Display Interfaces such as RGB or |
| 37 | * CPU Interface. | 37 | * CPU Interface. |
diff --git a/drivers/gpu/drm/i915/i915_drv.c b/drivers/gpu/drm/i915/i915_drv.c index 989be12cdd6e..2e367a1c6a64 100644 --- a/drivers/gpu/drm/i915/i915_drv.c +++ b/drivers/gpu/drm/i915/i915_drv.c | |||
| @@ -534,8 +534,10 @@ static int i915_drm_freeze(struct drm_device *dev) | |||
| 534 | * Disable CRTCs directly since we want to preserve sw state | 534 | * Disable CRTCs directly since we want to preserve sw state |
| 535 | * for _thaw. | 535 | * for _thaw. |
| 536 | */ | 536 | */ |
| 537 | mutex_lock(&dev->mode_config.mutex); | ||
| 537 | list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) | 538 | list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) |
| 538 | dev_priv->display.crtc_disable(crtc); | 539 | dev_priv->display.crtc_disable(crtc); |
| 540 | mutex_unlock(&dev->mode_config.mutex); | ||
| 539 | 541 | ||
| 540 | intel_modeset_suspend_hw(dev); | 542 | intel_modeset_suspend_hw(dev); |
| 541 | } | 543 | } |
diff --git a/drivers/gpu/drm/i915/i915_gem.c b/drivers/gpu/drm/i915/i915_gem.c index 12bbd5eac70d..621c7c67a643 100644 --- a/drivers/gpu/drm/i915/i915_gem.c +++ b/drivers/gpu/drm/i915/i915_gem.c | |||
| @@ -4442,10 +4442,9 @@ i915_gem_init_hw(struct drm_device *dev) | |||
| 4442 | if (dev_priv->ellc_size) | 4442 | if (dev_priv->ellc_size) |
| 4443 | I915_WRITE(HSW_IDICR, I915_READ(HSW_IDICR) | IDIHASHMSK(0xf)); | 4443 | I915_WRITE(HSW_IDICR, I915_READ(HSW_IDICR) | IDIHASHMSK(0xf)); |
| 4444 | 4444 | ||
| 4445 | if (IS_HSW_GT3(dev)) | 4445 | if (IS_HASWELL(dev)) |
| 4446 | I915_WRITE(MI_PREDICATE_RESULT_2, LOWER_SLICE_ENABLED); | 4446 | I915_WRITE(MI_PREDICATE_RESULT_2, IS_HSW_GT3(dev) ? |
| 4447 | else | 4447 | LOWER_SLICE_ENABLED : LOWER_SLICE_DISABLED); |
| 4448 | I915_WRITE(MI_PREDICATE_RESULT_2, LOWER_SLICE_DISABLED); | ||
| 4449 | 4448 | ||
| 4450 | if (HAS_PCH_NOP(dev)) { | 4449 | if (HAS_PCH_NOP(dev)) { |
| 4451 | u32 temp = I915_READ(GEN7_MSG_CTL); | 4450 | u32 temp = I915_READ(GEN7_MSG_CTL); |
diff --git a/drivers/gpu/drm/i915/i915_gem_dmabuf.c b/drivers/gpu/drm/i915/i915_gem_dmabuf.c index 7d5752fda5f1..9bb533e0d762 100644 --- a/drivers/gpu/drm/i915/i915_gem_dmabuf.c +++ b/drivers/gpu/drm/i915/i915_gem_dmabuf.c | |||
| @@ -125,13 +125,15 @@ static void *i915_gem_dmabuf_vmap(struct dma_buf *dma_buf) | |||
| 125 | 125 | ||
| 126 | ret = i915_gem_object_get_pages(obj); | 126 | ret = i915_gem_object_get_pages(obj); |
| 127 | if (ret) | 127 | if (ret) |
| 128 | goto error; | 128 | goto err; |
| 129 | |||
| 130 | i915_gem_object_pin_pages(obj); | ||
| 129 | 131 | ||
| 130 | ret = -ENOMEM; | 132 | ret = -ENOMEM; |
| 131 | 133 | ||
| 132 | pages = drm_malloc_ab(obj->base.size >> PAGE_SHIFT, sizeof(*pages)); | 134 | pages = drm_malloc_ab(obj->base.size >> PAGE_SHIFT, sizeof(*pages)); |
| 133 | if (pages == NULL) | 135 | if (pages == NULL) |
| 134 | goto error; | 136 | goto err_unpin; |
| 135 | 137 | ||
| 136 | i = 0; | 138 | i = 0; |
| 137 | for_each_sg_page(obj->pages->sgl, &sg_iter, obj->pages->nents, 0) | 139 | for_each_sg_page(obj->pages->sgl, &sg_iter, obj->pages->nents, 0) |
| @@ -141,15 +143,16 @@ static void *i915_gem_dmabuf_vmap(struct dma_buf *dma_buf) | |||
| 141 | drm_free_large(pages); | 143 | drm_free_large(pages); |
| 142 | 144 | ||
| 143 | if (!obj->dma_buf_vmapping) | 145 | if (!obj->dma_buf_vmapping) |
| 144 | goto error; | 146 | goto err_unpin; |
| 145 | 147 | ||
| 146 | obj->vmapping_count = 1; | 148 | obj->vmapping_count = 1; |
| 147 | i915_gem_object_pin_pages(obj); | ||
| 148 | out_unlock: | 149 | out_unlock: |
| 149 | mutex_unlock(&dev->struct_mutex); | 150 | mutex_unlock(&dev->struct_mutex); |
| 150 | return obj->dma_buf_vmapping; | 151 | return obj->dma_buf_vmapping; |
| 151 | 152 | ||
| 152 | error: | 153 | err_unpin: |
| 154 | i915_gem_object_unpin_pages(obj); | ||
| 155 | err: | ||
| 153 | mutex_unlock(&dev->struct_mutex); | 156 | mutex_unlock(&dev->struct_mutex); |
| 154 | return ERR_PTR(ret); | 157 | return ERR_PTR(ret); |
| 155 | } | 158 | } |
diff --git a/drivers/gpu/drm/i915/i915_gem_execbuffer.c b/drivers/gpu/drm/i915/i915_gem_execbuffer.c index 885d595e0e02..b7e787fb4649 100644 --- a/drivers/gpu/drm/i915/i915_gem_execbuffer.c +++ b/drivers/gpu/drm/i915/i915_gem_execbuffer.c | |||
| @@ -33,6 +33,9 @@ | |||
| 33 | #include "intel_drv.h" | 33 | #include "intel_drv.h" |
| 34 | #include <linux/dma_remapping.h> | 34 | #include <linux/dma_remapping.h> |
| 35 | 35 | ||
| 36 | #define __EXEC_OBJECT_HAS_PIN (1<<31) | ||
| 37 | #define __EXEC_OBJECT_HAS_FENCE (1<<30) | ||
| 38 | |||
| 36 | struct eb_vmas { | 39 | struct eb_vmas { |
| 37 | struct list_head vmas; | 40 | struct list_head vmas; |
| 38 | int and; | 41 | int and; |
| @@ -187,7 +190,28 @@ static struct i915_vma *eb_get_vma(struct eb_vmas *eb, unsigned long handle) | |||
| 187 | } | 190 | } |
| 188 | } | 191 | } |
| 189 | 192 | ||
| 190 | static void eb_destroy(struct eb_vmas *eb) { | 193 | static void |
| 194 | i915_gem_execbuffer_unreserve_vma(struct i915_vma *vma) | ||
| 195 | { | ||
| 196 | struct drm_i915_gem_exec_object2 *entry; | ||
| 197 | struct drm_i915_gem_object *obj = vma->obj; | ||
| 198 | |||
| 199 | if (!drm_mm_node_allocated(&vma->node)) | ||
| 200 | return; | ||
| 201 | |||
| 202 | entry = vma->exec_entry; | ||
| 203 | |||
| 204 | if (entry->flags & __EXEC_OBJECT_HAS_FENCE) | ||
| 205 | i915_gem_object_unpin_fence(obj); | ||
| 206 | |||
| 207 | if (entry->flags & __EXEC_OBJECT_HAS_PIN) | ||
| 208 | i915_gem_object_unpin(obj); | ||
| 209 | |||
| 210 | entry->flags &= ~(__EXEC_OBJECT_HAS_FENCE | __EXEC_OBJECT_HAS_PIN); | ||
| 211 | } | ||
| 212 | |||
| 213 | static void eb_destroy(struct eb_vmas *eb) | ||
| 214 | { | ||
| 191 | while (!list_empty(&eb->vmas)) { | 215 | while (!list_empty(&eb->vmas)) { |
| 192 | struct i915_vma *vma; | 216 | struct i915_vma *vma; |
| 193 | 217 | ||
| @@ -195,6 +219,7 @@ static void eb_destroy(struct eb_vmas *eb) { | |||
| 195 | struct i915_vma, | 219 | struct i915_vma, |
| 196 | exec_list); | 220 | exec_list); |
| 197 | list_del_init(&vma->exec_list); | 221 | list_del_init(&vma->exec_list); |
| 222 | i915_gem_execbuffer_unreserve_vma(vma); | ||
| 198 | drm_gem_object_unreference(&vma->obj->base); | 223 | drm_gem_object_unreference(&vma->obj->base); |
| 199 | } | 224 | } |
| 200 | kfree(eb); | 225 | kfree(eb); |
| @@ -478,9 +503,6 @@ i915_gem_execbuffer_relocate(struct eb_vmas *eb, | |||
| 478 | return ret; | 503 | return ret; |
| 479 | } | 504 | } |
| 480 | 505 | ||
| 481 | #define __EXEC_OBJECT_HAS_PIN (1<<31) | ||
| 482 | #define __EXEC_OBJECT_HAS_FENCE (1<<30) | ||
| 483 | |||
| 484 | static int | 506 | static int |
| 485 | need_reloc_mappable(struct i915_vma *vma) | 507 | need_reloc_mappable(struct i915_vma *vma) |
| 486 | { | 508 | { |
| @@ -552,26 +574,6 @@ i915_gem_execbuffer_reserve_vma(struct i915_vma *vma, | |||
| 552 | return 0; | 574 | return 0; |
| 553 | } | 575 | } |
| 554 | 576 | ||
| 555 | static void | ||
| 556 | i915_gem_execbuffer_unreserve_vma(struct i915_vma *vma) | ||
| 557 | { | ||
| 558 | struct drm_i915_gem_exec_object2 *entry; | ||
| 559 | struct drm_i915_gem_object *obj = vma->obj; | ||
| 560 | |||
| 561 | if (!drm_mm_node_allocated(&vma->node)) | ||
| 562 | return; | ||
| 563 | |||
| 564 | entry = vma->exec_entry; | ||
| 565 | |||
| 566 | if (entry->flags & __EXEC_OBJECT_HAS_FENCE) | ||
| 567 | i915_gem_object_unpin_fence(obj); | ||
| 568 | |||
| 569 | if (entry->flags & __EXEC_OBJECT_HAS_PIN) | ||
| 570 | i915_gem_object_unpin(obj); | ||
| 571 | |||
| 572 | entry->flags &= ~(__EXEC_OBJECT_HAS_FENCE | __EXEC_OBJECT_HAS_PIN); | ||
| 573 | } | ||
| 574 | |||
| 575 | static int | 577 | static int |
| 576 | i915_gem_execbuffer_reserve(struct intel_ring_buffer *ring, | 578 | i915_gem_execbuffer_reserve(struct intel_ring_buffer *ring, |
| 577 | struct list_head *vmas, | 579 | struct list_head *vmas, |
| @@ -670,13 +672,14 @@ i915_gem_execbuffer_reserve(struct intel_ring_buffer *ring, | |||
| 670 | goto err; | 672 | goto err; |
| 671 | } | 673 | } |
| 672 | 674 | ||
| 673 | err: /* Decrement pin count for bound objects */ | 675 | err: |
| 674 | list_for_each_entry(vma, vmas, exec_list) | ||
| 675 | i915_gem_execbuffer_unreserve_vma(vma); | ||
| 676 | |||
| 677 | if (ret != -ENOSPC || retry++) | 676 | if (ret != -ENOSPC || retry++) |
| 678 | return ret; | 677 | return ret; |
| 679 | 678 | ||
| 679 | /* Decrement pin count for bound objects */ | ||
| 680 | list_for_each_entry(vma, vmas, exec_list) | ||
| 681 | i915_gem_execbuffer_unreserve_vma(vma); | ||
| 682 | |||
| 680 | ret = i915_gem_evict_vm(vm, true); | 683 | ret = i915_gem_evict_vm(vm, true); |
| 681 | if (ret) | 684 | if (ret) |
| 682 | return ret; | 685 | return ret; |
| @@ -708,6 +711,7 @@ i915_gem_execbuffer_relocate_slow(struct drm_device *dev, | |||
| 708 | while (!list_empty(&eb->vmas)) { | 711 | while (!list_empty(&eb->vmas)) { |
| 709 | vma = list_first_entry(&eb->vmas, struct i915_vma, exec_list); | 712 | vma = list_first_entry(&eb->vmas, struct i915_vma, exec_list); |
| 710 | list_del_init(&vma->exec_list); | 713 | list_del_init(&vma->exec_list); |
| 714 | i915_gem_execbuffer_unreserve_vma(vma); | ||
| 711 | drm_gem_object_unreference(&vma->obj->base); | 715 | drm_gem_object_unreference(&vma->obj->base); |
| 712 | } | 716 | } |
| 713 | 717 | ||
diff --git a/drivers/gpu/drm/i915/i915_gem_gtt.c b/drivers/gpu/drm/i915/i915_gem_gtt.c index 3620a1b0a73c..38cb8d44a013 100644 --- a/drivers/gpu/drm/i915/i915_gem_gtt.c +++ b/drivers/gpu/drm/i915/i915_gem_gtt.c | |||
| @@ -57,7 +57,9 @@ typedef gen8_gtt_pte_t gen8_ppgtt_pde_t; | |||
| 57 | #define HSW_WB_LLC_AGE3 HSW_CACHEABILITY_CONTROL(0x2) | 57 | #define HSW_WB_LLC_AGE3 HSW_CACHEABILITY_CONTROL(0x2) |
| 58 | #define HSW_WB_LLC_AGE0 HSW_CACHEABILITY_CONTROL(0x3) | 58 | #define HSW_WB_LLC_AGE0 HSW_CACHEABILITY_CONTROL(0x3) |
| 59 | #define HSW_WB_ELLC_LLC_AGE0 HSW_CACHEABILITY_CONTROL(0xb) | 59 | #define HSW_WB_ELLC_LLC_AGE0 HSW_CACHEABILITY_CONTROL(0xb) |
| 60 | #define HSW_WB_ELLC_LLC_AGE3 HSW_CACHEABILITY_CONTROL(0x8) | ||
| 60 | #define HSW_WT_ELLC_LLC_AGE0 HSW_CACHEABILITY_CONTROL(0x6) | 61 | #define HSW_WT_ELLC_LLC_AGE0 HSW_CACHEABILITY_CONTROL(0x6) |
| 62 | #define HSW_WT_ELLC_LLC_AGE3 HSW_CACHEABILITY_CONTROL(0x7) | ||
| 61 | 63 | ||
| 62 | #define GEN8_PTES_PER_PAGE (PAGE_SIZE / sizeof(gen8_gtt_pte_t)) | 64 | #define GEN8_PTES_PER_PAGE (PAGE_SIZE / sizeof(gen8_gtt_pte_t)) |
| 63 | #define GEN8_PDES_PER_PAGE (PAGE_SIZE / sizeof(gen8_ppgtt_pde_t)) | 65 | #define GEN8_PDES_PER_PAGE (PAGE_SIZE / sizeof(gen8_ppgtt_pde_t)) |
| @@ -185,10 +187,10 @@ static gen6_gtt_pte_t iris_pte_encode(dma_addr_t addr, | |||
| 185 | case I915_CACHE_NONE: | 187 | case I915_CACHE_NONE: |
| 186 | break; | 188 | break; |
| 187 | case I915_CACHE_WT: | 189 | case I915_CACHE_WT: |
| 188 | pte |= HSW_WT_ELLC_LLC_AGE0; | 190 | pte |= HSW_WT_ELLC_LLC_AGE3; |
| 189 | break; | 191 | break; |
| 190 | default: | 192 | default: |
| 191 | pte |= HSW_WB_ELLC_LLC_AGE0; | 193 | pte |= HSW_WB_ELLC_LLC_AGE3; |
| 192 | break; | 194 | break; |
| 193 | } | 195 | } |
| 194 | 196 | ||
diff --git a/drivers/gpu/drm/i915/i915_reg.h b/drivers/gpu/drm/i915/i915_reg.h index f9eafb6ed523..ee2742122a02 100644 --- a/drivers/gpu/drm/i915/i915_reg.h +++ b/drivers/gpu/drm/i915/i915_reg.h | |||
| @@ -235,6 +235,7 @@ | |||
| 235 | */ | 235 | */ |
| 236 | #define MI_LOAD_REGISTER_IMM(x) MI_INSTR(0x22, 2*x-1) | 236 | #define MI_LOAD_REGISTER_IMM(x) MI_INSTR(0x22, 2*x-1) |
| 237 | #define MI_STORE_REGISTER_MEM(x) MI_INSTR(0x24, 2*x-1) | 237 | #define MI_STORE_REGISTER_MEM(x) MI_INSTR(0x24, 2*x-1) |
| 238 | #define MI_SRM_LRM_GLOBAL_GTT (1<<22) | ||
| 238 | #define MI_FLUSH_DW MI_INSTR(0x26, 1) /* for GEN6 */ | 239 | #define MI_FLUSH_DW MI_INSTR(0x26, 1) /* for GEN6 */ |
| 239 | #define MI_FLUSH_DW_STORE_INDEX (1<<21) | 240 | #define MI_FLUSH_DW_STORE_INDEX (1<<21) |
| 240 | #define MI_INVALIDATE_TLB (1<<18) | 241 | #define MI_INVALIDATE_TLB (1<<18) |
diff --git a/drivers/gpu/drm/i915/intel_ddi.c b/drivers/gpu/drm/i915/intel_ddi.c index 330077bcd0bd..526c8ded16b0 100644 --- a/drivers/gpu/drm/i915/intel_ddi.c +++ b/drivers/gpu/drm/i915/intel_ddi.c | |||
| @@ -173,7 +173,7 @@ static void intel_prepare_ddi_buffers(struct drm_device *dev, enum port port) | |||
| 173 | ddi_translations = ddi_translations_dp; | 173 | ddi_translations = ddi_translations_dp; |
| 174 | break; | 174 | break; |
| 175 | case PORT_D: | 175 | case PORT_D: |
| 176 | if (intel_dpd_is_edp(dev)) | 176 | if (intel_dp_is_edp(dev, PORT_D)) |
| 177 | ddi_translations = ddi_translations_edp; | 177 | ddi_translations = ddi_translations_edp; |
| 178 | else | 178 | else |
| 179 | ddi_translations = ddi_translations_dp; | 179 | ddi_translations = ddi_translations_dp; |
| @@ -1158,9 +1158,10 @@ static void intel_ddi_post_disable(struct intel_encoder *intel_encoder) | |||
| 1158 | if (wait) | 1158 | if (wait) |
| 1159 | intel_wait_ddi_buf_idle(dev_priv, port); | 1159 | intel_wait_ddi_buf_idle(dev_priv, port); |
| 1160 | 1160 | ||
| 1161 | if (type == INTEL_OUTPUT_EDP) { | 1161 | if (type == INTEL_OUTPUT_DISPLAYPORT || type == INTEL_OUTPUT_EDP) { |
| 1162 | struct intel_dp *intel_dp = enc_to_intel_dp(encoder); | 1162 | struct intel_dp *intel_dp = enc_to_intel_dp(encoder); |
| 1163 | ironlake_edp_panel_vdd_on(intel_dp); | 1163 | ironlake_edp_panel_vdd_on(intel_dp); |
| 1164 | intel_dp_sink_dpms(intel_dp, DRM_MODE_DPMS_OFF); | ||
| 1164 | ironlake_edp_panel_off(intel_dp); | 1165 | ironlake_edp_panel_off(intel_dp); |
| 1165 | } | 1166 | } |
| 1166 | 1167 | ||
diff --git a/drivers/gpu/drm/i915/intel_display.c b/drivers/gpu/drm/i915/intel_display.c index 7ec8b488bb1d..080f6fd4e839 100644 --- a/drivers/gpu/drm/i915/intel_display.c +++ b/drivers/gpu/drm/i915/intel_display.c | |||
| @@ -5815,7 +5815,7 @@ static void intel_set_pipe_csc(struct drm_crtc *crtc) | |||
| 5815 | uint16_t postoff = 0; | 5815 | uint16_t postoff = 0; |
| 5816 | 5816 | ||
| 5817 | if (intel_crtc->config.limited_color_range) | 5817 | if (intel_crtc->config.limited_color_range) |
| 5818 | postoff = (16 * (1 << 13) / 255) & 0x1fff; | 5818 | postoff = (16 * (1 << 12) / 255) & 0x1fff; |
| 5819 | 5819 | ||
| 5820 | I915_WRITE(PIPE_CSC_POSTOFF_HI(pipe), postoff); | 5820 | I915_WRITE(PIPE_CSC_POSTOFF_HI(pipe), postoff); |
| 5821 | I915_WRITE(PIPE_CSC_POSTOFF_ME(pipe), postoff); | 5821 | I915_WRITE(PIPE_CSC_POSTOFF_ME(pipe), postoff); |
| @@ -6402,7 +6402,7 @@ static void hsw_restore_lcpll(struct drm_i915_private *dev_priv) | |||
| 6402 | 6402 | ||
| 6403 | /* Make sure we're not on PC8 state before disabling PC8, otherwise | 6403 | /* Make sure we're not on PC8 state before disabling PC8, otherwise |
| 6404 | * we'll hang the machine! */ | 6404 | * we'll hang the machine! */ |
| 6405 | dev_priv->uncore.funcs.force_wake_get(dev_priv); | 6405 | gen6_gt_force_wake_get(dev_priv); |
| 6406 | 6406 | ||
| 6407 | if (val & LCPLL_POWER_DOWN_ALLOW) { | 6407 | if (val & LCPLL_POWER_DOWN_ALLOW) { |
| 6408 | val &= ~LCPLL_POWER_DOWN_ALLOW; | 6408 | val &= ~LCPLL_POWER_DOWN_ALLOW; |
| @@ -6436,7 +6436,7 @@ static void hsw_restore_lcpll(struct drm_i915_private *dev_priv) | |||
| 6436 | DRM_ERROR("Switching back to LCPLL failed\n"); | 6436 | DRM_ERROR("Switching back to LCPLL failed\n"); |
| 6437 | } | 6437 | } |
| 6438 | 6438 | ||
| 6439 | dev_priv->uncore.funcs.force_wake_put(dev_priv); | 6439 | gen6_gt_force_wake_put(dev_priv); |
| 6440 | } | 6440 | } |
| 6441 | 6441 | ||
| 6442 | void hsw_enable_pc8_work(struct work_struct *__work) | 6442 | void hsw_enable_pc8_work(struct work_struct *__work) |
| @@ -8354,7 +8354,8 @@ static int intel_gen7_queue_flip(struct drm_device *dev, | |||
| 8354 | intel_ring_emit(ring, ~(DERRMR_PIPEA_PRI_FLIP_DONE | | 8354 | intel_ring_emit(ring, ~(DERRMR_PIPEA_PRI_FLIP_DONE | |
| 8355 | DERRMR_PIPEB_PRI_FLIP_DONE | | 8355 | DERRMR_PIPEB_PRI_FLIP_DONE | |
| 8356 | DERRMR_PIPEC_PRI_FLIP_DONE)); | 8356 | DERRMR_PIPEC_PRI_FLIP_DONE)); |
| 8357 | intel_ring_emit(ring, MI_STORE_REGISTER_MEM(1)); | 8357 | intel_ring_emit(ring, MI_STORE_REGISTER_MEM(1) | |
| 8358 | MI_SRM_LRM_GLOBAL_GTT); | ||
| 8358 | intel_ring_emit(ring, DERRMR); | 8359 | intel_ring_emit(ring, DERRMR); |
| 8359 | intel_ring_emit(ring, ring->scratch.gtt_offset + 256); | 8360 | intel_ring_emit(ring, ring->scratch.gtt_offset + 256); |
| 8360 | } | 8361 | } |
| @@ -10049,7 +10050,7 @@ static void intel_setup_outputs(struct drm_device *dev) | |||
| 10049 | intel_ddi_init(dev, PORT_D); | 10050 | intel_ddi_init(dev, PORT_D); |
| 10050 | } else if (HAS_PCH_SPLIT(dev)) { | 10051 | } else if (HAS_PCH_SPLIT(dev)) { |
| 10051 | int found; | 10052 | int found; |
| 10052 | dpd_is_edp = intel_dpd_is_edp(dev); | 10053 | dpd_is_edp = intel_dp_is_edp(dev, PORT_D); |
| 10053 | 10054 | ||
| 10054 | if (has_edp_a(dev)) | 10055 | if (has_edp_a(dev)) |
| 10055 | intel_dp_init(dev, DP_A, PORT_A); | 10056 | intel_dp_init(dev, DP_A, PORT_A); |
| @@ -10086,8 +10087,7 @@ static void intel_setup_outputs(struct drm_device *dev) | |||
| 10086 | intel_hdmi_init(dev, VLV_DISPLAY_BASE + GEN4_HDMIC, | 10087 | intel_hdmi_init(dev, VLV_DISPLAY_BASE + GEN4_HDMIC, |
| 10087 | PORT_C); | 10088 | PORT_C); |
| 10088 | if (I915_READ(VLV_DISPLAY_BASE + DP_C) & DP_DETECTED) | 10089 | if (I915_READ(VLV_DISPLAY_BASE + DP_C) & DP_DETECTED) |
| 10089 | intel_dp_init(dev, VLV_DISPLAY_BASE + DP_C, | 10090 | intel_dp_init(dev, VLV_DISPLAY_BASE + DP_C, PORT_C); |
| 10090 | PORT_C); | ||
| 10091 | } | 10091 | } |
| 10092 | 10092 | ||
| 10093 | intel_dsi_init(dev); | 10093 | intel_dsi_init(dev); |
diff --git a/drivers/gpu/drm/i915/intel_dp.c b/drivers/gpu/drm/i915/intel_dp.c index 0b2e842fef01..30c627c7b7ba 100644 --- a/drivers/gpu/drm/i915/intel_dp.c +++ b/drivers/gpu/drm/i915/intel_dp.c | |||
| @@ -3326,11 +3326,19 @@ intel_trans_dp_port_sel(struct drm_crtc *crtc) | |||
| 3326 | } | 3326 | } |
| 3327 | 3327 | ||
| 3328 | /* check the VBT to see whether the eDP is on DP-D port */ | 3328 | /* check the VBT to see whether the eDP is on DP-D port */ |
| 3329 | bool intel_dpd_is_edp(struct drm_device *dev) | 3329 | bool intel_dp_is_edp(struct drm_device *dev, enum port port) |
| 3330 | { | 3330 | { |
| 3331 | struct drm_i915_private *dev_priv = dev->dev_private; | 3331 | struct drm_i915_private *dev_priv = dev->dev_private; |
| 3332 | union child_device_config *p_child; | 3332 | union child_device_config *p_child; |
| 3333 | int i; | 3333 | int i; |
| 3334 | static const short port_mapping[] = { | ||
| 3335 | [PORT_B] = PORT_IDPB, | ||
| 3336 | [PORT_C] = PORT_IDPC, | ||
| 3337 | [PORT_D] = PORT_IDPD, | ||
| 3338 | }; | ||
| 3339 | |||
| 3340 | if (port == PORT_A) | ||
| 3341 | return true; | ||
| 3334 | 3342 | ||
| 3335 | if (!dev_priv->vbt.child_dev_num) | 3343 | if (!dev_priv->vbt.child_dev_num) |
| 3336 | return false; | 3344 | return false; |
| @@ -3338,7 +3346,7 @@ bool intel_dpd_is_edp(struct drm_device *dev) | |||
| 3338 | for (i = 0; i < dev_priv->vbt.child_dev_num; i++) { | 3346 | for (i = 0; i < dev_priv->vbt.child_dev_num; i++) { |
| 3339 | p_child = dev_priv->vbt.child_dev + i; | 3347 | p_child = dev_priv->vbt.child_dev + i; |
| 3340 | 3348 | ||
| 3341 | if (p_child->common.dvo_port == PORT_IDPD && | 3349 | if (p_child->common.dvo_port == port_mapping[port] && |
| 3342 | (p_child->common.device_type & DEVICE_TYPE_eDP_BITS) == | 3350 | (p_child->common.device_type & DEVICE_TYPE_eDP_BITS) == |
| 3343 | (DEVICE_TYPE_eDP & DEVICE_TYPE_eDP_BITS)) | 3351 | (DEVICE_TYPE_eDP & DEVICE_TYPE_eDP_BITS)) |
| 3344 | return true; | 3352 | return true; |
| @@ -3616,26 +3624,10 @@ intel_dp_init_connector(struct intel_digital_port *intel_dig_port, | |||
| 3616 | intel_dp->DP = I915_READ(intel_dp->output_reg); | 3624 | intel_dp->DP = I915_READ(intel_dp->output_reg); |
| 3617 | intel_dp->attached_connector = intel_connector; | 3625 | intel_dp->attached_connector = intel_connector; |
| 3618 | 3626 | ||
| 3619 | type = DRM_MODE_CONNECTOR_DisplayPort; | 3627 | if (intel_dp_is_edp(dev, port)) |
| 3620 | /* | ||
| 3621 | * FIXME : We need to initialize built-in panels before external panels. | ||
| 3622 | * For X0, DP_C is fixed as eDP. Revisit this as part of VLV eDP cleanup | ||
| 3623 | */ | ||
| 3624 | switch (port) { | ||
| 3625 | case PORT_A: | ||
| 3626 | type = DRM_MODE_CONNECTOR_eDP; | 3628 | type = DRM_MODE_CONNECTOR_eDP; |
| 3627 | break; | 3629 | else |
| 3628 | case PORT_C: | 3630 | type = DRM_MODE_CONNECTOR_DisplayPort; |
| 3629 | if (IS_VALLEYVIEW(dev)) | ||
| 3630 | type = DRM_MODE_CONNECTOR_eDP; | ||
| 3631 | break; | ||
| 3632 | case PORT_D: | ||
| 3633 | if (HAS_PCH_SPLIT(dev) && intel_dpd_is_edp(dev)) | ||
| 3634 | type = DRM_MODE_CONNECTOR_eDP; | ||
| 3635 | break; | ||
| 3636 | default: /* silence GCC warning */ | ||
| 3637 | break; | ||
| 3638 | } | ||
| 3639 | 3631 | ||
| 3640 | /* | 3632 | /* |
| 3641 | * For eDP we always set the encoder type to INTEL_OUTPUT_EDP, but | 3633 | * For eDP we always set the encoder type to INTEL_OUTPUT_EDP, but |
diff --git a/drivers/gpu/drm/i915/intel_drv.h b/drivers/gpu/drm/i915/intel_drv.h index 1e49aa8f5377..a18e88b3e425 100644 --- a/drivers/gpu/drm/i915/intel_drv.h +++ b/drivers/gpu/drm/i915/intel_drv.h | |||
| @@ -708,7 +708,7 @@ void intel_dp_encoder_destroy(struct drm_encoder *encoder); | |||
| 708 | void intel_dp_check_link_status(struct intel_dp *intel_dp); | 708 | void intel_dp_check_link_status(struct intel_dp *intel_dp); |
| 709 | bool intel_dp_compute_config(struct intel_encoder *encoder, | 709 | bool intel_dp_compute_config(struct intel_encoder *encoder, |
| 710 | struct intel_crtc_config *pipe_config); | 710 | struct intel_crtc_config *pipe_config); |
| 711 | bool intel_dpd_is_edp(struct drm_device *dev); | 711 | bool intel_dp_is_edp(struct drm_device *dev, enum port port); |
| 712 | void ironlake_edp_backlight_on(struct intel_dp *intel_dp); | 712 | void ironlake_edp_backlight_on(struct intel_dp *intel_dp); |
| 713 | void ironlake_edp_backlight_off(struct intel_dp *intel_dp); | 713 | void ironlake_edp_backlight_off(struct intel_dp *intel_dp); |
| 714 | void ironlake_edp_panel_on(struct intel_dp *intel_dp); | 714 | void ironlake_edp_panel_on(struct intel_dp *intel_dp); |
diff --git a/drivers/gpu/drm/i915/intel_pm.c b/drivers/gpu/drm/i915/intel_pm.c index caf2ee4e5441..6e0d5e075b15 100644 --- a/drivers/gpu/drm/i915/intel_pm.c +++ b/drivers/gpu/drm/i915/intel_pm.c | |||
| @@ -1180,7 +1180,7 @@ static bool g4x_compute_wm0(struct drm_device *dev, | |||
| 1180 | 1180 | ||
| 1181 | adjusted_mode = &to_intel_crtc(crtc)->config.adjusted_mode; | 1181 | adjusted_mode = &to_intel_crtc(crtc)->config.adjusted_mode; |
| 1182 | clock = adjusted_mode->crtc_clock; | 1182 | clock = adjusted_mode->crtc_clock; |
| 1183 | htotal = adjusted_mode->htotal; | 1183 | htotal = adjusted_mode->crtc_htotal; |
| 1184 | hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; | 1184 | hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; |
| 1185 | pixel_size = crtc->fb->bits_per_pixel / 8; | 1185 | pixel_size = crtc->fb->bits_per_pixel / 8; |
| 1186 | 1186 | ||
| @@ -1267,7 +1267,7 @@ static bool g4x_compute_srwm(struct drm_device *dev, | |||
| 1267 | crtc = intel_get_crtc_for_plane(dev, plane); | 1267 | crtc = intel_get_crtc_for_plane(dev, plane); |
| 1268 | adjusted_mode = &to_intel_crtc(crtc)->config.adjusted_mode; | 1268 | adjusted_mode = &to_intel_crtc(crtc)->config.adjusted_mode; |
| 1269 | clock = adjusted_mode->crtc_clock; | 1269 | clock = adjusted_mode->crtc_clock; |
| 1270 | htotal = adjusted_mode->htotal; | 1270 | htotal = adjusted_mode->crtc_htotal; |
| 1271 | hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; | 1271 | hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; |
| 1272 | pixel_size = crtc->fb->bits_per_pixel / 8; | 1272 | pixel_size = crtc->fb->bits_per_pixel / 8; |
| 1273 | 1273 | ||
| @@ -1498,7 +1498,7 @@ static void i965_update_wm(struct drm_crtc *unused_crtc) | |||
| 1498 | const struct drm_display_mode *adjusted_mode = | 1498 | const struct drm_display_mode *adjusted_mode = |
| 1499 | &to_intel_crtc(crtc)->config.adjusted_mode; | 1499 | &to_intel_crtc(crtc)->config.adjusted_mode; |
| 1500 | int clock = adjusted_mode->crtc_clock; | 1500 | int clock = adjusted_mode->crtc_clock; |
| 1501 | int htotal = adjusted_mode->htotal; | 1501 | int htotal = adjusted_mode->crtc_htotal; |
| 1502 | int hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; | 1502 | int hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; |
| 1503 | int pixel_size = crtc->fb->bits_per_pixel / 8; | 1503 | int pixel_size = crtc->fb->bits_per_pixel / 8; |
| 1504 | unsigned long line_time_us; | 1504 | unsigned long line_time_us; |
| @@ -1624,7 +1624,7 @@ static void i9xx_update_wm(struct drm_crtc *unused_crtc) | |||
| 1624 | const struct drm_display_mode *adjusted_mode = | 1624 | const struct drm_display_mode *adjusted_mode = |
| 1625 | &to_intel_crtc(enabled)->config.adjusted_mode; | 1625 | &to_intel_crtc(enabled)->config.adjusted_mode; |
| 1626 | int clock = adjusted_mode->crtc_clock; | 1626 | int clock = adjusted_mode->crtc_clock; |
| 1627 | int htotal = adjusted_mode->htotal; | 1627 | int htotal = adjusted_mode->crtc_htotal; |
| 1628 | int hdisplay = to_intel_crtc(enabled)->config.pipe_src_w; | 1628 | int hdisplay = to_intel_crtc(enabled)->config.pipe_src_w; |
| 1629 | int pixel_size = enabled->fb->bits_per_pixel / 8; | 1629 | int pixel_size = enabled->fb->bits_per_pixel / 8; |
| 1630 | unsigned long line_time_us; | 1630 | unsigned long line_time_us; |
| @@ -1776,7 +1776,7 @@ static bool ironlake_compute_srwm(struct drm_device *dev, int level, int plane, | |||
| 1776 | crtc = intel_get_crtc_for_plane(dev, plane); | 1776 | crtc = intel_get_crtc_for_plane(dev, plane); |
| 1777 | adjusted_mode = &to_intel_crtc(crtc)->config.adjusted_mode; | 1777 | adjusted_mode = &to_intel_crtc(crtc)->config.adjusted_mode; |
| 1778 | clock = adjusted_mode->crtc_clock; | 1778 | clock = adjusted_mode->crtc_clock; |
| 1779 | htotal = adjusted_mode->htotal; | 1779 | htotal = adjusted_mode->crtc_htotal; |
| 1780 | hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; | 1780 | hdisplay = to_intel_crtc(crtc)->config.pipe_src_w; |
| 1781 | pixel_size = crtc->fb->bits_per_pixel / 8; | 1781 | pixel_size = crtc->fb->bits_per_pixel / 8; |
| 1782 | 1782 | ||
| @@ -2469,8 +2469,9 @@ hsw_compute_linetime_wm(struct drm_device *dev, struct drm_crtc *crtc) | |||
| 2469 | /* The WM are computed with base on how long it takes to fill a single | 2469 | /* The WM are computed with base on how long it takes to fill a single |
| 2470 | * row at the given clock rate, multiplied by 8. | 2470 | * row at the given clock rate, multiplied by 8. |
| 2471 | * */ | 2471 | * */ |
| 2472 | linetime = DIV_ROUND_CLOSEST(mode->htotal * 1000 * 8, mode->clock); | 2472 | linetime = DIV_ROUND_CLOSEST(mode->crtc_htotal * 1000 * 8, |
| 2473 | ips_linetime = DIV_ROUND_CLOSEST(mode->htotal * 1000 * 8, | 2473 | mode->crtc_clock); |
| 2474 | ips_linetime = DIV_ROUND_CLOSEST(mode->crtc_htotal * 1000 * 8, | ||
| 2474 | intel_ddi_get_cdclk_freq(dev_priv)); | 2475 | intel_ddi_get_cdclk_freq(dev_priv)); |
| 2475 | 2476 | ||
| 2476 | return PIPE_WM_LINETIME_IPS_LINETIME(ips_linetime) | | 2477 | return PIPE_WM_LINETIME_IPS_LINETIME(ips_linetime) | |
diff --git a/drivers/gpu/drm/nouveau/Makefile b/drivers/gpu/drm/nouveau/Makefile index edcf801613e6..b3fa1ba191b7 100644 --- a/drivers/gpu/drm/nouveau/Makefile +++ b/drivers/gpu/drm/nouveau/Makefile | |||
| @@ -59,6 +59,7 @@ nouveau-y += core/subdev/clock/nv40.o | |||
| 59 | nouveau-y += core/subdev/clock/nv50.o | 59 | nouveau-y += core/subdev/clock/nv50.o |
| 60 | nouveau-y += core/subdev/clock/nv84.o | 60 | nouveau-y += core/subdev/clock/nv84.o |
| 61 | nouveau-y += core/subdev/clock/nva3.o | 61 | nouveau-y += core/subdev/clock/nva3.o |
| 62 | nouveau-y += core/subdev/clock/nvaa.o | ||
| 62 | nouveau-y += core/subdev/clock/nvc0.o | 63 | nouveau-y += core/subdev/clock/nvc0.o |
| 63 | nouveau-y += core/subdev/clock/nve0.o | 64 | nouveau-y += core/subdev/clock/nve0.o |
| 64 | nouveau-y += core/subdev/clock/pllnv04.o | 65 | nouveau-y += core/subdev/clock/pllnv04.o |
diff --git a/drivers/gpu/drm/nouveau/core/engine/device/nv50.c b/drivers/gpu/drm/nouveau/core/engine/device/nv50.c index db139827047c..db3fc7be856a 100644 --- a/drivers/gpu/drm/nouveau/core/engine/device/nv50.c +++ b/drivers/gpu/drm/nouveau/core/engine/device/nv50.c | |||
| @@ -283,7 +283,7 @@ nv50_identify(struct nouveau_device *device) | |||
| 283 | device->oclass[NVDEV_SUBDEV_VBIOS ] = &nouveau_bios_oclass; | 283 | device->oclass[NVDEV_SUBDEV_VBIOS ] = &nouveau_bios_oclass; |
| 284 | device->oclass[NVDEV_SUBDEV_GPIO ] = &nv50_gpio_oclass; | 284 | device->oclass[NVDEV_SUBDEV_GPIO ] = &nv50_gpio_oclass; |
| 285 | device->oclass[NVDEV_SUBDEV_I2C ] = &nv94_i2c_oclass; | 285 | device->oclass[NVDEV_SUBDEV_I2C ] = &nv94_i2c_oclass; |
| 286 | device->oclass[NVDEV_SUBDEV_CLOCK ] = nv84_clock_oclass; | 286 | device->oclass[NVDEV_SUBDEV_CLOCK ] = nvaa_clock_oclass; |
| 287 | device->oclass[NVDEV_SUBDEV_THERM ] = &nv84_therm_oclass; | 287 | device->oclass[NVDEV_SUBDEV_THERM ] = &nv84_therm_oclass; |
| 288 | device->oclass[NVDEV_SUBDEV_MXM ] = &nv50_mxm_oclass; | 288 | device->oclass[NVDEV_SUBDEV_MXM ] = &nv50_mxm_oclass; |
| 289 | device->oclass[NVDEV_SUBDEV_DEVINIT] = &nv50_devinit_oclass; | 289 | device->oclass[NVDEV_SUBDEV_DEVINIT] = &nv50_devinit_oclass; |
| @@ -311,7 +311,7 @@ nv50_identify(struct nouveau_device *device) | |||
| 311 | device->oclass[NVDEV_SUBDEV_VBIOS ] = &nouveau_bios_oclass; | 311 | device->oclass[NVDEV_SUBDEV_VBIOS ] = &nouveau_bios_oclass; |
| 312 | device->oclass[NVDEV_SUBDEV_GPIO ] = &nv50_gpio_oclass; | 312 | device->oclass[NVDEV_SUBDEV_GPIO ] = &nv50_gpio_oclass; |
| 313 | device->oclass[NVDEV_SUBDEV_I2C ] = &nv94_i2c_oclass; | 313 | device->oclass[NVDEV_SUBDEV_I2C ] = &nv94_i2c_oclass; |
| 314 | device->oclass[NVDEV_SUBDEV_CLOCK ] = nv84_clock_oclass; | 314 | device->oclass[NVDEV_SUBDEV_CLOCK ] = nvaa_clock_oclass; |
| 315 | device->oclass[NVDEV_SUBDEV_THERM ] = &nv84_therm_oclass; | 315 | device->oclass[NVDEV_SUBDEV_THERM ] = &nv84_therm_oclass; |
| 316 | device->oclass[NVDEV_SUBDEV_MXM ] = &nv50_mxm_oclass; | 316 | device->oclass[NVDEV_SUBDEV_MXM ] = &nv50_mxm_oclass; |
| 317 | device->oclass[NVDEV_SUBDEV_DEVINIT] = &nv50_devinit_oclass; | 317 | device->oclass[NVDEV_SUBDEV_DEVINIT] = &nv50_devinit_oclass; |
diff --git a/drivers/gpu/drm/nouveau/core/engine/fifo/nv50.c b/drivers/gpu/drm/nouveau/core/engine/fifo/nv50.c index 5f555788121c..e6352bd5b4ff 100644 --- a/drivers/gpu/drm/nouveau/core/engine/fifo/nv50.c +++ b/drivers/gpu/drm/nouveau/core/engine/fifo/nv50.c | |||
| @@ -33,6 +33,7 @@ | |||
| 33 | #include <engine/dmaobj.h> | 33 | #include <engine/dmaobj.h> |
| 34 | #include <engine/fifo.h> | 34 | #include <engine/fifo.h> |
| 35 | 35 | ||
| 36 | #include "nv04.h" | ||
| 36 | #include "nv50.h" | 37 | #include "nv50.h" |
| 37 | 38 | ||
| 38 | /******************************************************************************* | 39 | /******************************************************************************* |
| @@ -460,6 +461,8 @@ nv50_fifo_ctor(struct nouveau_object *parent, struct nouveau_object *engine, | |||
| 460 | nv_subdev(priv)->intr = nv04_fifo_intr; | 461 | nv_subdev(priv)->intr = nv04_fifo_intr; |
| 461 | nv_engine(priv)->cclass = &nv50_fifo_cclass; | 462 | nv_engine(priv)->cclass = &nv50_fifo_cclass; |
| 462 | nv_engine(priv)->sclass = nv50_fifo_sclass; | 463 | nv_engine(priv)->sclass = nv50_fifo_sclass; |
| 464 | priv->base.pause = nv04_fifo_pause; | ||
| 465 | priv->base.start = nv04_fifo_start; | ||
| 463 | return 0; | 466 | return 0; |
| 464 | } | 467 | } |
| 465 | 468 | ||
diff --git a/drivers/gpu/drm/nouveau/core/engine/fifo/nv84.c b/drivers/gpu/drm/nouveau/core/engine/fifo/nv84.c index 0908dc834c84..fe0f41e65d9b 100644 --- a/drivers/gpu/drm/nouveau/core/engine/fifo/nv84.c +++ b/drivers/gpu/drm/nouveau/core/engine/fifo/nv84.c | |||
| @@ -35,6 +35,7 @@ | |||
| 35 | #include <engine/dmaobj.h> | 35 | #include <engine/dmaobj.h> |
| 36 | #include <engine/fifo.h> | 36 | #include <engine/fifo.h> |
| 37 | 37 | ||
| 38 | #include "nv04.h" | ||
| 38 | #include "nv50.h" | 39 | #include "nv50.h" |
| 39 | 40 | ||
| 40 | /******************************************************************************* | 41 | /******************************************************************************* |
| @@ -432,6 +433,8 @@ nv84_fifo_ctor(struct nouveau_object *parent, struct nouveau_object *engine, | |||
| 432 | nv_subdev(priv)->intr = nv04_fifo_intr; | 433 | nv_subdev(priv)->intr = nv04_fifo_intr; |
| 433 | nv_engine(priv)->cclass = &nv84_fifo_cclass; | 434 | nv_engine(priv)->cclass = &nv84_fifo_cclass; |
| 434 | nv_engine(priv)->sclass = nv84_fifo_sclass; | 435 | nv_engine(priv)->sclass = nv84_fifo_sclass; |
| 436 | priv->base.pause = nv04_fifo_pause; | ||
| 437 | priv->base.start = nv04_fifo_start; | ||
| 435 | return 0; | 438 | return 0; |
| 436 | } | 439 | } |
| 437 | 440 | ||
diff --git a/drivers/gpu/drm/nouveau/core/engine/software/nv50.c b/drivers/gpu/drm/nouveau/core/engine/software/nv50.c index b574dd4bb828..5ce686ee729e 100644 --- a/drivers/gpu/drm/nouveau/core/engine/software/nv50.c +++ b/drivers/gpu/drm/nouveau/core/engine/software/nv50.c | |||
| @@ -176,7 +176,7 @@ nv50_software_context_ctor(struct nouveau_object *parent, | |||
| 176 | if (ret) | 176 | if (ret) |
| 177 | return ret; | 177 | return ret; |
| 178 | 178 | ||
| 179 | chan->vblank.nr_event = pdisp->vblank->index_nr; | 179 | chan->vblank.nr_event = pdisp ? pdisp->vblank->index_nr : 0; |
| 180 | chan->vblank.event = kzalloc(chan->vblank.nr_event * | 180 | chan->vblank.event = kzalloc(chan->vblank.nr_event * |
| 181 | sizeof(*chan->vblank.event), GFP_KERNEL); | 181 | sizeof(*chan->vblank.event), GFP_KERNEL); |
| 182 | if (!chan->vblank.event) | 182 | if (!chan->vblank.event) |
diff --git a/drivers/gpu/drm/nouveau/core/include/subdev/clock.h b/drivers/gpu/drm/nouveau/core/include/subdev/clock.h index e2675bc0edba..8f4ced75444a 100644 --- a/drivers/gpu/drm/nouveau/core/include/subdev/clock.h +++ b/drivers/gpu/drm/nouveau/core/include/subdev/clock.h | |||
| @@ -14,6 +14,9 @@ enum nv_clk_src { | |||
| 14 | nv_clk_src_hclk, | 14 | nv_clk_src_hclk, |
| 15 | nv_clk_src_hclkm3, | 15 | nv_clk_src_hclkm3, |
| 16 | nv_clk_src_hclkm3d2, | 16 | nv_clk_src_hclkm3d2, |
| 17 | nv_clk_src_hclkm2d3, /* NVAA */ | ||
| 18 | nv_clk_src_hclkm4, /* NVAA */ | ||
| 19 | nv_clk_src_cclk, /* NVAA */ | ||
| 17 | 20 | ||
| 18 | nv_clk_src_host, | 21 | nv_clk_src_host, |
| 19 | 22 | ||
| @@ -127,6 +130,7 @@ extern struct nouveau_oclass nv04_clock_oclass; | |||
| 127 | extern struct nouveau_oclass nv40_clock_oclass; | 130 | extern struct nouveau_oclass nv40_clock_oclass; |
| 128 | extern struct nouveau_oclass *nv50_clock_oclass; | 131 | extern struct nouveau_oclass *nv50_clock_oclass; |
| 129 | extern struct nouveau_oclass *nv84_clock_oclass; | 132 | extern struct nouveau_oclass *nv84_clock_oclass; |
| 133 | extern struct nouveau_oclass *nvaa_clock_oclass; | ||
| 130 | extern struct nouveau_oclass nva3_clock_oclass; | 134 | extern struct nouveau_oclass nva3_clock_oclass; |
| 131 | extern struct nouveau_oclass nvc0_clock_oclass; | 135 | extern struct nouveau_oclass nvc0_clock_oclass; |
| 132 | extern struct nouveau_oclass nve0_clock_oclass; | 136 | extern struct nouveau_oclass nve0_clock_oclass; |
diff --git a/drivers/gpu/drm/nouveau/core/subdev/clock/nv04.c b/drivers/gpu/drm/nouveau/core/subdev/clock/nv04.c index da50c1b12928..30c1f3a4158e 100644 --- a/drivers/gpu/drm/nouveau/core/subdev/clock/nv04.c +++ b/drivers/gpu/drm/nouveau/core/subdev/clock/nv04.c | |||
| @@ -69,6 +69,11 @@ nv04_clock_pll_prog(struct nouveau_clock *clk, u32 reg1, | |||
| 69 | return 0; | 69 | return 0; |
| 70 | } | 70 | } |
| 71 | 71 | ||
| 72 | static struct nouveau_clocks | ||
| 73 | nv04_domain[] = { | ||
| 74 | { nv_clk_src_max } | ||
| 75 | }; | ||
| 76 | |||
| 72 | static int | 77 | static int |
| 73 | nv04_clock_ctor(struct nouveau_object *parent, struct nouveau_object *engine, | 78 | nv04_clock_ctor(struct nouveau_object *parent, struct nouveau_object *engine, |
| 74 | struct nouveau_oclass *oclass, void *data, u32 size, | 79 | struct nouveau_oclass *oclass, void *data, u32 size, |
| @@ -77,7 +82,7 @@ nv04_clock_ctor(struct nouveau_object *parent, struct nouveau_object *engine, | |||
| 77 | struct nv04_clock_priv *priv; | 82 | struct nv04_clock_priv *priv; |
| 78 | int ret; | 83 | int ret; |
| 79 | 84 | ||
| 80 | ret = nouveau_clock_create(parent, engine, oclass, NULL, &priv); | 85 | ret = nouveau_clock_create(parent, engine, oclass, nv04_domain, &priv); |
| 81 | *pobject = nv_object(priv); | 86 | *pobject = nv_object(priv); |
| 82 | if (ret) | 87 | if (ret) |
| 83 | return ret; | 88 | return ret; |
diff --git a/drivers/gpu/drm/nouveau/core/subdev/clock/nvaa.c b/drivers/gpu/drm/nouveau/core/subdev/clock/nvaa.c new file mode 100644 index 000000000000..7a723b4f564d --- /dev/null +++ b/drivers/gpu/drm/nouveau/core/subdev/clock/nvaa.c | |||
| @@ -0,0 +1,445 @@ | |||
| 1 | /* | ||
| 2 | * Copyright 2012 Red Hat Inc. | ||
| 3 | * | ||
| 4 | * Permission is hereby granted, free of charge, to any person obtaining a | ||
| 5 | * copy of this software and associated documentation files (the "Software"), | ||
| 6 | * to deal in the Software without restriction, including without limitation | ||
| 7 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, | ||
| 8 | * and/or sell copies of the Software, and to permit persons to whom the | ||
| 9 | * Software is furnished to do so, subject to the following conditions: | ||
| 10 | * | ||
| 11 | * The above copyright notice and this permission notice shall be included in | ||
| 12 | * all copies or substantial portions of the Software. | ||
| 13 | * | ||
| 14 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | ||
| 15 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | ||
| 16 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | ||
| 17 | * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR | ||
| 18 | * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, | ||
| 19 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR | ||
| 20 | * OTHER DEALINGS IN THE SOFTWARE. | ||
| 21 | * | ||
| 22 | * Authors: Ben Skeggs | ||
| 23 | */ | ||
| 24 | |||
| 25 | #include <engine/fifo.h> | ||
| 26 | #include <subdev/bios.h> | ||
| 27 | #include <subdev/bios/pll.h> | ||
| 28 | #include <subdev/timer.h> | ||
| 29 | #include <subdev/clock.h> | ||
| 30 | |||
| 31 | #include "pll.h" | ||
| 32 | |||
| 33 | struct nvaa_clock_priv { | ||
| 34 | struct nouveau_clock base; | ||
| 35 | enum nv_clk_src csrc, ssrc, vsrc; | ||
| 36 | u32 cctrl, sctrl; | ||
| 37 | u32 ccoef, scoef; | ||
| 38 | u32 cpost, spost; | ||
| 39 | u32 vdiv; | ||
| 40 | }; | ||
| 41 | |||
| 42 | static u32 | ||
| 43 | read_div(struct nouveau_clock *clk) | ||
| 44 | { | ||
| 45 | return nv_rd32(clk, 0x004600); | ||
| 46 | } | ||
| 47 | |||
| 48 | static u32 | ||
| 49 | read_pll(struct nouveau_clock *clk, u32 base) | ||
| 50 | { | ||
| 51 | u32 ctrl = nv_rd32(clk, base + 0); | ||
| 52 | u32 coef = nv_rd32(clk, base + 4); | ||
| 53 | u32 ref = clk->read(clk, nv_clk_src_href); | ||
| 54 | u32 post_div = 0; | ||
| 55 | u32 clock = 0; | ||
| 56 | int N1, M1; | ||
| 57 | |||
| 58 | switch (base){ | ||
| 59 | case 0x4020: | ||
| 60 | post_div = 1 << ((nv_rd32(clk, 0x4070) & 0x000f0000) >> 16); | ||
| 61 | break; | ||
| 62 | case 0x4028: | ||
| 63 | post_div = (nv_rd32(clk, 0x4040) & 0x000f0000) >> 16; | ||
| 64 | break; | ||
| 65 | default: | ||
| 66 | break; | ||
| 67 | } | ||
| 68 | |||
| 69 | N1 = (coef & 0x0000ff00) >> 8; | ||
| 70 | M1 = (coef & 0x000000ff); | ||
| 71 | if ((ctrl & 0x80000000) && M1) { | ||
| 72 | clock = ref * N1 / M1; | ||
| 73 | clock = clock / post_div; | ||
| 74 | } | ||
| 75 | |||
| 76 | return clock; | ||
| 77 | } | ||
| 78 | |||
| 79 | static int | ||
| 80 | nvaa_clock_read(struct nouveau_clock *clk, enum nv_clk_src src) | ||
| 81 | { | ||
| 82 | struct nvaa_clock_priv *priv = (void *)clk; | ||
| 83 | u32 mast = nv_rd32(clk, 0x00c054); | ||
| 84 | u32 P = 0; | ||
| 85 | |||
| 86 | switch (src) { | ||
| 87 | case nv_clk_src_crystal: | ||
| 88 | return nv_device(priv)->crystal; | ||
| 89 | case nv_clk_src_href: | ||
| 90 | return 100000; /* PCIE reference clock */ | ||
| 91 | case nv_clk_src_hclkm4: | ||
| 92 | return clk->read(clk, nv_clk_src_href) * 4; | ||
| 93 | case nv_clk_src_hclkm2d3: | ||
| 94 | return clk->read(clk, nv_clk_src_href) * 2 / 3; | ||
| 95 | case nv_clk_src_host: | ||
| 96 | switch (mast & 0x000c0000) { | ||
| 97 | case 0x00000000: return clk->read(clk, nv_clk_src_hclkm2d3); | ||
| 98 | case 0x00040000: break; | ||
| 99 | case 0x00080000: return clk->read(clk, nv_clk_src_hclkm4); | ||
| 100 | case 0x000c0000: return clk->read(clk, nv_clk_src_cclk); | ||
| 101 | } | ||
| 102 | break; | ||
| 103 | case nv_clk_src_core: | ||
| 104 | P = (nv_rd32(clk, 0x004028) & 0x00070000) >> 16; | ||
| 105 | |||
| 106 | switch (mast & 0x00000003) { | ||
| 107 | case 0x00000000: return clk->read(clk, nv_clk_src_crystal) >> P; | ||
| 108 | case 0x00000001: return 0; | ||
| 109 | case 0x00000002: return clk->read(clk, nv_clk_src_hclkm4) >> P; | ||
| 110 | case 0x00000003: return read_pll(clk, 0x004028) >> P; | ||
| 111 | } | ||
| 112 | break; | ||
| 113 | case nv_clk_src_cclk: | ||
| 114 | if ((mast & 0x03000000) != 0x03000000) | ||
| 115 | return clk->read(clk, nv_clk_src_core); | ||
| 116 | |||
| 117 | if ((mast & 0x00000200) == 0x00000000) | ||
| 118 | return clk->read(clk, nv_clk_src_core); | ||
| 119 | |||
| 120 | switch (mast & 0x00000c00) { | ||
| 121 | case 0x00000000: return clk->read(clk, nv_clk_src_href); | ||
| 122 | case 0x00000400: return clk->read(clk, nv_clk_src_hclkm4); | ||
| 123 | case 0x00000800: return clk->read(clk, nv_clk_src_hclkm2d3); | ||
| 124 | default: return 0; | ||
| 125 | } | ||
| 126 | case nv_clk_src_shader: | ||
| 127 | P = (nv_rd32(clk, 0x004020) & 0x00070000) >> 16; | ||
| 128 | switch (mast & 0x00000030) { | ||
| 129 | case 0x00000000: | ||
| 130 | if (mast & 0x00000040) | ||
| 131 | return clk->read(clk, nv_clk_src_href) >> P; | ||
| 132 | return clk->read(clk, nv_clk_src_crystal) >> P; | ||
| 133 | case 0x00000010: break; | ||
| 134 | case 0x00000020: return read_pll(clk, 0x004028) >> P; | ||
| 135 | case 0x00000030: return read_pll(clk, 0x004020) >> P; | ||
| 136 | } | ||
| 137 | break; | ||
| 138 | case nv_clk_src_mem: | ||
| 139 | return 0; | ||
| 140 | break; | ||
| 141 | case nv_clk_src_vdec: | ||
| 142 | P = (read_div(clk) & 0x00000700) >> 8; | ||
| 143 | |||
| 144 | switch (mast & 0x00400000) { | ||
| 145 | case 0x00400000: | ||
| 146 | return clk->read(clk, nv_clk_src_core) >> P; | ||
| 147 | break; | ||
| 148 | default: | ||
| 149 | return 500000 >> P; | ||
| 150 | break; | ||
| 151 | } | ||
| 152 | break; | ||
| 153 | default: | ||
| 154 | break; | ||
| 155 | } | ||
| 156 | |||
| 157 | nv_debug(priv, "unknown clock source %d 0x%08x\n", src, mast); | ||
| 158 | return 0; | ||
| 159 | } | ||
| 160 | |||
| 161 | static u32 | ||
| 162 | calc_pll(struct nvaa_clock_priv *priv, u32 reg, | ||
| 163 | u32 clock, int *N, int *M, int *P) | ||
| 164 | { | ||
| 165 | struct nouveau_bios *bios = nouveau_bios(priv); | ||
| 166 | struct nvbios_pll pll; | ||
| 167 | struct nouveau_clock *clk = &priv->base; | ||
| 168 | int ret; | ||
| 169 | |||
| 170 | ret = nvbios_pll_parse(bios, reg, &pll); | ||
| 171 | if (ret) | ||
| 172 | return 0; | ||
| 173 | |||
| 174 | pll.vco2.max_freq = 0; | ||
| 175 | pll.refclk = clk->read(clk, nv_clk_src_href); | ||
| 176 | if (!pll.refclk) | ||
| 177 | return 0; | ||
| 178 | |||
| 179 | return nv04_pll_calc(nv_subdev(priv), &pll, clock, N, M, NULL, NULL, P); | ||
| 180 | } | ||
| 181 | |||
| 182 | static inline u32 | ||
| 183 | calc_P(u32 src, u32 target, int *div) | ||
| 184 | { | ||
| 185 | u32 clk0 = src, clk1 = src; | ||
| 186 | for (*div = 0; *div <= 7; (*div)++) { | ||
| 187 | if (clk0 <= target) { | ||
| 188 | clk1 = clk0 << (*div ? 1 : 0); | ||
| 189 | break; | ||
| 190 | } | ||
| 191 | clk0 >>= 1; | ||
| 192 | } | ||
| 193 | |||
| 194 | if (target - clk0 <= clk1 - target) | ||
| 195 | return clk0; | ||
| 196 | (*div)--; | ||
| 197 | return clk1; | ||
| 198 | } | ||
| 199 | |||
| 200 | static int | ||
| 201 | nvaa_clock_calc(struct nouveau_clock *clk, struct nouveau_cstate *cstate) | ||
| 202 | { | ||
| 203 | struct nvaa_clock_priv *priv = (void *)clk; | ||
| 204 | const int shader = cstate->domain[nv_clk_src_shader]; | ||
| 205 | const int core = cstate->domain[nv_clk_src_core]; | ||
| 206 | const int vdec = cstate->domain[nv_clk_src_vdec]; | ||
| 207 | u32 out = 0, clock = 0; | ||
| 208 | int N, M, P1, P2 = 0; | ||
| 209 | int divs = 0; | ||
| 210 | |||
| 211 | /* cclk: find suitable source, disable PLL if we can */ | ||
| 212 | if (core < clk->read(clk, nv_clk_src_hclkm4)) | ||
| 213 | out = calc_P(clk->read(clk, nv_clk_src_hclkm4), core, &divs); | ||
| 214 | |||
| 215 | /* Calculate clock * 2, so shader clock can use it too */ | ||
| 216 | clock = calc_pll(priv, 0x4028, (core << 1), &N, &M, &P1); | ||
| 217 | |||
| 218 | if (abs(core - out) <= | ||
| 219 | abs(core - (clock >> 1))) { | ||
| 220 | priv->csrc = nv_clk_src_hclkm4; | ||
| 221 | priv->cctrl = divs << 16; | ||
| 222 | } else { | ||
| 223 | /* NVCTRL is actually used _after_ NVPOST, and after what we | ||
| 224 | * call NVPLL. To make matters worse, NVPOST is an integer | ||
| 225 | * divider instead of a right-shift number. */ | ||
| 226 | if(P1 > 2) { | ||
| 227 | P2 = P1 - 2; | ||
| 228 | P1 = 2; | ||
| 229 | } | ||
| 230 | |||
| 231 | priv->csrc = nv_clk_src_core; | ||
| 232 | priv->ccoef = (N << 8) | M; | ||
| 233 | |||
| 234 | priv->cctrl = (P2 + 1) << 16; | ||
| 235 | priv->cpost = (1 << P1) << 16; | ||
| 236 | } | ||
| 237 | |||
| 238 | /* sclk: nvpll + divisor, href or spll */ | ||
| 239 | out = 0; | ||
| 240 | if (shader == clk->read(clk, nv_clk_src_href)) { | ||
| 241 | priv->ssrc = nv_clk_src_href; | ||
| 242 | } else { | ||
| 243 | clock = calc_pll(priv, 0x4020, shader, &N, &M, &P1); | ||
| 244 | if (priv->csrc == nv_clk_src_core) { | ||
| 245 | out = calc_P((core << 1), shader, &divs); | ||
| 246 | } | ||
| 247 | |||
| 248 | if (abs(shader - out) <= | ||
| 249 | abs(shader - clock) && | ||
| 250 | (divs + P2) <= 7) { | ||
| 251 | priv->ssrc = nv_clk_src_core; | ||
| 252 | priv->sctrl = (divs + P2) << 16; | ||
| 253 | } else { | ||
| 254 | priv->ssrc = nv_clk_src_shader; | ||
| 255 | priv->scoef = (N << 8) | M; | ||
| 256 | priv->sctrl = P1 << 16; | ||
| 257 | } | ||
| 258 | } | ||
| 259 | |||
| 260 | /* vclk */ | ||
| 261 | out = calc_P(core, vdec, &divs); | ||
| 262 | clock = calc_P(500000, vdec, &P1); | ||
| 263 | if(abs(vdec - out) <= | ||
| 264 | abs(vdec - clock)) { | ||
| 265 | priv->vsrc = nv_clk_src_cclk; | ||
| 266 | priv->vdiv = divs << 16; | ||
| 267 | } else { | ||
| 268 | priv->vsrc = nv_clk_src_vdec; | ||
| 269 | priv->vdiv = P1 << 16; | ||
| 270 | } | ||
| 271 | |||
| 272 | /* Print strategy! */ | ||
| 273 | nv_debug(priv, "nvpll: %08x %08x %08x\n", | ||
| 274 | priv->ccoef, priv->cpost, priv->cctrl); | ||
| 275 | nv_debug(priv, " spll: %08x %08x %08x\n", | ||
| 276 | priv->scoef, priv->spost, priv->sctrl); | ||
| 277 | nv_debug(priv, " vdiv: %08x\n", priv->vdiv); | ||
| 278 | if (priv->csrc == nv_clk_src_hclkm4) | ||
| 279 | nv_debug(priv, "core: hrefm4\n"); | ||
| 280 | else | ||
| 281 | nv_debug(priv, "core: nvpll\n"); | ||
| 282 | |||
| 283 | if (priv->ssrc == nv_clk_src_hclkm4) | ||
| 284 | nv_debug(priv, "shader: hrefm4\n"); | ||
| 285 | else if (priv->ssrc == nv_clk_src_core) | ||
| 286 | nv_debug(priv, "shader: nvpll\n"); | ||
| 287 | else | ||
| 288 | nv_debug(priv, "shader: spll\n"); | ||
| 289 | |||
| 290 | if (priv->vsrc == nv_clk_src_hclkm4) | ||
| 291 | nv_debug(priv, "vdec: 500MHz\n"); | ||
| 292 | else | ||
| 293 | nv_debug(priv, "vdec: core\n"); | ||
| 294 | |||
| 295 | return 0; | ||
| 296 | } | ||
| 297 | |||
| 298 | static int | ||
| 299 | nvaa_clock_prog(struct nouveau_clock *clk) | ||
| 300 | { | ||
| 301 | struct nvaa_clock_priv *priv = (void *)clk; | ||
| 302 | struct nouveau_fifo *pfifo = nouveau_fifo(clk); | ||
| 303 | unsigned long flags; | ||
| 304 | u32 pllmask = 0, mast, ptherm_gate; | ||
| 305 | int ret = -EBUSY; | ||
| 306 | |||
| 307 | /* halt and idle execution engines */ | ||
| 308 | ptherm_gate = nv_mask(clk, 0x020060, 0x00070000, 0x00000000); | ||
| 309 | nv_mask(clk, 0x002504, 0x00000001, 0x00000001); | ||
| 310 | /* Wait until the interrupt handler is finished */ | ||
| 311 | if (!nv_wait(clk, 0x000100, 0xffffffff, 0x00000000)) | ||
| 312 | goto resume; | ||
| 313 | |||
| 314 | if (pfifo) | ||
| 315 | pfifo->pause(pfifo, &flags); | ||
| 316 | |||
| 317 | if (!nv_wait(clk, 0x002504, 0x00000010, 0x00000010)) | ||
| 318 | goto resume; | ||
| 319 | if (!nv_wait(clk, 0x00251c, 0x0000003f, 0x0000003f)) | ||
| 320 | goto resume; | ||
| 321 | |||
| 322 | /* First switch to safe clocks: href */ | ||
| 323 | mast = nv_mask(clk, 0xc054, 0x03400e70, 0x03400640); | ||
| 324 | mast &= ~0x00400e73; | ||
| 325 | mast |= 0x03000000; | ||
| 326 | |||
| 327 | switch (priv->csrc) { | ||
| 328 | case nv_clk_src_hclkm4: | ||
| 329 | nv_mask(clk, 0x4028, 0x00070000, priv->cctrl); | ||
| 330 | mast |= 0x00000002; | ||
| 331 | break; | ||
| 332 | case nv_clk_src_core: | ||
| 333 | nv_wr32(clk, 0x402c, priv->ccoef); | ||
| 334 | nv_wr32(clk, 0x4028, 0x80000000 | priv->cctrl); | ||
| 335 | nv_wr32(clk, 0x4040, priv->cpost); | ||
| 336 | pllmask |= (0x3 << 8); | ||
| 337 | mast |= 0x00000003; | ||
| 338 | break; | ||
| 339 | default: | ||
| 340 | nv_warn(priv,"Reclocking failed: unknown core clock\n"); | ||
| 341 | goto resume; | ||
| 342 | } | ||
| 343 | |||
| 344 | switch (priv->ssrc) { | ||
| 345 | case nv_clk_src_href: | ||
| 346 | nv_mask(clk, 0x4020, 0x00070000, 0x00000000); | ||
| 347 | /* mast |= 0x00000000; */ | ||
| 348 | break; | ||
| 349 | case nv_clk_src_core: | ||
| 350 | nv_mask(clk, 0x4020, 0x00070000, priv->sctrl); | ||
| 351 | mast |= 0x00000020; | ||
| 352 | break; | ||
| 353 | case nv_clk_src_shader: | ||
| 354 | nv_wr32(clk, 0x4024, priv->scoef); | ||
| 355 | nv_wr32(clk, 0x4020, 0x80000000 | priv->sctrl); | ||
| 356 | nv_wr32(clk, 0x4070, priv->spost); | ||
| 357 | pllmask |= (0x3 << 12); | ||
| 358 | mast |= 0x00000030; | ||
| 359 | break; | ||
| 360 | default: | ||
| 361 | nv_warn(priv,"Reclocking failed: unknown sclk clock\n"); | ||
| 362 | goto resume; | ||
| 363 | } | ||
| 364 | |||
| 365 | if (!nv_wait(clk, 0x004080, pllmask, pllmask)) { | ||
| 366 | nv_warn(priv,"Reclocking failed: unstable PLLs\n"); | ||
| 367 | goto resume; | ||
| 368 | } | ||
| 369 | |||
| 370 | switch (priv->vsrc) { | ||
| 371 | case nv_clk_src_cclk: | ||
| 372 | mast |= 0x00400000; | ||
| 373 | default: | ||
| 374 | nv_wr32(clk, 0x4600, priv->vdiv); | ||
| 375 | } | ||
| 376 | |||
| 377 | nv_wr32(clk, 0xc054, mast); | ||
| 378 | ret = 0; | ||
| 379 | |||
| 380 | resume: | ||
| 381 | if (pfifo) | ||
| 382 | pfifo->start(pfifo, &flags); | ||
| 383 | |||
| 384 | nv_mask(clk, 0x002504, 0x00000001, 0x00000000); | ||
| 385 | nv_wr32(clk, 0x020060, ptherm_gate); | ||
| 386 | |||
| 387 | /* Disable some PLLs and dividers when unused */ | ||
| 388 | if (priv->csrc != nv_clk_src_core) { | ||
| 389 | nv_wr32(clk, 0x4040, 0x00000000); | ||
| 390 | nv_mask(clk, 0x4028, 0x80000000, 0x00000000); | ||
| 391 | } | ||
| 392 | |||
| 393 | if (priv->ssrc != nv_clk_src_shader) { | ||
| 394 | nv_wr32(clk, 0x4070, 0x00000000); | ||
| 395 | nv_mask(clk, 0x4020, 0x80000000, 0x00000000); | ||
| 396 | } | ||
| 397 | |||
| 398 | return ret; | ||
| 399 | } | ||
| 400 | |||
| 401 | static void | ||
| 402 | nvaa_clock_tidy(struct nouveau_clock *clk) | ||
| 403 | { | ||
| 404 | } | ||
| 405 | |||
| 406 | static struct nouveau_clocks | ||
| 407 | nvaa_domains[] = { | ||
| 408 | { nv_clk_src_crystal, 0xff }, | ||
| 409 | { nv_clk_src_href , 0xff }, | ||
| 410 | { nv_clk_src_core , 0xff, 0, "core", 1000 }, | ||
| 411 | { nv_clk_src_shader , 0xff, 0, "shader", 1000 }, | ||
| 412 | { nv_clk_src_vdec , 0xff, 0, "vdec", 1000 }, | ||
| 413 | { nv_clk_src_max } | ||
| 414 | }; | ||
| 415 | |||
| 416 | static int | ||
| 417 | nvaa_clock_ctor(struct nouveau_object *parent, struct nouveau_object *engine, | ||
| 418 | struct nouveau_oclass *oclass, void *data, u32 size, | ||
| 419 | struct nouveau_object **pobject) | ||
| 420 | { | ||
| 421 | struct nvaa_clock_priv *priv; | ||
| 422 | int ret; | ||
| 423 | |||
| 424 | ret = nouveau_clock_create(parent, engine, oclass, nvaa_domains, &priv); | ||
| 425 | *pobject = nv_object(priv); | ||
| 426 | if (ret) | ||
| 427 | return ret; | ||
| 428 | |||
| 429 | priv->base.read = nvaa_clock_read; | ||
| 430 | priv->base.calc = nvaa_clock_calc; | ||
| 431 | priv->base.prog = nvaa_clock_prog; | ||
| 432 | priv->base.tidy = nvaa_clock_tidy; | ||
| 433 | return 0; | ||
| 434 | } | ||
| 435 | |||
| 436 | struct nouveau_oclass * | ||
| 437 | nvaa_clock_oclass = &(struct nouveau_oclass) { | ||
| 438 | .handle = NV_SUBDEV(CLOCK, 0xaa), | ||
| 439 | .ofuncs = &(struct nouveau_ofuncs) { | ||
| 440 | .ctor = nvaa_clock_ctor, | ||
| 441 | .dtor = _nouveau_clock_dtor, | ||
| 442 | .init = _nouveau_clock_init, | ||
| 443 | .fini = _nouveau_clock_fini, | ||
| 444 | }, | ||
| 445 | }; | ||
diff --git a/drivers/gpu/drm/nouveau/dispnv04/overlay.c b/drivers/gpu/drm/nouveau/dispnv04/overlay.c index 3618ac6b6316..32e7064b819b 100644 --- a/drivers/gpu/drm/nouveau/dispnv04/overlay.c +++ b/drivers/gpu/drm/nouveau/dispnv04/overlay.c | |||
| @@ -58,8 +58,8 @@ struct nouveau_plane { | |||
| 58 | }; | 58 | }; |
| 59 | 59 | ||
| 60 | static uint32_t formats[] = { | 60 | static uint32_t formats[] = { |
| 61 | DRM_FORMAT_NV12, | ||
| 62 | DRM_FORMAT_UYVY, | 61 | DRM_FORMAT_UYVY, |
| 62 | DRM_FORMAT_NV12, | ||
| 63 | }; | 63 | }; |
| 64 | 64 | ||
| 65 | /* Sine can be approximated with | 65 | /* Sine can be approximated with |
| @@ -99,13 +99,28 @@ nv10_update_plane(struct drm_plane *plane, struct drm_crtc *crtc, | |||
| 99 | struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc); | 99 | struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc); |
| 100 | struct nouveau_bo *cur = nv_plane->cur; | 100 | struct nouveau_bo *cur = nv_plane->cur; |
| 101 | bool flip = nv_plane->flip; | 101 | bool flip = nv_plane->flip; |
| 102 | int format = ALIGN(src_w * 4, 0x100); | ||
| 103 | int soff = NV_PCRTC0_SIZE * nv_crtc->index; | 102 | int soff = NV_PCRTC0_SIZE * nv_crtc->index; |
| 104 | int soff2 = NV_PCRTC0_SIZE * !nv_crtc->index; | 103 | int soff2 = NV_PCRTC0_SIZE * !nv_crtc->index; |
| 105 | int ret; | 104 | int format, ret; |
| 105 | |||
| 106 | /* Source parameters given in 16.16 fixed point, ignore fractional. */ | ||
| 107 | src_x >>= 16; | ||
| 108 | src_y >>= 16; | ||
| 109 | src_w >>= 16; | ||
| 110 | src_h >>= 16; | ||
| 111 | |||
| 112 | format = ALIGN(src_w * 4, 0x100); | ||
| 106 | 113 | ||
| 107 | if (format > 0xffff) | 114 | if (format > 0xffff) |
| 108 | return -EINVAL; | 115 | return -ERANGE; |
| 116 | |||
| 117 | if (dev->chipset >= 0x30) { | ||
| 118 | if (crtc_w < (src_w >> 1) || crtc_h < (src_h >> 1)) | ||
| 119 | return -ERANGE; | ||
| 120 | } else { | ||
| 121 | if (crtc_w < (src_w >> 3) || crtc_h < (src_h >> 3)) | ||
| 122 | return -ERANGE; | ||
| 123 | } | ||
| 109 | 124 | ||
| 110 | ret = nouveau_bo_pin(nv_fb->nvbo, TTM_PL_FLAG_VRAM); | 125 | ret = nouveau_bo_pin(nv_fb->nvbo, TTM_PL_FLAG_VRAM); |
| 111 | if (ret) | 126 | if (ret) |
| @@ -113,12 +128,6 @@ nv10_update_plane(struct drm_plane *plane, struct drm_crtc *crtc, | |||
| 113 | 128 | ||
| 114 | nv_plane->cur = nv_fb->nvbo; | 129 | nv_plane->cur = nv_fb->nvbo; |
| 115 | 130 | ||
| 116 | /* Source parameters given in 16.16 fixed point, ignore fractional. */ | ||
| 117 | src_x = src_x >> 16; | ||
| 118 | src_y = src_y >> 16; | ||
| 119 | src_w = src_w >> 16; | ||
| 120 | src_h = src_h >> 16; | ||
| 121 | |||
| 122 | nv_mask(dev, NV_PCRTC_ENGINE_CTRL + soff, NV_CRTC_FSEL_OVERLAY, NV_CRTC_FSEL_OVERLAY); | 131 | nv_mask(dev, NV_PCRTC_ENGINE_CTRL + soff, NV_CRTC_FSEL_OVERLAY, NV_CRTC_FSEL_OVERLAY); |
| 123 | nv_mask(dev, NV_PCRTC_ENGINE_CTRL + soff2, NV_CRTC_FSEL_OVERLAY, 0); | 132 | nv_mask(dev, NV_PCRTC_ENGINE_CTRL + soff2, NV_CRTC_FSEL_OVERLAY, 0); |
| 124 | 133 | ||
| @@ -245,14 +254,25 @@ nv10_overlay_init(struct drm_device *device) | |||
| 245 | { | 254 | { |
| 246 | struct nouveau_device *dev = nouveau_dev(device); | 255 | struct nouveau_device *dev = nouveau_dev(device); |
| 247 | struct nouveau_plane *plane = kzalloc(sizeof(struct nouveau_plane), GFP_KERNEL); | 256 | struct nouveau_plane *plane = kzalloc(sizeof(struct nouveau_plane), GFP_KERNEL); |
| 257 | int num_formats = ARRAY_SIZE(formats); | ||
| 248 | int ret; | 258 | int ret; |
| 249 | 259 | ||
| 250 | if (!plane) | 260 | if (!plane) |
| 251 | return; | 261 | return; |
| 252 | 262 | ||
| 263 | switch (dev->chipset) { | ||
| 264 | case 0x10: | ||
| 265 | case 0x11: | ||
| 266 | case 0x15: | ||
| 267 | case 0x1a: | ||
| 268 | case 0x20: | ||
| 269 | num_formats = 1; | ||
| 270 | break; | ||
| 271 | } | ||
| 272 | |||
| 253 | ret = drm_plane_init(device, &plane->base, 3 /* both crtc's */, | 273 | ret = drm_plane_init(device, &plane->base, 3 /* both crtc's */, |
| 254 | &nv10_plane_funcs, | 274 | &nv10_plane_funcs, |
| 255 | formats, ARRAY_SIZE(formats), false); | 275 | formats, num_formats, false); |
| 256 | if (ret) | 276 | if (ret) |
| 257 | goto err; | 277 | goto err; |
| 258 | 278 | ||
diff --git a/drivers/gpu/drm/nouveau/nouveau_display.c b/drivers/gpu/drm/nouveau/nouveau_display.c index 7809d92183c4..29c3efdfc7dd 100644 --- a/drivers/gpu/drm/nouveau/nouveau_display.c +++ b/drivers/gpu/drm/nouveau/nouveau_display.c | |||
| @@ -608,6 +608,7 @@ nouveau_crtc_page_flip(struct drm_crtc *crtc, struct drm_framebuffer *fb, | |||
| 608 | fence = nouveau_fence_ref(new_bo->bo.sync_obj); | 608 | fence = nouveau_fence_ref(new_bo->bo.sync_obj); |
| 609 | spin_unlock(&new_bo->bo.bdev->fence_lock); | 609 | spin_unlock(&new_bo->bo.bdev->fence_lock); |
| 610 | ret = nouveau_fence_sync(fence, chan); | 610 | ret = nouveau_fence_sync(fence, chan); |
| 611 | nouveau_fence_unref(&fence); | ||
| 611 | if (ret) | 612 | if (ret) |
| 612 | return ret; | 613 | return ret; |
| 613 | 614 | ||
| @@ -701,7 +702,7 @@ nouveau_finish_page_flip(struct nouveau_channel *chan, | |||
| 701 | 702 | ||
| 702 | s = list_first_entry(&fctx->flip, struct nouveau_page_flip_state, head); | 703 | s = list_first_entry(&fctx->flip, struct nouveau_page_flip_state, head); |
| 703 | if (s->event) | 704 | if (s->event) |
| 704 | drm_send_vblank_event(dev, -1, s->event); | 705 | drm_send_vblank_event(dev, s->crtc, s->event); |
| 705 | 706 | ||
| 706 | list_del(&s->head); | 707 | list_del(&s->head); |
| 707 | if (ps) | 708 | if (ps) |
diff --git a/drivers/gpu/drm/nouveau/nouveau_hwmon.c b/drivers/gpu/drm/nouveau/nouveau_hwmon.c index 38a4db5bfe21..4aff04fa483c 100644 --- a/drivers/gpu/drm/nouveau/nouveau_hwmon.c +++ b/drivers/gpu/drm/nouveau/nouveau_hwmon.c | |||
| @@ -630,7 +630,6 @@ error: | |||
| 630 | hwmon->hwmon = NULL; | 630 | hwmon->hwmon = NULL; |
| 631 | return ret; | 631 | return ret; |
| 632 | #else | 632 | #else |
| 633 | hwmon->hwmon = NULL; | ||
| 634 | return 0; | 633 | return 0; |
| 635 | #endif | 634 | #endif |
| 636 | } | 635 | } |
diff --git a/drivers/gpu/drm/nouveau/nv50_display.c b/drivers/gpu/drm/nouveau/nv50_display.c index f8e66c08b11a..4e384a2f99c3 100644 --- a/drivers/gpu/drm/nouveau/nv50_display.c +++ b/drivers/gpu/drm/nouveau/nv50_display.c | |||
| @@ -1265,7 +1265,7 @@ nv50_crtc_gamma_set(struct drm_crtc *crtc, u16 *r, u16 *g, u16 *b, | |||
| 1265 | uint32_t start, uint32_t size) | 1265 | uint32_t start, uint32_t size) |
| 1266 | { | 1266 | { |
| 1267 | struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc); | 1267 | struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc); |
| 1268 | u32 end = max(start + size, (u32)256); | 1268 | u32 end = min_t(u32, start + size, 256); |
| 1269 | u32 i; | 1269 | u32 i; |
| 1270 | 1270 | ||
| 1271 | for (i = start; i < end; i++) { | 1271 | for (i = start; i < end; i++) { |
diff --git a/drivers/gpu/drm/qxl/qxl_release.c b/drivers/gpu/drm/qxl/qxl_release.c index 0109a9644cb2..821ab7b9409b 100644 --- a/drivers/gpu/drm/qxl/qxl_release.c +++ b/drivers/gpu/drm/qxl/qxl_release.c | |||
| @@ -92,6 +92,7 @@ qxl_release_free(struct qxl_device *qdev, | |||
| 92 | - DRM_FILE_OFFSET); | 92 | - DRM_FILE_OFFSET); |
| 93 | qxl_fence_remove_release(&bo->fence, release->id); | 93 | qxl_fence_remove_release(&bo->fence, release->id); |
| 94 | qxl_bo_unref(&bo); | 94 | qxl_bo_unref(&bo); |
| 95 | kfree(entry); | ||
| 95 | } | 96 | } |
| 96 | spin_lock(&qdev->release_idr_lock); | 97 | spin_lock(&qdev->release_idr_lock); |
| 97 | idr_remove(&qdev->release_idr, release->id); | 98 | idr_remove(&qdev->release_idr, release->id); |
diff --git a/drivers/gpu/drm/radeon/atombios_i2c.c b/drivers/gpu/drm/radeon/atombios_i2c.c index 0652ee0a2098..f685035dbe39 100644 --- a/drivers/gpu/drm/radeon/atombios_i2c.c +++ b/drivers/gpu/drm/radeon/atombios_i2c.c | |||
| @@ -44,7 +44,7 @@ static int radeon_process_i2c_ch(struct radeon_i2c_chan *chan, | |||
| 44 | PROCESS_I2C_CHANNEL_TRANSACTION_PS_ALLOCATION args; | 44 | PROCESS_I2C_CHANNEL_TRANSACTION_PS_ALLOCATION args; |
| 45 | int index = GetIndexIntoMasterTable(COMMAND, ProcessI2cChannelTransaction); | 45 | int index = GetIndexIntoMasterTable(COMMAND, ProcessI2cChannelTransaction); |
| 46 | unsigned char *base; | 46 | unsigned char *base; |
| 47 | u16 out; | 47 | u16 out = cpu_to_le16(0); |
| 48 | 48 | ||
| 49 | memset(&args, 0, sizeof(args)); | 49 | memset(&args, 0, sizeof(args)); |
| 50 | 50 | ||
| @@ -55,11 +55,14 @@ static int radeon_process_i2c_ch(struct radeon_i2c_chan *chan, | |||
| 55 | DRM_ERROR("hw i2c: tried to write too many bytes (%d vs 3)\n", num); | 55 | DRM_ERROR("hw i2c: tried to write too many bytes (%d vs 3)\n", num); |
| 56 | return -EINVAL; | 56 | return -EINVAL; |
| 57 | } | 57 | } |
| 58 | args.ucRegIndex = buf[0]; | 58 | if (buf == NULL) |
| 59 | if (num > 1) { | 59 | args.ucRegIndex = 0; |
| 60 | else | ||
| 61 | args.ucRegIndex = buf[0]; | ||
| 62 | if (num) | ||
| 60 | num--; | 63 | num--; |
| 64 | if (num) | ||
| 61 | memcpy(&out, &buf[1], num); | 65 | memcpy(&out, &buf[1], num); |
| 62 | } | ||
| 63 | args.lpI2CDataOut = cpu_to_le16(out); | 66 | args.lpI2CDataOut = cpu_to_le16(out); |
| 64 | } else { | 67 | } else { |
| 65 | if (num > ATOM_MAX_HW_I2C_READ) { | 68 | if (num > ATOM_MAX_HW_I2C_READ) { |
| @@ -96,14 +99,14 @@ int radeon_atom_hw_i2c_xfer(struct i2c_adapter *i2c_adap, | |||
| 96 | struct radeon_i2c_chan *i2c = i2c_get_adapdata(i2c_adap); | 99 | struct radeon_i2c_chan *i2c = i2c_get_adapdata(i2c_adap); |
| 97 | struct i2c_msg *p; | 100 | struct i2c_msg *p; |
| 98 | int i, remaining, current_count, buffer_offset, max_bytes, ret; | 101 | int i, remaining, current_count, buffer_offset, max_bytes, ret; |
| 99 | u8 buf = 0, flags; | 102 | u8 flags; |
| 100 | 103 | ||
| 101 | /* check for bus probe */ | 104 | /* check for bus probe */ |
| 102 | p = &msgs[0]; | 105 | p = &msgs[0]; |
| 103 | if ((num == 1) && (p->len == 0)) { | 106 | if ((num == 1) && (p->len == 0)) { |
| 104 | ret = radeon_process_i2c_ch(i2c, | 107 | ret = radeon_process_i2c_ch(i2c, |
| 105 | p->addr, HW_I2C_WRITE, | 108 | p->addr, HW_I2C_WRITE, |
| 106 | &buf, 1); | 109 | NULL, 0); |
| 107 | if (ret) | 110 | if (ret) |
| 108 | return ret; | 111 | return ret; |
| 109 | else | 112 | else |
diff --git a/drivers/gpu/drm/radeon/dce6_afmt.c b/drivers/gpu/drm/radeon/dce6_afmt.c index 009f46e0ce72..de86493cbc44 100644 --- a/drivers/gpu/drm/radeon/dce6_afmt.c +++ b/drivers/gpu/drm/radeon/dce6_afmt.c | |||
| @@ -93,11 +93,13 @@ void dce6_afmt_select_pin(struct drm_encoder *encoder) | |||
| 93 | struct radeon_device *rdev = encoder->dev->dev_private; | 93 | struct radeon_device *rdev = encoder->dev->dev_private; |
| 94 | struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder); | 94 | struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder); |
| 95 | struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv; | 95 | struct radeon_encoder_atom_dig *dig = radeon_encoder->enc_priv; |
| 96 | u32 offset = dig->afmt->offset; | 96 | u32 offset; |
| 97 | 97 | ||
| 98 | if (!dig->afmt->pin) | 98 | if (!dig || !dig->afmt || !dig->afmt->pin) |
| 99 | return; | 99 | return; |
| 100 | 100 | ||
| 101 | offset = dig->afmt->offset; | ||
| 102 | |||
| 101 | WREG32(AFMT_AUDIO_SRC_CONTROL + offset, | 103 | WREG32(AFMT_AUDIO_SRC_CONTROL + offset, |
| 102 | AFMT_AUDIO_SRC_SELECT(dig->afmt->pin->id)); | 104 | AFMT_AUDIO_SRC_SELECT(dig->afmt->pin->id)); |
| 103 | } | 105 | } |
| @@ -112,7 +114,7 @@ void dce6_afmt_write_latency_fields(struct drm_encoder *encoder, | |||
| 112 | struct radeon_connector *radeon_connector = NULL; | 114 | struct radeon_connector *radeon_connector = NULL; |
| 113 | u32 tmp = 0, offset; | 115 | u32 tmp = 0, offset; |
| 114 | 116 | ||
| 115 | if (!dig->afmt->pin) | 117 | if (!dig || !dig->afmt || !dig->afmt->pin) |
| 116 | return; | 118 | return; |
| 117 | 119 | ||
| 118 | offset = dig->afmt->pin->offset; | 120 | offset = dig->afmt->pin->offset; |
| @@ -156,7 +158,7 @@ void dce6_afmt_write_speaker_allocation(struct drm_encoder *encoder) | |||
| 156 | u8 *sadb; | 158 | u8 *sadb; |
| 157 | int sad_count; | 159 | int sad_count; |
| 158 | 160 | ||
| 159 | if (!dig->afmt->pin) | 161 | if (!dig || !dig->afmt || !dig->afmt->pin) |
| 160 | return; | 162 | return; |
| 161 | 163 | ||
| 162 | offset = dig->afmt->pin->offset; | 164 | offset = dig->afmt->pin->offset; |
| @@ -217,7 +219,7 @@ void dce6_afmt_write_sad_regs(struct drm_encoder *encoder) | |||
| 217 | { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR13, HDMI_AUDIO_CODING_TYPE_WMA_PRO }, | 219 | { AZ_F0_CODEC_PIN_CONTROL_AUDIO_DESCRIPTOR13, HDMI_AUDIO_CODING_TYPE_WMA_PRO }, |
| 218 | }; | 220 | }; |
| 219 | 221 | ||
| 220 | if (!dig->afmt->pin) | 222 | if (!dig || !dig->afmt || !dig->afmt->pin) |
| 221 | return; | 223 | return; |
| 222 | 224 | ||
| 223 | offset = dig->afmt->pin->offset; | 225 | offset = dig->afmt->pin->offset; |
diff --git a/drivers/gpu/drm/radeon/ni_dpm.c b/drivers/gpu/drm/radeon/ni_dpm.c index cdc003085a76..49c4d48f54d6 100644 --- a/drivers/gpu/drm/radeon/ni_dpm.c +++ b/drivers/gpu/drm/radeon/ni_dpm.c | |||
| @@ -785,8 +785,8 @@ static void ni_apply_state_adjust_rules(struct radeon_device *rdev, | |||
| 785 | struct ni_ps *ps = ni_get_ps(rps); | 785 | struct ni_ps *ps = ni_get_ps(rps); |
| 786 | struct radeon_clock_and_voltage_limits *max_limits; | 786 | struct radeon_clock_and_voltage_limits *max_limits; |
| 787 | bool disable_mclk_switching; | 787 | bool disable_mclk_switching; |
| 788 | u32 mclk, sclk; | 788 | u32 mclk; |
| 789 | u16 vddc, vddci; | 789 | u16 vddci; |
| 790 | u32 max_sclk_vddc, max_mclk_vddci, max_mclk_vddc; | 790 | u32 max_sclk_vddc, max_mclk_vddci, max_mclk_vddc; |
| 791 | int i; | 791 | int i; |
| 792 | 792 | ||
| @@ -839,24 +839,14 @@ static void ni_apply_state_adjust_rules(struct radeon_device *rdev, | |||
| 839 | 839 | ||
| 840 | /* XXX validate the min clocks required for display */ | 840 | /* XXX validate the min clocks required for display */ |
| 841 | 841 | ||
| 842 | /* adjust low state */ | ||
| 842 | if (disable_mclk_switching) { | 843 | if (disable_mclk_switching) { |
| 843 | mclk = ps->performance_levels[ps->performance_level_count - 1].mclk; | 844 | ps->performance_levels[0].mclk = |
| 844 | sclk = ps->performance_levels[0].sclk; | 845 | ps->performance_levels[ps->performance_level_count - 1].mclk; |
| 845 | vddc = ps->performance_levels[0].vddc; | 846 | ps->performance_levels[0].vddci = |
| 846 | vddci = ps->performance_levels[ps->performance_level_count - 1].vddci; | 847 | ps->performance_levels[ps->performance_level_count - 1].vddci; |
| 847 | } else { | ||
| 848 | sclk = ps->performance_levels[0].sclk; | ||
| 849 | mclk = ps->performance_levels[0].mclk; | ||
| 850 | vddc = ps->performance_levels[0].vddc; | ||
| 851 | vddci = ps->performance_levels[0].vddci; | ||
| 852 | } | 848 | } |
| 853 | 849 | ||
| 854 | /* adjusted low state */ | ||
| 855 | ps->performance_levels[0].sclk = sclk; | ||
| 856 | ps->performance_levels[0].mclk = mclk; | ||
| 857 | ps->performance_levels[0].vddc = vddc; | ||
| 858 | ps->performance_levels[0].vddci = vddci; | ||
| 859 | |||
| 860 | btc_skip_blacklist_clocks(rdev, max_limits->sclk, max_limits->mclk, | 850 | btc_skip_blacklist_clocks(rdev, max_limits->sclk, max_limits->mclk, |
| 861 | &ps->performance_levels[0].sclk, | 851 | &ps->performance_levels[0].sclk, |
| 862 | &ps->performance_levels[0].mclk); | 852 | &ps->performance_levels[0].mclk); |
| @@ -868,11 +858,15 @@ static void ni_apply_state_adjust_rules(struct radeon_device *rdev, | |||
| 868 | ps->performance_levels[i].vddc = ps->performance_levels[i - 1].vddc; | 858 | ps->performance_levels[i].vddc = ps->performance_levels[i - 1].vddc; |
| 869 | } | 859 | } |
| 870 | 860 | ||
| 861 | /* adjust remaining states */ | ||
| 871 | if (disable_mclk_switching) { | 862 | if (disable_mclk_switching) { |
| 872 | mclk = ps->performance_levels[0].mclk; | 863 | mclk = ps->performance_levels[0].mclk; |
| 864 | vddci = ps->performance_levels[0].vddci; | ||
| 873 | for (i = 1; i < ps->performance_level_count; i++) { | 865 | for (i = 1; i < ps->performance_level_count; i++) { |
| 874 | if (mclk < ps->performance_levels[i].mclk) | 866 | if (mclk < ps->performance_levels[i].mclk) |
| 875 | mclk = ps->performance_levels[i].mclk; | 867 | mclk = ps->performance_levels[i].mclk; |
| 868 | if (vddci < ps->performance_levels[i].vddci) | ||
| 869 | vddci = ps->performance_levels[i].vddci; | ||
| 876 | } | 870 | } |
| 877 | for (i = 0; i < ps->performance_level_count; i++) { | 871 | for (i = 0; i < ps->performance_level_count; i++) { |
| 878 | ps->performance_levels[i].mclk = mclk; | 872 | ps->performance_levels[i].mclk = mclk; |
diff --git a/drivers/gpu/drm/radeon/r600_hdmi.c b/drivers/gpu/drm/radeon/r600_hdmi.c index 4b89262f3f0e..b7d3ecba43e3 100644 --- a/drivers/gpu/drm/radeon/r600_hdmi.c +++ b/drivers/gpu/drm/radeon/r600_hdmi.c | |||
| @@ -304,9 +304,9 @@ void r600_audio_set_dto(struct drm_encoder *encoder, u32 clock) | |||
| 304 | WREG32(DCCG_AUDIO_DTO1_MODULE, dto_modulo); | 304 | WREG32(DCCG_AUDIO_DTO1_MODULE, dto_modulo); |
| 305 | WREG32(DCCG_AUDIO_DTO_SELECT, 1); /* select DTO1 */ | 305 | WREG32(DCCG_AUDIO_DTO_SELECT, 1); /* select DTO1 */ |
| 306 | } | 306 | } |
| 307 | } else if (ASIC_IS_DCE3(rdev)) { | 307 | } else { |
| 308 | /* according to the reg specs, this should DCE3.2 only, but in | 308 | /* according to the reg specs, this should DCE3.2 only, but in |
| 309 | * practice it seems to cover DCE3.0/3.1 as well. | 309 | * practice it seems to cover DCE2.0/3.0/3.1 as well. |
| 310 | */ | 310 | */ |
| 311 | if (dig->dig_encoder == 0) { | 311 | if (dig->dig_encoder == 0) { |
| 312 | WREG32(DCCG_AUDIO_DTO0_PHASE, base_rate * 100); | 312 | WREG32(DCCG_AUDIO_DTO0_PHASE, base_rate * 100); |
| @@ -317,10 +317,6 @@ void r600_audio_set_dto(struct drm_encoder *encoder, u32 clock) | |||
| 317 | WREG32(DCCG_AUDIO_DTO1_MODULE, clock * 100); | 317 | WREG32(DCCG_AUDIO_DTO1_MODULE, clock * 100); |
| 318 | WREG32(DCCG_AUDIO_DTO_SELECT, 1); /* select DTO1 */ | 318 | WREG32(DCCG_AUDIO_DTO_SELECT, 1); /* select DTO1 */ |
| 319 | } | 319 | } |
| 320 | } else { | ||
| 321 | /* according to the reg specs, this should be DCE2.0 and DCE3.0/3.1 */ | ||
| 322 | WREG32(AUDIO_DTO, AUDIO_DTO_PHASE(base_rate / 10) | | ||
| 323 | AUDIO_DTO_MODULE(clock / 10)); | ||
| 324 | } | 320 | } |
| 325 | } | 321 | } |
| 326 | 322 | ||
diff --git a/drivers/gpu/drm/radeon/radeon.h b/drivers/gpu/drm/radeon/radeon.h index ecf2a3960c07..b1f990d0eaa1 100644 --- a/drivers/gpu/drm/radeon/radeon.h +++ b/drivers/gpu/drm/radeon/radeon.h | |||
| @@ -2710,10 +2710,10 @@ void radeon_vm_fence(struct radeon_device *rdev, | |||
| 2710 | struct radeon_vm *vm, | 2710 | struct radeon_vm *vm, |
| 2711 | struct radeon_fence *fence); | 2711 | struct radeon_fence *fence); |
| 2712 | uint64_t radeon_vm_map_gart(struct radeon_device *rdev, uint64_t addr); | 2712 | uint64_t radeon_vm_map_gart(struct radeon_device *rdev, uint64_t addr); |
| 2713 | int radeon_vm_bo_update_pte(struct radeon_device *rdev, | 2713 | int radeon_vm_bo_update(struct radeon_device *rdev, |
| 2714 | struct radeon_vm *vm, | 2714 | struct radeon_vm *vm, |
| 2715 | struct radeon_bo *bo, | 2715 | struct radeon_bo *bo, |
| 2716 | struct ttm_mem_reg *mem); | 2716 | struct ttm_mem_reg *mem); |
| 2717 | void radeon_vm_bo_invalidate(struct radeon_device *rdev, | 2717 | void radeon_vm_bo_invalidate(struct radeon_device *rdev, |
| 2718 | struct radeon_bo *bo); | 2718 | struct radeon_bo *bo); |
| 2719 | struct radeon_bo_va *radeon_vm_bo_find(struct radeon_vm *vm, | 2719 | struct radeon_bo_va *radeon_vm_bo_find(struct radeon_vm *vm, |
diff --git a/drivers/gpu/drm/radeon/radeon_atombios.c b/drivers/gpu/drm/radeon/radeon_atombios.c index f79ee184ffd5..5c39bf7c3d88 100644 --- a/drivers/gpu/drm/radeon/radeon_atombios.c +++ b/drivers/gpu/drm/radeon/radeon_atombios.c | |||
| @@ -2918,7 +2918,7 @@ int radeon_atom_get_memory_pll_dividers(struct radeon_device *rdev, | |||
| 2918 | mpll_param->dll_speed = args.ucDllSpeed; | 2918 | mpll_param->dll_speed = args.ucDllSpeed; |
| 2919 | mpll_param->bwcntl = args.ucBWCntl; | 2919 | mpll_param->bwcntl = args.ucBWCntl; |
| 2920 | mpll_param->vco_mode = | 2920 | mpll_param->vco_mode = |
| 2921 | (args.ucPllCntlFlag & MPLL_CNTL_FLAG_VCO_MODE_MASK) ? 1 : 0; | 2921 | (args.ucPllCntlFlag & MPLL_CNTL_FLAG_VCO_MODE_MASK); |
| 2922 | mpll_param->yclk_sel = | 2922 | mpll_param->yclk_sel = |
| 2923 | (args.ucPllCntlFlag & MPLL_CNTL_FLAG_BYPASS_DQ_PLL) ? 1 : 0; | 2923 | (args.ucPllCntlFlag & MPLL_CNTL_FLAG_BYPASS_DQ_PLL) ? 1 : 0; |
| 2924 | mpll_param->qdr = | 2924 | mpll_param->qdr = |
diff --git a/drivers/gpu/drm/radeon/radeon_cs.c b/drivers/gpu/drm/radeon/radeon_cs.c index f41594b2eeac..0b366169d64d 100644 --- a/drivers/gpu/drm/radeon/radeon_cs.c +++ b/drivers/gpu/drm/radeon/radeon_cs.c | |||
| @@ -360,13 +360,13 @@ static int radeon_bo_vm_update_pte(struct radeon_cs_parser *parser, | |||
| 360 | struct radeon_bo *bo; | 360 | struct radeon_bo *bo; |
| 361 | int r; | 361 | int r; |
| 362 | 362 | ||
| 363 | r = radeon_vm_bo_update_pte(rdev, vm, rdev->ring_tmp_bo.bo, &rdev->ring_tmp_bo.bo->tbo.mem); | 363 | r = radeon_vm_bo_update(rdev, vm, rdev->ring_tmp_bo.bo, &rdev->ring_tmp_bo.bo->tbo.mem); |
| 364 | if (r) { | 364 | if (r) { |
| 365 | return r; | 365 | return r; |
| 366 | } | 366 | } |
| 367 | list_for_each_entry(lobj, &parser->validated, tv.head) { | 367 | list_for_each_entry(lobj, &parser->validated, tv.head) { |
| 368 | bo = lobj->bo; | 368 | bo = lobj->bo; |
| 369 | r = radeon_vm_bo_update_pte(parser->rdev, vm, bo, &bo->tbo.mem); | 369 | r = radeon_vm_bo_update(parser->rdev, vm, bo, &bo->tbo.mem); |
| 370 | if (r) { | 370 | if (r) { |
| 371 | return r; | 371 | return r; |
| 372 | } | 372 | } |
diff --git a/drivers/gpu/drm/radeon/radeon_drv.h b/drivers/gpu/drm/radeon/radeon_drv.h index 543dcfae7e6f..00e0d449021c 100644 --- a/drivers/gpu/drm/radeon/radeon_drv.h +++ b/drivers/gpu/drm/radeon/radeon_drv.h | |||
| @@ -108,9 +108,10 @@ | |||
| 108 | * 1.31- Add support for num Z pipes from GET_PARAM | 108 | * 1.31- Add support for num Z pipes from GET_PARAM |
| 109 | * 1.32- fixes for rv740 setup | 109 | * 1.32- fixes for rv740 setup |
| 110 | * 1.33- Add r6xx/r7xx const buffer support | 110 | * 1.33- Add r6xx/r7xx const buffer support |
| 111 | * 1.34- fix evergreen/cayman GS register | ||
| 111 | */ | 112 | */ |
| 112 | #define DRIVER_MAJOR 1 | 113 | #define DRIVER_MAJOR 1 |
| 113 | #define DRIVER_MINOR 33 | 114 | #define DRIVER_MINOR 34 |
| 114 | #define DRIVER_PATCHLEVEL 0 | 115 | #define DRIVER_PATCHLEVEL 0 |
| 115 | 116 | ||
| 116 | long radeon_drm_ioctl(struct file *filp, | 117 | long radeon_drm_ioctl(struct file *filp, |
diff --git a/drivers/gpu/drm/radeon/radeon_gart.c b/drivers/gpu/drm/radeon/radeon_gart.c index 3044e504f4ec..96e440061bdb 100644 --- a/drivers/gpu/drm/radeon/radeon_gart.c +++ b/drivers/gpu/drm/radeon/radeon_gart.c | |||
| @@ -29,6 +29,7 @@ | |||
| 29 | #include <drm/radeon_drm.h> | 29 | #include <drm/radeon_drm.h> |
| 30 | #include "radeon.h" | 30 | #include "radeon.h" |
| 31 | #include "radeon_reg.h" | 31 | #include "radeon_reg.h" |
| 32 | #include "radeon_trace.h" | ||
| 32 | 33 | ||
| 33 | /* | 34 | /* |
| 34 | * GART | 35 | * GART |
| @@ -737,6 +738,7 @@ struct radeon_fence *radeon_vm_grab_id(struct radeon_device *rdev, | |||
| 737 | for (i = 0; i < 2; ++i) { | 738 | for (i = 0; i < 2; ++i) { |
| 738 | if (choices[i]) { | 739 | if (choices[i]) { |
| 739 | vm->id = choices[i]; | 740 | vm->id = choices[i]; |
| 741 | trace_radeon_vm_grab_id(vm->id, ring); | ||
| 740 | return rdev->vm_manager.active[choices[i]]; | 742 | return rdev->vm_manager.active[choices[i]]; |
| 741 | } | 743 | } |
| 742 | } | 744 | } |
| @@ -1116,7 +1118,7 @@ static void radeon_vm_update_ptes(struct radeon_device *rdev, | |||
| 1116 | } | 1118 | } |
| 1117 | 1119 | ||
| 1118 | /** | 1120 | /** |
| 1119 | * radeon_vm_bo_update_pte - map a bo into the vm page table | 1121 | * radeon_vm_bo_update - map a bo into the vm page table |
| 1120 | * | 1122 | * |
| 1121 | * @rdev: radeon_device pointer | 1123 | * @rdev: radeon_device pointer |
| 1122 | * @vm: requested vm | 1124 | * @vm: requested vm |
| @@ -1128,10 +1130,10 @@ static void radeon_vm_update_ptes(struct radeon_device *rdev, | |||
| 1128 | * | 1130 | * |
| 1129 | * Object have to be reserved & global and local mutex must be locked! | 1131 | * Object have to be reserved & global and local mutex must be locked! |
| 1130 | */ | 1132 | */ |
| 1131 | int radeon_vm_bo_update_pte(struct radeon_device *rdev, | 1133 | int radeon_vm_bo_update(struct radeon_device *rdev, |
| 1132 | struct radeon_vm *vm, | 1134 | struct radeon_vm *vm, |
| 1133 | struct radeon_bo *bo, | 1135 | struct radeon_bo *bo, |
| 1134 | struct ttm_mem_reg *mem) | 1136 | struct ttm_mem_reg *mem) |
| 1135 | { | 1137 | { |
| 1136 | struct radeon_ib ib; | 1138 | struct radeon_ib ib; |
| 1137 | struct radeon_bo_va *bo_va; | 1139 | struct radeon_bo_va *bo_va; |
| @@ -1176,6 +1178,8 @@ int radeon_vm_bo_update_pte(struct radeon_device *rdev, | |||
| 1176 | bo_va->valid = false; | 1178 | bo_va->valid = false; |
| 1177 | } | 1179 | } |
| 1178 | 1180 | ||
| 1181 | trace_radeon_vm_bo_update(bo_va); | ||
| 1182 | |||
| 1179 | nptes = radeon_bo_ngpu_pages(bo); | 1183 | nptes = radeon_bo_ngpu_pages(bo); |
| 1180 | 1184 | ||
| 1181 | /* assume two extra pdes in case the mapping overlaps the borders */ | 1185 | /* assume two extra pdes in case the mapping overlaps the borders */ |
| @@ -1257,7 +1261,7 @@ int radeon_vm_bo_rmv(struct radeon_device *rdev, | |||
| 1257 | mutex_lock(&rdev->vm_manager.lock); | 1261 | mutex_lock(&rdev->vm_manager.lock); |
| 1258 | mutex_lock(&bo_va->vm->mutex); | 1262 | mutex_lock(&bo_va->vm->mutex); |
| 1259 | if (bo_va->soffset) { | 1263 | if (bo_va->soffset) { |
| 1260 | r = radeon_vm_bo_update_pte(rdev, bo_va->vm, bo_va->bo, NULL); | 1264 | r = radeon_vm_bo_update(rdev, bo_va->vm, bo_va->bo, NULL); |
| 1261 | } | 1265 | } |
| 1262 | mutex_unlock(&rdev->vm_manager.lock); | 1266 | mutex_unlock(&rdev->vm_manager.lock); |
| 1263 | list_del(&bo_va->vm_list); | 1267 | list_del(&bo_va->vm_list); |
diff --git a/drivers/gpu/drm/radeon/radeon_pm.c b/drivers/gpu/drm/radeon/radeon_pm.c index d1385ccc672c..984097b907ef 100644 --- a/drivers/gpu/drm/radeon/radeon_pm.c +++ b/drivers/gpu/drm/radeon/radeon_pm.c | |||
| @@ -537,8 +537,7 @@ static ssize_t radeon_hwmon_show_temp(struct device *dev, | |||
| 537 | struct device_attribute *attr, | 537 | struct device_attribute *attr, |
| 538 | char *buf) | 538 | char *buf) |
| 539 | { | 539 | { |
| 540 | struct drm_device *ddev = dev_get_drvdata(dev); | 540 | struct radeon_device *rdev = dev_get_drvdata(dev); |
| 541 | struct radeon_device *rdev = ddev->dev_private; | ||
| 542 | int temp; | 541 | int temp; |
| 543 | 542 | ||
| 544 | if (rdev->asic->pm.get_temperature) | 543 | if (rdev->asic->pm.get_temperature) |
| @@ -553,8 +552,7 @@ static ssize_t radeon_hwmon_show_temp_thresh(struct device *dev, | |||
| 553 | struct device_attribute *attr, | 552 | struct device_attribute *attr, |
| 554 | char *buf) | 553 | char *buf) |
| 555 | { | 554 | { |
| 556 | struct drm_device *ddev = dev_get_drvdata(dev); | 555 | struct radeon_device *rdev = dev_get_drvdata(dev); |
| 557 | struct radeon_device *rdev = ddev->dev_private; | ||
| 558 | int hyst = to_sensor_dev_attr(attr)->index; | 556 | int hyst = to_sensor_dev_attr(attr)->index; |
| 559 | int temp; | 557 | int temp; |
| 560 | 558 | ||
| @@ -566,23 +564,14 @@ static ssize_t radeon_hwmon_show_temp_thresh(struct device *dev, | |||
| 566 | return snprintf(buf, PAGE_SIZE, "%d\n", temp); | 564 | return snprintf(buf, PAGE_SIZE, "%d\n", temp); |
| 567 | } | 565 | } |
| 568 | 566 | ||
| 569 | static ssize_t radeon_hwmon_show_name(struct device *dev, | ||
| 570 | struct device_attribute *attr, | ||
| 571 | char *buf) | ||
| 572 | { | ||
| 573 | return sprintf(buf, "radeon\n"); | ||
| 574 | } | ||
| 575 | |||
| 576 | static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, radeon_hwmon_show_temp, NULL, 0); | 567 | static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, radeon_hwmon_show_temp, NULL, 0); |
| 577 | static SENSOR_DEVICE_ATTR(temp1_crit, S_IRUGO, radeon_hwmon_show_temp_thresh, NULL, 0); | 568 | static SENSOR_DEVICE_ATTR(temp1_crit, S_IRUGO, radeon_hwmon_show_temp_thresh, NULL, 0); |
| 578 | static SENSOR_DEVICE_ATTR(temp1_crit_hyst, S_IRUGO, radeon_hwmon_show_temp_thresh, NULL, 1); | 569 | static SENSOR_DEVICE_ATTR(temp1_crit_hyst, S_IRUGO, radeon_hwmon_show_temp_thresh, NULL, 1); |
| 579 | static SENSOR_DEVICE_ATTR(name, S_IRUGO, radeon_hwmon_show_name, NULL, 0); | ||
| 580 | 570 | ||
| 581 | static struct attribute *hwmon_attributes[] = { | 571 | static struct attribute *hwmon_attributes[] = { |
| 582 | &sensor_dev_attr_temp1_input.dev_attr.attr, | 572 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 583 | &sensor_dev_attr_temp1_crit.dev_attr.attr, | 573 | &sensor_dev_attr_temp1_crit.dev_attr.attr, |
| 584 | &sensor_dev_attr_temp1_crit_hyst.dev_attr.attr, | 574 | &sensor_dev_attr_temp1_crit_hyst.dev_attr.attr, |
| 585 | &sensor_dev_attr_name.dev_attr.attr, | ||
| 586 | NULL | 575 | NULL |
| 587 | }; | 576 | }; |
| 588 | 577 | ||
| @@ -590,8 +579,7 @@ static umode_t hwmon_attributes_visible(struct kobject *kobj, | |||
| 590 | struct attribute *attr, int index) | 579 | struct attribute *attr, int index) |
| 591 | { | 580 | { |
| 592 | struct device *dev = container_of(kobj, struct device, kobj); | 581 | struct device *dev = container_of(kobj, struct device, kobj); |
| 593 | struct drm_device *ddev = dev_get_drvdata(dev); | 582 | struct radeon_device *rdev = dev_get_drvdata(dev); |
| 594 | struct radeon_device *rdev = ddev->dev_private; | ||
| 595 | 583 | ||
| 596 | /* Skip limit attributes if DPM is not enabled */ | 584 | /* Skip limit attributes if DPM is not enabled */ |
| 597 | if (rdev->pm.pm_method != PM_METHOD_DPM && | 585 | if (rdev->pm.pm_method != PM_METHOD_DPM && |
| @@ -607,11 +595,15 @@ static const struct attribute_group hwmon_attrgroup = { | |||
| 607 | .is_visible = hwmon_attributes_visible, | 595 | .is_visible = hwmon_attributes_visible, |
| 608 | }; | 596 | }; |
| 609 | 597 | ||
| 598 | static const struct attribute_group *hwmon_groups[] = { | ||
| 599 | &hwmon_attrgroup, | ||
| 600 | NULL | ||
| 601 | }; | ||
| 602 | |||
| 610 | static int radeon_hwmon_init(struct radeon_device *rdev) | 603 | static int radeon_hwmon_init(struct radeon_device *rdev) |
| 611 | { | 604 | { |
| 612 | int err = 0; | 605 | int err = 0; |
| 613 | 606 | struct device *hwmon_dev; | |
| 614 | rdev->pm.int_hwmon_dev = NULL; | ||
| 615 | 607 | ||
| 616 | switch (rdev->pm.int_thermal_type) { | 608 | switch (rdev->pm.int_thermal_type) { |
| 617 | case THERMAL_TYPE_RV6XX: | 609 | case THERMAL_TYPE_RV6XX: |
| @@ -624,20 +616,13 @@ static int radeon_hwmon_init(struct radeon_device *rdev) | |||
| 624 | case THERMAL_TYPE_KV: | 616 | case THERMAL_TYPE_KV: |
| 625 | if (rdev->asic->pm.get_temperature == NULL) | 617 | if (rdev->asic->pm.get_temperature == NULL) |
| 626 | return err; | 618 | return err; |
| 627 | rdev->pm.int_hwmon_dev = hwmon_device_register(rdev->dev); | 619 | hwmon_dev = hwmon_device_register_with_groups(rdev->dev, |
| 628 | if (IS_ERR(rdev->pm.int_hwmon_dev)) { | 620 | "radeon", rdev, |
| 629 | err = PTR_ERR(rdev->pm.int_hwmon_dev); | 621 | hwmon_groups); |
| 622 | if (IS_ERR(hwmon_dev)) { | ||
| 623 | err = PTR_ERR(hwmon_dev); | ||
| 630 | dev_err(rdev->dev, | 624 | dev_err(rdev->dev, |
| 631 | "Unable to register hwmon device: %d\n", err); | 625 | "Unable to register hwmon device: %d\n", err); |
| 632 | break; | ||
| 633 | } | ||
| 634 | dev_set_drvdata(rdev->pm.int_hwmon_dev, rdev->ddev); | ||
| 635 | err = sysfs_create_group(&rdev->pm.int_hwmon_dev->kobj, | ||
| 636 | &hwmon_attrgroup); | ||
| 637 | if (err) { | ||
| 638 | dev_err(rdev->dev, | ||
| 639 | "Unable to create hwmon sysfs file: %d\n", err); | ||
| 640 | hwmon_device_unregister(rdev->dev); | ||
| 641 | } | 626 | } |
| 642 | break; | 627 | break; |
| 643 | default: | 628 | default: |
| @@ -647,14 +632,6 @@ static int radeon_hwmon_init(struct radeon_device *rdev) | |||
| 647 | return err; | 632 | return err; |
| 648 | } | 633 | } |
| 649 | 634 | ||
| 650 | static void radeon_hwmon_fini(struct radeon_device *rdev) | ||
| 651 | { | ||
| 652 | if (rdev->pm.int_hwmon_dev) { | ||
| 653 | sysfs_remove_group(&rdev->pm.int_hwmon_dev->kobj, &hwmon_attrgroup); | ||
| 654 | hwmon_device_unregister(rdev->pm.int_hwmon_dev); | ||
| 655 | } | ||
| 656 | } | ||
| 657 | |||
| 658 | static void radeon_dpm_thermal_work_handler(struct work_struct *work) | 635 | static void radeon_dpm_thermal_work_handler(struct work_struct *work) |
| 659 | { | 636 | { |
| 660 | struct radeon_device *rdev = | 637 | struct radeon_device *rdev = |
| @@ -1337,8 +1314,6 @@ static void radeon_pm_fini_old(struct radeon_device *rdev) | |||
| 1337 | 1314 | ||
| 1338 | if (rdev->pm.power_state) | 1315 | if (rdev->pm.power_state) |
| 1339 | kfree(rdev->pm.power_state); | 1316 | kfree(rdev->pm.power_state); |
| 1340 | |||
| 1341 | radeon_hwmon_fini(rdev); | ||
| 1342 | } | 1317 | } |
| 1343 | 1318 | ||
| 1344 | static void radeon_pm_fini_dpm(struct radeon_device *rdev) | 1319 | static void radeon_pm_fini_dpm(struct radeon_device *rdev) |
| @@ -1358,8 +1333,6 @@ static void radeon_pm_fini_dpm(struct radeon_device *rdev) | |||
| 1358 | 1333 | ||
| 1359 | if (rdev->pm.power_state) | 1334 | if (rdev->pm.power_state) |
| 1360 | kfree(rdev->pm.power_state); | 1335 | kfree(rdev->pm.power_state); |
| 1361 | |||
| 1362 | radeon_hwmon_fini(rdev); | ||
| 1363 | } | 1336 | } |
| 1364 | 1337 | ||
| 1365 | void radeon_pm_fini(struct radeon_device *rdev) | 1338 | void radeon_pm_fini(struct radeon_device *rdev) |
diff --git a/drivers/gpu/drm/radeon/radeon_trace.h b/drivers/gpu/drm/radeon/radeon_trace.h index 9f0e18172b6e..0473257d4078 100644 --- a/drivers/gpu/drm/radeon/radeon_trace.h +++ b/drivers/gpu/drm/radeon/radeon_trace.h | |||
| @@ -47,6 +47,39 @@ TRACE_EVENT(radeon_cs, | |||
| 47 | __entry->fences) | 47 | __entry->fences) |
| 48 | ); | 48 | ); |
| 49 | 49 | ||
| 50 | TRACE_EVENT(radeon_vm_grab_id, | ||
| 51 | TP_PROTO(unsigned vmid, int ring), | ||
| 52 | TP_ARGS(vmid, ring), | ||
| 53 | TP_STRUCT__entry( | ||
| 54 | __field(u32, vmid) | ||
| 55 | __field(u32, ring) | ||
| 56 | ), | ||
| 57 | |||
| 58 | TP_fast_assign( | ||
| 59 | __entry->vmid = vmid; | ||
| 60 | __entry->ring = ring; | ||
| 61 | ), | ||
| 62 | TP_printk("vmid=%u, ring=%u", __entry->vmid, __entry->ring) | ||
| 63 | ); | ||
| 64 | |||
| 65 | TRACE_EVENT(radeon_vm_bo_update, | ||
| 66 | TP_PROTO(struct radeon_bo_va *bo_va), | ||
| 67 | TP_ARGS(bo_va), | ||
| 68 | TP_STRUCT__entry( | ||
| 69 | __field(u64, soffset) | ||
| 70 | __field(u64, eoffset) | ||
| 71 | __field(u32, flags) | ||
| 72 | ), | ||
| 73 | |||
| 74 | TP_fast_assign( | ||
| 75 | __entry->soffset = bo_va->soffset; | ||
| 76 | __entry->eoffset = bo_va->eoffset; | ||
| 77 | __entry->flags = bo_va->flags; | ||
| 78 | ), | ||
| 79 | TP_printk("soffs=%010llx, eoffs=%010llx, flags=%08x", | ||
| 80 | __entry->soffset, __entry->eoffset, __entry->flags) | ||
| 81 | ); | ||
| 82 | |||
| 50 | TRACE_EVENT(radeon_vm_set_page, | 83 | TRACE_EVENT(radeon_vm_set_page, |
| 51 | TP_PROTO(uint64_t pe, uint64_t addr, unsigned count, | 84 | TP_PROTO(uint64_t pe, uint64_t addr, unsigned count, |
| 52 | uint32_t incr, uint32_t flags), | 85 | uint32_t incr, uint32_t flags), |
diff --git a/drivers/gpu/drm/radeon/reg_srcs/cayman b/drivers/gpu/drm/radeon/reg_srcs/cayman index a072fa8c46b0..d46b58d078aa 100644 --- a/drivers/gpu/drm/radeon/reg_srcs/cayman +++ b/drivers/gpu/drm/radeon/reg_srcs/cayman | |||
| @@ -21,7 +21,7 @@ cayman 0x9400 | |||
| 21 | 0x000089AC VGT_COMPUTE_THREAD_GOURP_SIZE | 21 | 0x000089AC VGT_COMPUTE_THREAD_GOURP_SIZE |
| 22 | 0x000089B0 VGT_HS_OFFCHIP_PARAM | 22 | 0x000089B0 VGT_HS_OFFCHIP_PARAM |
| 23 | 0x00008A14 PA_CL_ENHANCE | 23 | 0x00008A14 PA_CL_ENHANCE |
| 24 | 0x00008A60 PA_SC_LINE_STIPPLE_VALUE | 24 | 0x00008A60 PA_SU_LINE_STIPPLE_VALUE |
| 25 | 0x00008B10 PA_SC_LINE_STIPPLE_STATE | 25 | 0x00008B10 PA_SC_LINE_STIPPLE_STATE |
| 26 | 0x00008BF0 PA_SC_ENHANCE | 26 | 0x00008BF0 PA_SC_ENHANCE |
| 27 | 0x00008D8C SQ_DYN_GPR_CNTL_PS_FLUSH_REQ | 27 | 0x00008D8C SQ_DYN_GPR_CNTL_PS_FLUSH_REQ |
| @@ -532,7 +532,7 @@ cayman 0x9400 | |||
| 532 | 0x00028B84 PA_SU_POLY_OFFSET_FRONT_OFFSET | 532 | 0x00028B84 PA_SU_POLY_OFFSET_FRONT_OFFSET |
| 533 | 0x00028B88 PA_SU_POLY_OFFSET_BACK_SCALE | 533 | 0x00028B88 PA_SU_POLY_OFFSET_BACK_SCALE |
| 534 | 0x00028B8C PA_SU_POLY_OFFSET_BACK_OFFSET | 534 | 0x00028B8C PA_SU_POLY_OFFSET_BACK_OFFSET |
| 535 | 0x00028B74 VGT_GS_INSTANCE_CNT | 535 | 0x00028B90 VGT_GS_INSTANCE_CNT |
| 536 | 0x00028BD4 PA_SC_CENTROID_PRIORITY_0 | 536 | 0x00028BD4 PA_SC_CENTROID_PRIORITY_0 |
| 537 | 0x00028BD8 PA_SC_CENTROID_PRIORITY_1 | 537 | 0x00028BD8 PA_SC_CENTROID_PRIORITY_1 |
| 538 | 0x00028BDC PA_SC_LINE_CNTL | 538 | 0x00028BDC PA_SC_LINE_CNTL |
diff --git a/drivers/gpu/drm/radeon/reg_srcs/evergreen b/drivers/gpu/drm/radeon/reg_srcs/evergreen index b912a37689bf..57745c8761c8 100644 --- a/drivers/gpu/drm/radeon/reg_srcs/evergreen +++ b/drivers/gpu/drm/radeon/reg_srcs/evergreen | |||
| @@ -22,7 +22,7 @@ evergreen 0x9400 | |||
| 22 | 0x000089A4 VGT_COMPUTE_START_Z | 22 | 0x000089A4 VGT_COMPUTE_START_Z |
| 23 | 0x000089AC VGT_COMPUTE_THREAD_GOURP_SIZE | 23 | 0x000089AC VGT_COMPUTE_THREAD_GOURP_SIZE |
| 24 | 0x00008A14 PA_CL_ENHANCE | 24 | 0x00008A14 PA_CL_ENHANCE |
| 25 | 0x00008A60 PA_SC_LINE_STIPPLE_VALUE | 25 | 0x00008A60 PA_SU_LINE_STIPPLE_VALUE |
| 26 | 0x00008B10 PA_SC_LINE_STIPPLE_STATE | 26 | 0x00008B10 PA_SC_LINE_STIPPLE_STATE |
| 27 | 0x00008BF0 PA_SC_ENHANCE | 27 | 0x00008BF0 PA_SC_ENHANCE |
| 28 | 0x00008D8C SQ_DYN_GPR_CNTL_PS_FLUSH_REQ | 28 | 0x00008D8C SQ_DYN_GPR_CNTL_PS_FLUSH_REQ |
| @@ -545,7 +545,7 @@ evergreen 0x9400 | |||
| 545 | 0x00028B84 PA_SU_POLY_OFFSET_FRONT_OFFSET | 545 | 0x00028B84 PA_SU_POLY_OFFSET_FRONT_OFFSET |
| 546 | 0x00028B88 PA_SU_POLY_OFFSET_BACK_SCALE | 546 | 0x00028B88 PA_SU_POLY_OFFSET_BACK_SCALE |
| 547 | 0x00028B8C PA_SU_POLY_OFFSET_BACK_OFFSET | 547 | 0x00028B8C PA_SU_POLY_OFFSET_BACK_OFFSET |
| 548 | 0x00028B74 VGT_GS_INSTANCE_CNT | 548 | 0x00028B90 VGT_GS_INSTANCE_CNT |
| 549 | 0x00028C00 PA_SC_LINE_CNTL | 549 | 0x00028C00 PA_SC_LINE_CNTL |
| 550 | 0x00028C08 PA_SU_VTX_CNTL | 550 | 0x00028C08 PA_SU_VTX_CNTL |
| 551 | 0x00028C0C PA_CL_GB_VERT_CLIP_ADJ | 551 | 0x00028C0C PA_CL_GB_VERT_CLIP_ADJ |
diff --git a/drivers/gpu/drm/radeon/si.c b/drivers/gpu/drm/radeon/si.c index 6a64ccaa0695..a36736dab5e0 100644 --- a/drivers/gpu/drm/radeon/si.c +++ b/drivers/gpu/drm/radeon/si.c | |||
| @@ -3882,8 +3882,15 @@ static int si_mc_init(struct radeon_device *rdev) | |||
| 3882 | rdev->mc.aper_base = pci_resource_start(rdev->pdev, 0); | 3882 | rdev->mc.aper_base = pci_resource_start(rdev->pdev, 0); |
| 3883 | rdev->mc.aper_size = pci_resource_len(rdev->pdev, 0); | 3883 | rdev->mc.aper_size = pci_resource_len(rdev->pdev, 0); |
| 3884 | /* size in MB on si */ | 3884 | /* size in MB on si */ |
| 3885 | rdev->mc.mc_vram_size = RREG32(CONFIG_MEMSIZE) * 1024ULL * 1024ULL; | 3885 | tmp = RREG32(CONFIG_MEMSIZE); |
| 3886 | rdev->mc.real_vram_size = RREG32(CONFIG_MEMSIZE) * 1024ULL * 1024ULL; | 3886 | /* some boards may have garbage in the upper 16 bits */ |
| 3887 | if (tmp & 0xffff0000) { | ||
| 3888 | DRM_INFO("Probable bad vram size: 0x%08x\n", tmp); | ||
| 3889 | if (tmp & 0xffff) | ||
| 3890 | tmp &= 0xffff; | ||
| 3891 | } | ||
| 3892 | rdev->mc.mc_vram_size = tmp * 1024ULL * 1024ULL; | ||
| 3893 | rdev->mc.real_vram_size = rdev->mc.mc_vram_size; | ||
| 3887 | rdev->mc.visible_vram_size = rdev->mc.aper_size; | 3894 | rdev->mc.visible_vram_size = rdev->mc.aper_size; |
| 3888 | si_vram_gtt_location(rdev, &rdev->mc); | 3895 | si_vram_gtt_location(rdev, &rdev->mc); |
| 3889 | radeon_update_bandwidth_info(rdev); | 3896 | radeon_update_bandwidth_info(rdev); |
diff --git a/drivers/gpu/drm/tegra/drm.c b/drivers/gpu/drm/tegra/drm.c index 28e178137718..07eba596d458 100644 --- a/drivers/gpu/drm/tegra/drm.c +++ b/drivers/gpu/drm/tegra/drm.c | |||
| @@ -135,11 +135,11 @@ int tegra_drm_submit(struct tegra_drm_context *context, | |||
| 135 | unsigned int num_relocs = args->num_relocs; | 135 | unsigned int num_relocs = args->num_relocs; |
| 136 | unsigned int num_waitchks = args->num_waitchks; | 136 | unsigned int num_waitchks = args->num_waitchks; |
| 137 | struct drm_tegra_cmdbuf __user *cmdbufs = | 137 | struct drm_tegra_cmdbuf __user *cmdbufs = |
| 138 | (void * __user)(uintptr_t)args->cmdbufs; | 138 | (void __user *)(uintptr_t)args->cmdbufs; |
| 139 | struct drm_tegra_reloc __user *relocs = | 139 | struct drm_tegra_reloc __user *relocs = |
| 140 | (void * __user)(uintptr_t)args->relocs; | 140 | (void __user *)(uintptr_t)args->relocs; |
| 141 | struct drm_tegra_waitchk __user *waitchks = | 141 | struct drm_tegra_waitchk __user *waitchks = |
| 142 | (void * __user)(uintptr_t)args->waitchks; | 142 | (void __user *)(uintptr_t)args->waitchks; |
| 143 | struct drm_tegra_syncpt syncpt; | 143 | struct drm_tegra_syncpt syncpt; |
| 144 | struct host1x_job *job; | 144 | struct host1x_job *job; |
| 145 | int err; | 145 | int err; |
| @@ -163,9 +163,10 @@ int tegra_drm_submit(struct tegra_drm_context *context, | |||
| 163 | struct drm_tegra_cmdbuf cmdbuf; | 163 | struct drm_tegra_cmdbuf cmdbuf; |
| 164 | struct host1x_bo *bo; | 164 | struct host1x_bo *bo; |
| 165 | 165 | ||
| 166 | err = copy_from_user(&cmdbuf, cmdbufs, sizeof(cmdbuf)); | 166 | if (copy_from_user(&cmdbuf, cmdbufs, sizeof(cmdbuf))) { |
| 167 | if (err) | 167 | err = -EFAULT; |
| 168 | goto fail; | 168 | goto fail; |
| 169 | } | ||
| 169 | 170 | ||
| 170 | bo = host1x_bo_lookup(drm, file, cmdbuf.handle); | 171 | bo = host1x_bo_lookup(drm, file, cmdbuf.handle); |
| 171 | if (!bo) { | 172 | if (!bo) { |
| @@ -178,10 +179,11 @@ int tegra_drm_submit(struct tegra_drm_context *context, | |||
| 178 | cmdbufs++; | 179 | cmdbufs++; |
| 179 | } | 180 | } |
| 180 | 181 | ||
| 181 | err = copy_from_user(job->relocarray, relocs, | 182 | if (copy_from_user(job->relocarray, relocs, |
| 182 | sizeof(*relocs) * num_relocs); | 183 | sizeof(*relocs) * num_relocs)) { |
| 183 | if (err) | 184 | err = -EFAULT; |
| 184 | goto fail; | 185 | goto fail; |
| 186 | } | ||
| 185 | 187 | ||
| 186 | while (num_relocs--) { | 188 | while (num_relocs--) { |
| 187 | struct host1x_reloc *reloc = &job->relocarray[num_relocs]; | 189 | struct host1x_reloc *reloc = &job->relocarray[num_relocs]; |
| @@ -199,15 +201,17 @@ int tegra_drm_submit(struct tegra_drm_context *context, | |||
| 199 | } | 201 | } |
| 200 | } | 202 | } |
| 201 | 203 | ||
| 202 | err = copy_from_user(job->waitchk, waitchks, | 204 | if (copy_from_user(job->waitchk, waitchks, |
| 203 | sizeof(*waitchks) * num_waitchks); | 205 | sizeof(*waitchks) * num_waitchks)) { |
| 204 | if (err) | 206 | err = -EFAULT; |
| 205 | goto fail; | 207 | goto fail; |
| 208 | } | ||
| 206 | 209 | ||
| 207 | err = copy_from_user(&syncpt, (void * __user)(uintptr_t)args->syncpts, | 210 | if (copy_from_user(&syncpt, (void __user *)(uintptr_t)args->syncpts, |
| 208 | sizeof(syncpt)); | 211 | sizeof(syncpt))) { |
| 209 | if (err) | 212 | err = -EFAULT; |
| 210 | goto fail; | 213 | goto fail; |
| 214 | } | ||
| 211 | 215 | ||
| 212 | job->is_addr_reg = context->client->ops->is_addr_reg; | 216 | job->is_addr_reg = context->client->ops->is_addr_reg; |
| 213 | job->syncpt_incrs = syncpt.incrs; | 217 | job->syncpt_incrs = syncpt.incrs; |
| @@ -573,7 +577,7 @@ static void tegra_debugfs_cleanup(struct drm_minor *minor) | |||
| 573 | } | 577 | } |
| 574 | #endif | 578 | #endif |
| 575 | 579 | ||
| 576 | struct drm_driver tegra_drm_driver = { | 580 | static struct drm_driver tegra_drm_driver = { |
| 577 | .driver_features = DRIVER_MODESET | DRIVER_GEM, | 581 | .driver_features = DRIVER_MODESET | DRIVER_GEM, |
| 578 | .load = tegra_drm_load, | 582 | .load = tegra_drm_load, |
| 579 | .unload = tegra_drm_unload, | 583 | .unload = tegra_drm_unload, |
diff --git a/drivers/gpu/drm/tegra/drm.h b/drivers/gpu/drm/tegra/drm.h index fdfe259ed7f8..7da0b923131f 100644 --- a/drivers/gpu/drm/tegra/drm.h +++ b/drivers/gpu/drm/tegra/drm.h | |||
| @@ -116,7 +116,7 @@ host1x_client_to_dc(struct host1x_client *client) | |||
| 116 | 116 | ||
| 117 | static inline struct tegra_dc *to_tegra_dc(struct drm_crtc *crtc) | 117 | static inline struct tegra_dc *to_tegra_dc(struct drm_crtc *crtc) |
| 118 | { | 118 | { |
| 119 | return container_of(crtc, struct tegra_dc, base); | 119 | return crtc ? container_of(crtc, struct tegra_dc, base) : NULL; |
| 120 | } | 120 | } |
| 121 | 121 | ||
| 122 | static inline void tegra_dc_writel(struct tegra_dc *dc, unsigned long value, | 122 | static inline void tegra_dc_writel(struct tegra_dc *dc, unsigned long value, |
diff --git a/drivers/gpu/drm/tegra/fb.c b/drivers/gpu/drm/tegra/fb.c index 490f7719e317..a3835e7de184 100644 --- a/drivers/gpu/drm/tegra/fb.c +++ b/drivers/gpu/drm/tegra/fb.c | |||
| @@ -247,7 +247,7 @@ static int tegra_fbdev_probe(struct drm_fb_helper *helper, | |||
| 247 | info->var.yoffset * fb->pitches[0]; | 247 | info->var.yoffset * fb->pitches[0]; |
| 248 | 248 | ||
| 249 | drm->mode_config.fb_base = (resource_size_t)bo->paddr; | 249 | drm->mode_config.fb_base = (resource_size_t)bo->paddr; |
| 250 | info->screen_base = bo->vaddr + offset; | 250 | info->screen_base = (void __iomem *)bo->vaddr + offset; |
| 251 | info->screen_size = size; | 251 | info->screen_size = size; |
| 252 | info->fix.smem_start = (unsigned long)(bo->paddr + offset); | 252 | info->fix.smem_start = (unsigned long)(bo->paddr + offset); |
| 253 | info->fix.smem_len = size; | 253 | info->fix.smem_len = size; |
diff --git a/drivers/gpu/drm/tegra/rgb.c b/drivers/gpu/drm/tegra/rgb.c index ba47ca4fb880..3b29018913a5 100644 --- a/drivers/gpu/drm/tegra/rgb.c +++ b/drivers/gpu/drm/tegra/rgb.c | |||
| @@ -14,6 +14,8 @@ | |||
| 14 | 14 | ||
| 15 | struct tegra_rgb { | 15 | struct tegra_rgb { |
| 16 | struct tegra_output output; | 16 | struct tegra_output output; |
| 17 | struct tegra_dc *dc; | ||
| 18 | |||
| 17 | struct clk *clk_parent; | 19 | struct clk *clk_parent; |
| 18 | struct clk *clk; | 20 | struct clk *clk; |
| 19 | }; | 21 | }; |
| @@ -84,18 +86,18 @@ static void tegra_dc_write_regs(struct tegra_dc *dc, | |||
| 84 | 86 | ||
| 85 | static int tegra_output_rgb_enable(struct tegra_output *output) | 87 | static int tegra_output_rgb_enable(struct tegra_output *output) |
| 86 | { | 88 | { |
| 87 | struct tegra_dc *dc = to_tegra_dc(output->encoder.crtc); | 89 | struct tegra_rgb *rgb = to_rgb(output); |
| 88 | 90 | ||
| 89 | tegra_dc_write_regs(dc, rgb_enable, ARRAY_SIZE(rgb_enable)); | 91 | tegra_dc_write_regs(rgb->dc, rgb_enable, ARRAY_SIZE(rgb_enable)); |
| 90 | 92 | ||
| 91 | return 0; | 93 | return 0; |
| 92 | } | 94 | } |
| 93 | 95 | ||
| 94 | static int tegra_output_rgb_disable(struct tegra_output *output) | 96 | static int tegra_output_rgb_disable(struct tegra_output *output) |
| 95 | { | 97 | { |
| 96 | struct tegra_dc *dc = to_tegra_dc(output->encoder.crtc); | 98 | struct tegra_rgb *rgb = to_rgb(output); |
| 97 | 99 | ||
| 98 | tegra_dc_write_regs(dc, rgb_disable, ARRAY_SIZE(rgb_disable)); | 100 | tegra_dc_write_regs(rgb->dc, rgb_disable, ARRAY_SIZE(rgb_disable)); |
| 99 | 101 | ||
| 100 | return 0; | 102 | return 0; |
| 101 | } | 103 | } |
| @@ -146,6 +148,7 @@ int tegra_dc_rgb_probe(struct tegra_dc *dc) | |||
| 146 | 148 | ||
| 147 | rgb->output.dev = dc->dev; | 149 | rgb->output.dev = dc->dev; |
| 148 | rgb->output.of_node = np; | 150 | rgb->output.of_node = np; |
| 151 | rgb->dc = dc; | ||
| 149 | 152 | ||
| 150 | err = tegra_output_probe(&rgb->output); | 153 | err = tegra_output_probe(&rgb->output); |
| 151 | if (err < 0) | 154 | if (err < 0) |
diff --git a/drivers/gpu/drm/udl/udl_gem.c b/drivers/gpu/drm/udl/udl_gem.c index 24ffbe990736..8d67b943ac05 100644 --- a/drivers/gpu/drm/udl/udl_gem.c +++ b/drivers/gpu/drm/udl/udl_gem.c | |||
| @@ -125,6 +125,12 @@ static int udl_gem_get_pages(struct udl_gem_object *obj, gfp_t gfpmask) | |||
| 125 | 125 | ||
| 126 | static void udl_gem_put_pages(struct udl_gem_object *obj) | 126 | static void udl_gem_put_pages(struct udl_gem_object *obj) |
| 127 | { | 127 | { |
| 128 | if (obj->base.import_attach) { | ||
| 129 | drm_free_large(obj->pages); | ||
| 130 | obj->pages = NULL; | ||
| 131 | return; | ||
| 132 | } | ||
| 133 | |||
| 128 | drm_gem_put_pages(&obj->base, obj->pages, false, false); | 134 | drm_gem_put_pages(&obj->base, obj->pages, false, false); |
| 129 | obj->pages = NULL; | 135 | obj->pages = NULL; |
| 130 | } | 136 | } |
diff --git a/drivers/gpu/drm/vmwgfx/vmwgfx_buffer.c b/drivers/gpu/drm/vmwgfx/vmwgfx_buffer.c index 7776e6f0aef6..0489c6152482 100644 --- a/drivers/gpu/drm/vmwgfx/vmwgfx_buffer.c +++ b/drivers/gpu/drm/vmwgfx/vmwgfx_buffer.c | |||
| @@ -150,6 +150,8 @@ struct vmw_ttm_tt { | |||
| 150 | bool mapped; | 150 | bool mapped; |
| 151 | }; | 151 | }; |
| 152 | 152 | ||
| 153 | const size_t vmw_tt_size = sizeof(struct vmw_ttm_tt); | ||
| 154 | |||
| 153 | /** | 155 | /** |
| 154 | * Helper functions to advance a struct vmw_piter iterator. | 156 | * Helper functions to advance a struct vmw_piter iterator. |
| 155 | * | 157 | * |
diff --git a/drivers/gpu/drm/vmwgfx/vmwgfx_drv.h b/drivers/gpu/drm/vmwgfx/vmwgfx_drv.h index db85985c7086..20890ad8408b 100644 --- a/drivers/gpu/drm/vmwgfx/vmwgfx_drv.h +++ b/drivers/gpu/drm/vmwgfx/vmwgfx_drv.h | |||
| @@ -615,6 +615,7 @@ extern int vmw_mmap(struct file *filp, struct vm_area_struct *vma); | |||
| 615 | * TTM buffer object driver - vmwgfx_buffer.c | 615 | * TTM buffer object driver - vmwgfx_buffer.c |
| 616 | */ | 616 | */ |
| 617 | 617 | ||
| 618 | extern const size_t vmw_tt_size; | ||
| 618 | extern struct ttm_placement vmw_vram_placement; | 619 | extern struct ttm_placement vmw_vram_placement; |
| 619 | extern struct ttm_placement vmw_vram_ne_placement; | 620 | extern struct ttm_placement vmw_vram_ne_placement; |
| 620 | extern struct ttm_placement vmw_vram_sys_placement; | 621 | extern struct ttm_placement vmw_vram_sys_placement; |
diff --git a/drivers/gpu/drm/vmwgfx/vmwgfx_kms.c b/drivers/gpu/drm/vmwgfx/vmwgfx_kms.c index ecb3d867b426..03f1c2038631 100644 --- a/drivers/gpu/drm/vmwgfx/vmwgfx_kms.c +++ b/drivers/gpu/drm/vmwgfx/vmwgfx_kms.c | |||
| @@ -75,6 +75,7 @@ void vmw_display_unit_cleanup(struct vmw_display_unit *du) | |||
| 75 | vmw_surface_unreference(&du->cursor_surface); | 75 | vmw_surface_unreference(&du->cursor_surface); |
| 76 | if (du->cursor_dmabuf) | 76 | if (du->cursor_dmabuf) |
| 77 | vmw_dmabuf_unreference(&du->cursor_dmabuf); | 77 | vmw_dmabuf_unreference(&du->cursor_dmabuf); |
| 78 | drm_sysfs_connector_remove(&du->connector); | ||
| 78 | drm_crtc_cleanup(&du->crtc); | 79 | drm_crtc_cleanup(&du->crtc); |
| 79 | drm_encoder_cleanup(&du->encoder); | 80 | drm_encoder_cleanup(&du->encoder); |
| 80 | drm_connector_cleanup(&du->connector); | 81 | drm_connector_cleanup(&du->connector); |
diff --git a/drivers/gpu/drm/vmwgfx/vmwgfx_ldu.c b/drivers/gpu/drm/vmwgfx/vmwgfx_ldu.c index 79f7e8e60529..a055a26819c2 100644 --- a/drivers/gpu/drm/vmwgfx/vmwgfx_ldu.c +++ b/drivers/gpu/drm/vmwgfx/vmwgfx_ldu.c | |||
| @@ -260,6 +260,7 @@ static int vmw_ldu_crtc_set_config(struct drm_mode_set *set) | |||
| 260 | connector->encoder = NULL; | 260 | connector->encoder = NULL; |
| 261 | encoder->crtc = NULL; | 261 | encoder->crtc = NULL; |
| 262 | crtc->fb = NULL; | 262 | crtc->fb = NULL; |
| 263 | crtc->enabled = false; | ||
| 263 | 264 | ||
| 264 | vmw_ldu_del_active(dev_priv, ldu); | 265 | vmw_ldu_del_active(dev_priv, ldu); |
| 265 | 266 | ||
| @@ -285,6 +286,7 @@ static int vmw_ldu_crtc_set_config(struct drm_mode_set *set) | |||
| 285 | crtc->x = set->x; | 286 | crtc->x = set->x; |
| 286 | crtc->y = set->y; | 287 | crtc->y = set->y; |
| 287 | crtc->mode = *mode; | 288 | crtc->mode = *mode; |
| 289 | crtc->enabled = true; | ||
| 288 | 290 | ||
| 289 | vmw_ldu_add_active(dev_priv, ldu, vfb); | 291 | vmw_ldu_add_active(dev_priv, ldu, vfb); |
| 290 | 292 | ||
| @@ -369,6 +371,8 @@ static int vmw_ldu_init(struct vmw_private *dev_priv, unsigned unit) | |||
| 369 | encoder->possible_crtcs = (1 << unit); | 371 | encoder->possible_crtcs = (1 << unit); |
| 370 | encoder->possible_clones = 0; | 372 | encoder->possible_clones = 0; |
| 371 | 373 | ||
| 374 | (void) drm_sysfs_connector_add(connector); | ||
| 375 | |||
| 372 | drm_crtc_init(dev, crtc, &vmw_legacy_crtc_funcs); | 376 | drm_crtc_init(dev, crtc, &vmw_legacy_crtc_funcs); |
| 373 | 377 | ||
| 374 | drm_mode_crtc_set_gamma_size(crtc, 256); | 378 | drm_mode_crtc_set_gamma_size(crtc, 256); |
diff --git a/drivers/gpu/drm/vmwgfx/vmwgfx_resource.c b/drivers/gpu/drm/vmwgfx/vmwgfx_resource.c index efe2b74c5eb1..9b5ea2ac7ddf 100644 --- a/drivers/gpu/drm/vmwgfx/vmwgfx_resource.c +++ b/drivers/gpu/drm/vmwgfx/vmwgfx_resource.c | |||
| @@ -352,6 +352,38 @@ int vmw_user_lookup_handle(struct vmw_private *dev_priv, | |||
| 352 | /** | 352 | /** |
| 353 | * Buffer management. | 353 | * Buffer management. |
| 354 | */ | 354 | */ |
| 355 | |||
| 356 | /** | ||
| 357 | * vmw_dmabuf_acc_size - Calculate the pinned memory usage of buffers | ||
| 358 | * | ||
| 359 | * @dev_priv: Pointer to a struct vmw_private identifying the device. | ||
| 360 | * @size: The requested buffer size. | ||
| 361 | * @user: Whether this is an ordinary dma buffer or a user dma buffer. | ||
| 362 | */ | ||
| 363 | static size_t vmw_dmabuf_acc_size(struct vmw_private *dev_priv, size_t size, | ||
| 364 | bool user) | ||
| 365 | { | ||
| 366 | static size_t struct_size, user_struct_size; | ||
| 367 | size_t num_pages = PAGE_ALIGN(size) >> PAGE_SHIFT; | ||
| 368 | size_t page_array_size = ttm_round_pot(num_pages * sizeof(void *)); | ||
| 369 | |||
| 370 | if (unlikely(struct_size == 0)) { | ||
| 371 | size_t backend_size = ttm_round_pot(vmw_tt_size); | ||
| 372 | |||
| 373 | struct_size = backend_size + | ||
| 374 | ttm_round_pot(sizeof(struct vmw_dma_buffer)); | ||
| 375 | user_struct_size = backend_size + | ||
| 376 | ttm_round_pot(sizeof(struct vmw_user_dma_buffer)); | ||
| 377 | } | ||
| 378 | |||
| 379 | if (dev_priv->map_mode == vmw_dma_alloc_coherent) | ||
| 380 | page_array_size += | ||
| 381 | ttm_round_pot(num_pages * sizeof(dma_addr_t)); | ||
| 382 | |||
| 383 | return ((user) ? user_struct_size : struct_size) + | ||
| 384 | page_array_size; | ||
| 385 | } | ||
| 386 | |||
| 355 | void vmw_dmabuf_bo_free(struct ttm_buffer_object *bo) | 387 | void vmw_dmabuf_bo_free(struct ttm_buffer_object *bo) |
| 356 | { | 388 | { |
| 357 | struct vmw_dma_buffer *vmw_bo = vmw_dma_buffer(bo); | 389 | struct vmw_dma_buffer *vmw_bo = vmw_dma_buffer(bo); |
| @@ -359,6 +391,13 @@ void vmw_dmabuf_bo_free(struct ttm_buffer_object *bo) | |||
| 359 | kfree(vmw_bo); | 391 | kfree(vmw_bo); |
| 360 | } | 392 | } |
| 361 | 393 | ||
| 394 | static void vmw_user_dmabuf_destroy(struct ttm_buffer_object *bo) | ||
| 395 | { | ||
| 396 | struct vmw_user_dma_buffer *vmw_user_bo = vmw_user_dma_buffer(bo); | ||
| 397 | |||
| 398 | ttm_prime_object_kfree(vmw_user_bo, prime); | ||
| 399 | } | ||
| 400 | |||
| 362 | int vmw_dmabuf_init(struct vmw_private *dev_priv, | 401 | int vmw_dmabuf_init(struct vmw_private *dev_priv, |
| 363 | struct vmw_dma_buffer *vmw_bo, | 402 | struct vmw_dma_buffer *vmw_bo, |
| 364 | size_t size, struct ttm_placement *placement, | 403 | size_t size, struct ttm_placement *placement, |
| @@ -368,28 +407,23 @@ int vmw_dmabuf_init(struct vmw_private *dev_priv, | |||
| 368 | struct ttm_bo_device *bdev = &dev_priv->bdev; | 407 | struct ttm_bo_device *bdev = &dev_priv->bdev; |
| 369 | size_t acc_size; | 408 | size_t acc_size; |
| 370 | int ret; | 409 | int ret; |
| 410 | bool user = (bo_free == &vmw_user_dmabuf_destroy); | ||
| 371 | 411 | ||
| 372 | BUG_ON(!bo_free); | 412 | BUG_ON(!bo_free && (!user && (bo_free != vmw_dmabuf_bo_free))); |
| 373 | 413 | ||
| 374 | acc_size = ttm_bo_acc_size(bdev, size, sizeof(struct vmw_dma_buffer)); | 414 | acc_size = vmw_dmabuf_acc_size(dev_priv, size, user); |
| 375 | memset(vmw_bo, 0, sizeof(*vmw_bo)); | 415 | memset(vmw_bo, 0, sizeof(*vmw_bo)); |
| 376 | 416 | ||
| 377 | INIT_LIST_HEAD(&vmw_bo->res_list); | 417 | INIT_LIST_HEAD(&vmw_bo->res_list); |
| 378 | 418 | ||
| 379 | ret = ttm_bo_init(bdev, &vmw_bo->base, size, | 419 | ret = ttm_bo_init(bdev, &vmw_bo->base, size, |
| 380 | ttm_bo_type_device, placement, | 420 | (user) ? ttm_bo_type_device : |
| 421 | ttm_bo_type_kernel, placement, | ||
| 381 | 0, interruptible, | 422 | 0, interruptible, |
| 382 | NULL, acc_size, NULL, bo_free); | 423 | NULL, acc_size, NULL, bo_free); |
| 383 | return ret; | 424 | return ret; |
| 384 | } | 425 | } |
| 385 | 426 | ||
| 386 | static void vmw_user_dmabuf_destroy(struct ttm_buffer_object *bo) | ||
| 387 | { | ||
| 388 | struct vmw_user_dma_buffer *vmw_user_bo = vmw_user_dma_buffer(bo); | ||
| 389 | |||
| 390 | ttm_prime_object_kfree(vmw_user_bo, prime); | ||
| 391 | } | ||
| 392 | |||
| 393 | static void vmw_user_dmabuf_release(struct ttm_base_object **p_base) | 427 | static void vmw_user_dmabuf_release(struct ttm_base_object **p_base) |
| 394 | { | 428 | { |
| 395 | struct vmw_user_dma_buffer *vmw_user_bo; | 429 | struct vmw_user_dma_buffer *vmw_user_bo; |
| @@ -781,54 +815,55 @@ err_ref: | |||
| 781 | } | 815 | } |
| 782 | 816 | ||
| 783 | 817 | ||
| 818 | /** | ||
| 819 | * vmw_dumb_create - Create a dumb kms buffer | ||
| 820 | * | ||
| 821 | * @file_priv: Pointer to a struct drm_file identifying the caller. | ||
| 822 | * @dev: Pointer to the drm device. | ||
| 823 | * @args: Pointer to a struct drm_mode_create_dumb structure | ||
| 824 | * | ||
| 825 | * This is a driver callback for the core drm create_dumb functionality. | ||
| 826 | * Note that this is very similar to the vmw_dmabuf_alloc ioctl, except | ||
| 827 | * that the arguments have a different format. | ||
| 828 | */ | ||
| 784 | int vmw_dumb_create(struct drm_file *file_priv, | 829 | int vmw_dumb_create(struct drm_file *file_priv, |
| 785 | struct drm_device *dev, | 830 | struct drm_device *dev, |
| 786 | struct drm_mode_create_dumb *args) | 831 | struct drm_mode_create_dumb *args) |
| 787 | { | 832 | { |
| 788 | struct vmw_private *dev_priv = vmw_priv(dev); | 833 | struct vmw_private *dev_priv = vmw_priv(dev); |
| 789 | struct vmw_master *vmaster = vmw_master(file_priv->master); | 834 | struct vmw_master *vmaster = vmw_master(file_priv->master); |
| 790 | struct vmw_user_dma_buffer *vmw_user_bo; | 835 | struct vmw_dma_buffer *dma_buf; |
| 791 | struct ttm_buffer_object *tmp; | ||
| 792 | int ret; | 836 | int ret; |
| 793 | 837 | ||
| 794 | args->pitch = args->width * ((args->bpp + 7) / 8); | 838 | args->pitch = args->width * ((args->bpp + 7) / 8); |
| 795 | args->size = args->pitch * args->height; | 839 | args->size = args->pitch * args->height; |
| 796 | 840 | ||
| 797 | vmw_user_bo = kzalloc(sizeof(*vmw_user_bo), GFP_KERNEL); | ||
| 798 | if (vmw_user_bo == NULL) | ||
| 799 | return -ENOMEM; | ||
| 800 | |||
| 801 | ret = ttm_read_lock(&vmaster->lock, true); | 841 | ret = ttm_read_lock(&vmaster->lock, true); |
| 802 | if (ret != 0) { | 842 | if (unlikely(ret != 0)) |
| 803 | kfree(vmw_user_bo); | ||
| 804 | return ret; | 843 | return ret; |
| 805 | } | ||
| 806 | 844 | ||
| 807 | ret = vmw_dmabuf_init(dev_priv, &vmw_user_bo->dma, args->size, | 845 | ret = vmw_user_dmabuf_alloc(dev_priv, vmw_fpriv(file_priv)->tfile, |
| 808 | &vmw_vram_sys_placement, true, | 846 | args->size, false, &args->handle, |
| 809 | &vmw_user_dmabuf_destroy); | 847 | &dma_buf); |
| 810 | if (ret != 0) | ||
| 811 | goto out_no_dmabuf; | ||
| 812 | |||
| 813 | tmp = ttm_bo_reference(&vmw_user_bo->dma.base); | ||
| 814 | ret = ttm_prime_object_init(vmw_fpriv(file_priv)->tfile, | ||
| 815 | args->size, | ||
| 816 | &vmw_user_bo->prime, | ||
| 817 | false, | ||
| 818 | ttm_buffer_type, | ||
| 819 | &vmw_user_dmabuf_release, NULL); | ||
| 820 | if (unlikely(ret != 0)) | 848 | if (unlikely(ret != 0)) |
| 821 | goto out_no_base_object; | 849 | goto out_no_dmabuf; |
| 822 | |||
| 823 | args->handle = vmw_user_bo->prime.base.hash.key; | ||
| 824 | 850 | ||
| 825 | out_no_base_object: | 851 | vmw_dmabuf_unreference(&dma_buf); |
| 826 | ttm_bo_unref(&tmp); | ||
| 827 | out_no_dmabuf: | 852 | out_no_dmabuf: |
| 828 | ttm_read_unlock(&vmaster->lock); | 853 | ttm_read_unlock(&vmaster->lock); |
| 829 | return ret; | 854 | return ret; |
| 830 | } | 855 | } |
| 831 | 856 | ||
| 857 | /** | ||
| 858 | * vmw_dumb_map_offset - Return the address space offset of a dumb buffer | ||
| 859 | * | ||
| 860 | * @file_priv: Pointer to a struct drm_file identifying the caller. | ||
| 861 | * @dev: Pointer to the drm device. | ||
| 862 | * @handle: Handle identifying the dumb buffer. | ||
| 863 | * @offset: The address space offset returned. | ||
| 864 | * | ||
| 865 | * This is a driver callback for the core drm dumb_map_offset functionality. | ||
| 866 | */ | ||
| 832 | int vmw_dumb_map_offset(struct drm_file *file_priv, | 867 | int vmw_dumb_map_offset(struct drm_file *file_priv, |
| 833 | struct drm_device *dev, uint32_t handle, | 868 | struct drm_device *dev, uint32_t handle, |
| 834 | uint64_t *offset) | 869 | uint64_t *offset) |
| @@ -846,6 +881,15 @@ int vmw_dumb_map_offset(struct drm_file *file_priv, | |||
| 846 | return 0; | 881 | return 0; |
| 847 | } | 882 | } |
| 848 | 883 | ||
| 884 | /** | ||
| 885 | * vmw_dumb_destroy - Destroy a dumb boffer | ||
| 886 | * | ||
| 887 | * @file_priv: Pointer to a struct drm_file identifying the caller. | ||
| 888 | * @dev: Pointer to the drm device. | ||
| 889 | * @handle: Handle identifying the dumb buffer. | ||
| 890 | * | ||
| 891 | * This is a driver callback for the core drm dumb_destroy functionality. | ||
| 892 | */ | ||
| 849 | int vmw_dumb_destroy(struct drm_file *file_priv, | 893 | int vmw_dumb_destroy(struct drm_file *file_priv, |
| 850 | struct drm_device *dev, | 894 | struct drm_device *dev, |
| 851 | uint32_t handle) | 895 | uint32_t handle) |
diff --git a/drivers/gpu/drm/vmwgfx/vmwgfx_scrn.c b/drivers/gpu/drm/vmwgfx/vmwgfx_scrn.c index 26387c3d5a21..22406c8651ea 100644 --- a/drivers/gpu/drm/vmwgfx/vmwgfx_scrn.c +++ b/drivers/gpu/drm/vmwgfx/vmwgfx_scrn.c | |||
| @@ -310,6 +310,7 @@ static int vmw_sou_crtc_set_config(struct drm_mode_set *set) | |||
| 310 | crtc->fb = NULL; | 310 | crtc->fb = NULL; |
| 311 | crtc->x = 0; | 311 | crtc->x = 0; |
| 312 | crtc->y = 0; | 312 | crtc->y = 0; |
| 313 | crtc->enabled = false; | ||
| 313 | 314 | ||
| 314 | vmw_sou_del_active(dev_priv, sou); | 315 | vmw_sou_del_active(dev_priv, sou); |
| 315 | 316 | ||
| @@ -370,6 +371,7 @@ static int vmw_sou_crtc_set_config(struct drm_mode_set *set) | |||
| 370 | crtc->fb = NULL; | 371 | crtc->fb = NULL; |
| 371 | crtc->x = 0; | 372 | crtc->x = 0; |
| 372 | crtc->y = 0; | 373 | crtc->y = 0; |
| 374 | crtc->enabled = false; | ||
| 373 | 375 | ||
| 374 | return ret; | 376 | return ret; |
| 375 | } | 377 | } |
| @@ -382,6 +384,7 @@ static int vmw_sou_crtc_set_config(struct drm_mode_set *set) | |||
| 382 | crtc->fb = fb; | 384 | crtc->fb = fb; |
| 383 | crtc->x = set->x; | 385 | crtc->x = set->x; |
| 384 | crtc->y = set->y; | 386 | crtc->y = set->y; |
| 387 | crtc->enabled = true; | ||
| 385 | 388 | ||
| 386 | return 0; | 389 | return 0; |
| 387 | } | 390 | } |
| @@ -464,6 +467,8 @@ static int vmw_sou_init(struct vmw_private *dev_priv, unsigned unit) | |||
| 464 | encoder->possible_crtcs = (1 << unit); | 467 | encoder->possible_crtcs = (1 << unit); |
| 465 | encoder->possible_clones = 0; | 468 | encoder->possible_clones = 0; |
| 466 | 469 | ||
| 470 | (void) drm_sysfs_connector_add(connector); | ||
| 471 | |||
| 467 | drm_crtc_init(dev, crtc, &vmw_screen_object_crtc_funcs); | 472 | drm_crtc_init(dev, crtc, &vmw_screen_object_crtc_funcs); |
| 468 | 473 | ||
| 469 | drm_mode_crtc_set_gamma_size(crtc, 256); | 474 | drm_mode_crtc_set_gamma_size(crtc, 256); |
diff --git a/drivers/gpu/host1x/bus.c b/drivers/gpu/host1x/bus.c index 509383f8be03..6a929591aa73 100644 --- a/drivers/gpu/host1x/bus.c +++ b/drivers/gpu/host1x/bus.c | |||
| @@ -19,6 +19,7 @@ | |||
| 19 | #include <linux/of.h> | 19 | #include <linux/of.h> |
| 20 | #include <linux/slab.h> | 20 | #include <linux/slab.h> |
| 21 | 21 | ||
| 22 | #include "bus.h" | ||
| 22 | #include "dev.h" | 23 | #include "dev.h" |
| 23 | 24 | ||
| 24 | static DEFINE_MUTEX(clients_lock); | 25 | static DEFINE_MUTEX(clients_lock); |
| @@ -257,7 +258,7 @@ static int host1x_unregister_client(struct host1x *host1x, | |||
| 257 | return -ENODEV; | 258 | return -ENODEV; |
| 258 | } | 259 | } |
| 259 | 260 | ||
| 260 | struct bus_type host1x_bus_type = { | 261 | static struct bus_type host1x_bus_type = { |
| 261 | .name = "host1x", | 262 | .name = "host1x", |
| 262 | }; | 263 | }; |
| 263 | 264 | ||
| @@ -301,7 +302,7 @@ static int host1x_device_add(struct host1x *host1x, | |||
| 301 | device->dev.coherent_dma_mask = host1x->dev->coherent_dma_mask; | 302 | device->dev.coherent_dma_mask = host1x->dev->coherent_dma_mask; |
| 302 | device->dev.dma_mask = &device->dev.coherent_dma_mask; | 303 | device->dev.dma_mask = &device->dev.coherent_dma_mask; |
| 303 | device->dev.release = host1x_device_release; | 304 | device->dev.release = host1x_device_release; |
| 304 | dev_set_name(&device->dev, driver->name); | 305 | dev_set_name(&device->dev, "%s", driver->name); |
| 305 | device->dev.bus = &host1x_bus_type; | 306 | device->dev.bus = &host1x_bus_type; |
| 306 | device->dev.parent = host1x->dev; | 307 | device->dev.parent = host1x->dev; |
| 307 | 308 | ||
diff --git a/drivers/gpu/host1x/hw/cdma_hw.c b/drivers/gpu/host1x/hw/cdma_hw.c index 37e2a63241a9..6b09b71940c2 100644 --- a/drivers/gpu/host1x/hw/cdma_hw.c +++ b/drivers/gpu/host1x/hw/cdma_hw.c | |||
| @@ -54,8 +54,8 @@ static void cdma_timeout_cpu_incr(struct host1x_cdma *cdma, u32 getptr, | |||
| 54 | u32 *p = (u32 *)((u32)pb->mapped + getptr); | 54 | u32 *p = (u32 *)((u32)pb->mapped + getptr); |
| 55 | *(p++) = HOST1X_OPCODE_NOP; | 55 | *(p++) = HOST1X_OPCODE_NOP; |
| 56 | *(p++) = HOST1X_OPCODE_NOP; | 56 | *(p++) = HOST1X_OPCODE_NOP; |
| 57 | dev_dbg(host1x->dev, "%s: NOP at 0x%x\n", __func__, | 57 | dev_dbg(host1x->dev, "%s: NOP at %#llx\n", __func__, |
| 58 | pb->phys + getptr); | 58 | (u64)pb->phys + getptr); |
| 59 | getptr = (getptr + 8) & (pb->size_bytes - 1); | 59 | getptr = (getptr + 8) & (pb->size_bytes - 1); |
| 60 | } | 60 | } |
| 61 | wmb(); | 61 | wmb(); |
diff --git a/drivers/gpu/host1x/hw/debug_hw.c b/drivers/gpu/host1x/hw/debug_hw.c index 640c75ca5a8b..f72c873eff81 100644 --- a/drivers/gpu/host1x/hw/debug_hw.c +++ b/drivers/gpu/host1x/hw/debug_hw.c | |||
| @@ -163,8 +163,8 @@ static void show_channel_gathers(struct output *o, struct host1x_cdma *cdma) | |||
| 163 | continue; | 163 | continue; |
| 164 | } | 164 | } |
| 165 | 165 | ||
| 166 | host1x_debug_output(o, " GATHER at %08x+%04x, %d words\n", | 166 | host1x_debug_output(o, " GATHER at %#llx+%04x, %d words\n", |
| 167 | g->base, g->offset, g->words); | 167 | (u64)g->base, g->offset, g->words); |
| 168 | 168 | ||
| 169 | show_gather(o, g->base + g->offset, g->words, cdma, | 169 | show_gather(o, g->base + g->offset, g->words, cdma, |
| 170 | g->base, mapped); | 170 | g->base, mapped); |
diff --git a/drivers/hid/Kconfig b/drivers/hid/Kconfig index 329fbb9b5976..34e2d39d4ce8 100644 --- a/drivers/hid/Kconfig +++ b/drivers/hid/Kconfig | |||
| @@ -460,6 +460,7 @@ config HID_MULTITOUCH | |||
| 460 | - Stantum multitouch panels | 460 | - Stantum multitouch panels |
| 461 | - Touch International Panels | 461 | - Touch International Panels |
| 462 | - Unitec Panels | 462 | - Unitec Panels |
| 463 | - Wistron optical touch panels | ||
| 463 | - XAT optical touch panels | 464 | - XAT optical touch panels |
| 464 | - Xiroku optical touch panels | 465 | - Xiroku optical touch panels |
| 465 | - Zytronic touch panels | 466 | - Zytronic touch panels |
diff --git a/drivers/hid/hid-appleir.c b/drivers/hid/hid-appleir.c index a42e6a394c5e..0e6a42d37eb6 100644 --- a/drivers/hid/hid-appleir.c +++ b/drivers/hid/hid-appleir.c | |||
| @@ -297,6 +297,9 @@ static int appleir_probe(struct hid_device *hid, const struct hid_device_id *id) | |||
| 297 | 297 | ||
| 298 | appleir->hid = hid; | 298 | appleir->hid = hid; |
| 299 | 299 | ||
| 300 | /* force input as some remotes bypass the input registration */ | ||
| 301 | hid->quirks |= HID_QUIRK_HIDINPUT_FORCE; | ||
| 302 | |||
| 300 | spin_lock_init(&appleir->lock); | 303 | spin_lock_init(&appleir->lock); |
| 301 | setup_timer(&appleir->key_up_timer, | 304 | setup_timer(&appleir->key_up_timer, |
| 302 | key_up_tick, (unsigned long) appleir); | 305 | key_up_tick, (unsigned long) appleir); |
diff --git a/drivers/hid/hid-core.c b/drivers/hid/hid-core.c index 8c10f2742233..253fe23ef7fe 100644 --- a/drivers/hid/hid-core.c +++ b/drivers/hid/hid-core.c | |||
| @@ -1723,6 +1723,7 @@ static const struct hid_device_id hid_have_special_driver[] = { | |||
| 1723 | { HID_USB_DEVICE(USB_VENDOR_ID_KENSINGTON, USB_DEVICE_ID_KS_SLIMBLADE) }, | 1723 | { HID_USB_DEVICE(USB_VENDOR_ID_KENSINGTON, USB_DEVICE_ID_KS_SLIMBLADE) }, |
| 1724 | { HID_USB_DEVICE(USB_VENDOR_ID_KEYTOUCH, USB_DEVICE_ID_KEYTOUCH_IEC) }, | 1724 | { HID_USB_DEVICE(USB_VENDOR_ID_KEYTOUCH, USB_DEVICE_ID_KEYTOUCH_IEC) }, |
| 1725 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_GENIUS_GILA_GAMING_MOUSE) }, | 1725 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_GENIUS_GILA_GAMING_MOUSE) }, |
| 1726 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_GENIUS_MANTICORE) }, | ||
| 1726 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_GENIUS_GX_IMPERATOR) }, | 1727 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_GENIUS_GX_IMPERATOR) }, |
| 1727 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_KYE_ERGO_525V) }, | 1728 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_KYE_ERGO_525V) }, |
| 1728 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_KYE_EASYPEN_I405X) }, | 1729 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_KYE_EASYPEN_I405X) }, |
| @@ -1879,7 +1880,6 @@ static const struct hid_device_id hid_have_special_driver[] = { | |||
| 1879 | 1880 | ||
| 1880 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_MICROSOFT, USB_DEVICE_ID_MS_PRESENTER_8K_BT) }, | 1881 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_MICROSOFT, USB_DEVICE_ID_MS_PRESENTER_8K_BT) }, |
| 1881 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, USB_DEVICE_ID_NINTENDO_WIIMOTE) }, | 1882 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, USB_DEVICE_ID_NINTENDO_WIIMOTE) }, |
| 1882 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO2, USB_DEVICE_ID_NINTENDO_WIIMOTE) }, | ||
| 1883 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, USB_DEVICE_ID_NINTENDO_WIIMOTE2) }, | 1883 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, USB_DEVICE_ID_NINTENDO_WIIMOTE2) }, |
| 1884 | { } | 1884 | { } |
| 1885 | }; | 1885 | }; |
diff --git a/drivers/hid/hid-ids.h b/drivers/hid/hid-ids.h index 76559629568c..f9304cb37154 100644 --- a/drivers/hid/hid-ids.h +++ b/drivers/hid/hid-ids.h | |||
| @@ -489,6 +489,7 @@ | |||
| 489 | #define USB_VENDOR_ID_KYE 0x0458 | 489 | #define USB_VENDOR_ID_KYE 0x0458 |
| 490 | #define USB_DEVICE_ID_KYE_ERGO_525V 0x0087 | 490 | #define USB_DEVICE_ID_KYE_ERGO_525V 0x0087 |
| 491 | #define USB_DEVICE_ID_GENIUS_GILA_GAMING_MOUSE 0x0138 | 491 | #define USB_DEVICE_ID_GENIUS_GILA_GAMING_MOUSE 0x0138 |
| 492 | #define USB_DEVICE_ID_GENIUS_MANTICORE 0x0153 | ||
| 492 | #define USB_DEVICE_ID_GENIUS_GX_IMPERATOR 0x4018 | 493 | #define USB_DEVICE_ID_GENIUS_GX_IMPERATOR 0x4018 |
| 493 | #define USB_DEVICE_ID_KYE_GPEN_560 0x5003 | 494 | #define USB_DEVICE_ID_KYE_GPEN_560 0x5003 |
| 494 | #define USB_DEVICE_ID_KYE_EASYPEN_I405X 0x5010 | 495 | #define USB_DEVICE_ID_KYE_EASYPEN_I405X 0x5010 |
| @@ -640,7 +641,6 @@ | |||
| 640 | #define USB_DEVICE_ID_NEXTWINDOW_TOUCHSCREEN 0x0003 | 641 | #define USB_DEVICE_ID_NEXTWINDOW_TOUCHSCREEN 0x0003 |
| 641 | 642 | ||
| 642 | #define USB_VENDOR_ID_NINTENDO 0x057e | 643 | #define USB_VENDOR_ID_NINTENDO 0x057e |
| 643 | #define USB_VENDOR_ID_NINTENDO2 0x054c | ||
| 644 | #define USB_DEVICE_ID_NINTENDO_WIIMOTE 0x0306 | 644 | #define USB_DEVICE_ID_NINTENDO_WIIMOTE 0x0306 |
| 645 | #define USB_DEVICE_ID_NINTENDO_WIIMOTE2 0x0330 | 645 | #define USB_DEVICE_ID_NINTENDO_WIIMOTE2 0x0330 |
| 646 | 646 | ||
| @@ -902,6 +902,9 @@ | |||
| 902 | #define USB_DEVICE_ID_SUPER_DUAL_BOX_PRO 0x8802 | 902 | #define USB_DEVICE_ID_SUPER_DUAL_BOX_PRO 0x8802 |
| 903 | #define USB_DEVICE_ID_SUPER_JOY_BOX_5_PRO 0x8804 | 903 | #define USB_DEVICE_ID_SUPER_JOY_BOX_5_PRO 0x8804 |
| 904 | 904 | ||
| 905 | #define USB_VENDOR_ID_WISTRON 0x0fb8 | ||
| 906 | #define USB_DEVICE_ID_WISTRON_OPTICAL_TOUCH 0x1109 | ||
| 907 | |||
| 905 | #define USB_VENDOR_ID_X_TENSIONS 0x1ae7 | 908 | #define USB_VENDOR_ID_X_TENSIONS 0x1ae7 |
| 906 | #define USB_DEVICE_ID_SPEEDLINK_VAD_CEZANNE 0x9001 | 909 | #define USB_DEVICE_ID_SPEEDLINK_VAD_CEZANNE 0x9001 |
| 907 | 910 | ||
diff --git a/drivers/hid/hid-kye.c b/drivers/hid/hid-kye.c index 73845120295e..e77696367591 100644 --- a/drivers/hid/hid-kye.c +++ b/drivers/hid/hid-kye.c | |||
| @@ -342,6 +342,10 @@ static __u8 *kye_report_fixup(struct hid_device *hdev, __u8 *rdesc, | |||
| 342 | rdesc = kye_consumer_control_fixup(hdev, rdesc, rsize, 83, | 342 | rdesc = kye_consumer_control_fixup(hdev, rdesc, rsize, 83, |
| 343 | "Genius Gx Imperator Keyboard"); | 343 | "Genius Gx Imperator Keyboard"); |
| 344 | break; | 344 | break; |
| 345 | case USB_DEVICE_ID_GENIUS_MANTICORE: | ||
| 346 | rdesc = kye_consumer_control_fixup(hdev, rdesc, rsize, 104, | ||
| 347 | "Genius Manticore Keyboard"); | ||
| 348 | break; | ||
| 345 | } | 349 | } |
| 346 | return rdesc; | 350 | return rdesc; |
| 347 | } | 351 | } |
| @@ -418,6 +422,14 @@ static int kye_probe(struct hid_device *hdev, const struct hid_device_id *id) | |||
| 418 | goto enabling_err; | 422 | goto enabling_err; |
| 419 | } | 423 | } |
| 420 | break; | 424 | break; |
| 425 | case USB_DEVICE_ID_GENIUS_MANTICORE: | ||
| 426 | /* | ||
| 427 | * The manticore keyboard needs to have all the interfaces | ||
| 428 | * opened at least once to be fully functional. | ||
| 429 | */ | ||
| 430 | if (hid_hw_open(hdev)) | ||
| 431 | hid_hw_close(hdev); | ||
| 432 | break; | ||
| 421 | } | 433 | } |
| 422 | 434 | ||
| 423 | return 0; | 435 | return 0; |
| @@ -439,6 +451,8 @@ static const struct hid_device_id kye_devices[] = { | |||
| 439 | USB_DEVICE_ID_GENIUS_GILA_GAMING_MOUSE) }, | 451 | USB_DEVICE_ID_GENIUS_GILA_GAMING_MOUSE) }, |
| 440 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, | 452 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, |
| 441 | USB_DEVICE_ID_GENIUS_GX_IMPERATOR) }, | 453 | USB_DEVICE_ID_GENIUS_GX_IMPERATOR) }, |
| 454 | { HID_USB_DEVICE(USB_VENDOR_ID_KYE, | ||
| 455 | USB_DEVICE_ID_GENIUS_MANTICORE) }, | ||
| 442 | { } | 456 | { } |
| 443 | }; | 457 | }; |
| 444 | MODULE_DEVICE_TABLE(hid, kye_devices); | 458 | MODULE_DEVICE_TABLE(hid, kye_devices); |
diff --git a/drivers/hid/hid-multitouch.c b/drivers/hid/hid-multitouch.c index a2cedb8ae1c0..d83b1e8b505b 100644 --- a/drivers/hid/hid-multitouch.c +++ b/drivers/hid/hid-multitouch.c | |||
| @@ -1335,6 +1335,12 @@ static const struct hid_device_id mt_devices[] = { | |||
| 1335 | { .driver_data = MT_CLS_NSMU, | 1335 | { .driver_data = MT_CLS_NSMU, |
| 1336 | MT_USB_DEVICE(USB_VENDOR_ID_UNITEC, | 1336 | MT_USB_DEVICE(USB_VENDOR_ID_UNITEC, |
| 1337 | USB_DEVICE_ID_UNITEC_USB_TOUCH_0A19) }, | 1337 | USB_DEVICE_ID_UNITEC_USB_TOUCH_0A19) }, |
| 1338 | |||
| 1339 | /* Wistron panels */ | ||
| 1340 | { .driver_data = MT_CLS_NSMU, | ||
| 1341 | MT_USB_DEVICE(USB_VENDOR_ID_WISTRON, | ||
| 1342 | USB_DEVICE_ID_WISTRON_OPTICAL_TOUCH) }, | ||
| 1343 | |||
| 1338 | /* XAT */ | 1344 | /* XAT */ |
| 1339 | { .driver_data = MT_CLS_NSMU, | 1345 | { .driver_data = MT_CLS_NSMU, |
| 1340 | MT_USB_DEVICE(USB_VENDOR_ID_XAT, | 1346 | MT_USB_DEVICE(USB_VENDOR_ID_XAT, |
diff --git a/drivers/hid/hid-sensor-hub.c b/drivers/hid/hid-sensor-hub.c index a184e1921c11..8fab82829f8b 100644 --- a/drivers/hid/hid-sensor-hub.c +++ b/drivers/hid/hid-sensor-hub.c | |||
| @@ -112,13 +112,15 @@ static int sensor_hub_get_physical_device_count( | |||
| 112 | 112 | ||
| 113 | static void sensor_hub_fill_attr_info( | 113 | static void sensor_hub_fill_attr_info( |
| 114 | struct hid_sensor_hub_attribute_info *info, | 114 | struct hid_sensor_hub_attribute_info *info, |
| 115 | s32 index, s32 report_id, s32 units, s32 unit_expo, s32 size) | 115 | s32 index, s32 report_id, struct hid_field *field) |
| 116 | { | 116 | { |
| 117 | info->index = index; | 117 | info->index = index; |
| 118 | info->report_id = report_id; | 118 | info->report_id = report_id; |
| 119 | info->units = units; | 119 | info->units = field->unit; |
| 120 | info->unit_expo = unit_expo; | 120 | info->unit_expo = field->unit_exponent; |
| 121 | info->size = size/8; | 121 | info->size = (field->report_size * field->report_count)/8; |
| 122 | info->logical_minimum = field->logical_minimum; | ||
| 123 | info->logical_maximum = field->logical_maximum; | ||
| 122 | } | 124 | } |
| 123 | 125 | ||
| 124 | static struct hid_sensor_hub_callbacks *sensor_hub_get_callback( | 126 | static struct hid_sensor_hub_callbacks *sensor_hub_get_callback( |
| @@ -325,9 +327,7 @@ int sensor_hub_input_get_attribute_info(struct hid_sensor_hub_device *hsdev, | |||
| 325 | if (field->physical == usage_id && | 327 | if (field->physical == usage_id && |
| 326 | field->logical == attr_usage_id) { | 328 | field->logical == attr_usage_id) { |
| 327 | sensor_hub_fill_attr_info(info, i, report->id, | 329 | sensor_hub_fill_attr_info(info, i, report->id, |
| 328 | field->unit, field->unit_exponent, | 330 | field); |
| 329 | field->report_size * | ||
| 330 | field->report_count); | ||
| 331 | ret = 0; | 331 | ret = 0; |
| 332 | } else { | 332 | } else { |
| 333 | for (j = 0; j < field->maxusage; ++j) { | 333 | for (j = 0; j < field->maxusage; ++j) { |
| @@ -336,11 +336,7 @@ int sensor_hub_input_get_attribute_info(struct hid_sensor_hub_device *hsdev, | |||
| 336 | field->usage[j].collection_index == | 336 | field->usage[j].collection_index == |
| 337 | collection_index) { | 337 | collection_index) { |
| 338 | sensor_hub_fill_attr_info(info, | 338 | sensor_hub_fill_attr_info(info, |
| 339 | i, report->id, | 339 | i, report->id, field); |
| 340 | field->unit, | ||
| 341 | field->unit_exponent, | ||
| 342 | field->report_size * | ||
| 343 | field->report_count); | ||
| 344 | ret = 0; | 340 | ret = 0; |
| 345 | break; | 341 | break; |
| 346 | } | 342 | } |
| @@ -573,6 +569,8 @@ static int sensor_hub_probe(struct hid_device *hdev, | |||
| 573 | goto err_free_names; | 569 | goto err_free_names; |
| 574 | } | 570 | } |
| 575 | sd->hid_sensor_hub_client_devs[ | 571 | sd->hid_sensor_hub_client_devs[ |
| 572 | sd->hid_sensor_client_cnt].id = PLATFORM_DEVID_AUTO; | ||
| 573 | sd->hid_sensor_hub_client_devs[ | ||
| 576 | sd->hid_sensor_client_cnt].name = name; | 574 | sd->hid_sensor_client_cnt].name = name; |
| 577 | sd->hid_sensor_hub_client_devs[ | 575 | sd->hid_sensor_hub_client_devs[ |
| 578 | sd->hid_sensor_client_cnt].platform_data = | 576 | sd->hid_sensor_client_cnt].platform_data = |
diff --git a/drivers/hid/hid-sony.c b/drivers/hid/hid-sony.c index da551d113762..098af2f84b8c 100644 --- a/drivers/hid/hid-sony.c +++ b/drivers/hid/hid-sony.c | |||
| @@ -225,6 +225,13 @@ static const unsigned int buzz_keymap[] = { | |||
| 225 | struct sony_sc { | 225 | struct sony_sc { |
| 226 | unsigned long quirks; | 226 | unsigned long quirks; |
| 227 | 227 | ||
| 228 | #ifdef CONFIG_SONY_FF | ||
| 229 | struct work_struct rumble_worker; | ||
| 230 | struct hid_device *hdev; | ||
| 231 | __u8 left; | ||
| 232 | __u8 right; | ||
| 233 | #endif | ||
| 234 | |||
| 228 | void *extra; | 235 | void *extra; |
| 229 | }; | 236 | }; |
| 230 | 237 | ||
| @@ -615,9 +622,9 @@ static void buzz_remove(struct hid_device *hdev) | |||
| 615 | } | 622 | } |
| 616 | 623 | ||
| 617 | #ifdef CONFIG_SONY_FF | 624 | #ifdef CONFIG_SONY_FF |
| 618 | static int sony_play_effect(struct input_dev *dev, void *data, | 625 | static void sony_rumble_worker(struct work_struct *work) |
| 619 | struct ff_effect *effect) | ||
| 620 | { | 626 | { |
| 627 | struct sony_sc *sc = container_of(work, struct sony_sc, rumble_worker); | ||
| 621 | unsigned char buf[] = { | 628 | unsigned char buf[] = { |
| 622 | 0x01, | 629 | 0x01, |
| 623 | 0x00, 0xff, 0x00, 0xff, 0x00, | 630 | 0x00, 0xff, 0x00, 0xff, 0x00, |
| @@ -628,21 +635,28 @@ static int sony_play_effect(struct input_dev *dev, void *data, | |||
| 628 | 0xff, 0x27, 0x10, 0x00, 0x32, | 635 | 0xff, 0x27, 0x10, 0x00, 0x32, |
| 629 | 0x00, 0x00, 0x00, 0x00, 0x00 | 636 | 0x00, 0x00, 0x00, 0x00, 0x00 |
| 630 | }; | 637 | }; |
| 631 | __u8 left; | 638 | |
| 632 | __u8 right; | 639 | buf[3] = sc->right; |
| 640 | buf[5] = sc->left; | ||
| 641 | |||
| 642 | sc->hdev->hid_output_raw_report(sc->hdev, buf, sizeof(buf), | ||
| 643 | HID_OUTPUT_REPORT); | ||
| 644 | } | ||
| 645 | |||
| 646 | static int sony_play_effect(struct input_dev *dev, void *data, | ||
| 647 | struct ff_effect *effect) | ||
| 648 | { | ||
| 633 | struct hid_device *hid = input_get_drvdata(dev); | 649 | struct hid_device *hid = input_get_drvdata(dev); |
| 650 | struct sony_sc *sc = hid_get_drvdata(hid); | ||
| 634 | 651 | ||
| 635 | if (effect->type != FF_RUMBLE) | 652 | if (effect->type != FF_RUMBLE) |
| 636 | return 0; | 653 | return 0; |
| 637 | 654 | ||
| 638 | left = effect->u.rumble.strong_magnitude / 256; | 655 | sc->left = effect->u.rumble.strong_magnitude / 256; |
| 639 | right = effect->u.rumble.weak_magnitude ? 1 : 0; | 656 | sc->right = effect->u.rumble.weak_magnitude ? 1 : 0; |
| 640 | |||
| 641 | buf[3] = right; | ||
| 642 | buf[5] = left; | ||
| 643 | 657 | ||
| 644 | return hid->hid_output_raw_report(hid, buf, sizeof(buf), | 658 | schedule_work(&sc->rumble_worker); |
| 645 | HID_OUTPUT_REPORT); | 659 | return 0; |
| 646 | } | 660 | } |
| 647 | 661 | ||
| 648 | static int sony_init_ff(struct hid_device *hdev) | 662 | static int sony_init_ff(struct hid_device *hdev) |
| @@ -650,16 +664,31 @@ static int sony_init_ff(struct hid_device *hdev) | |||
| 650 | struct hid_input *hidinput = list_entry(hdev->inputs.next, | 664 | struct hid_input *hidinput = list_entry(hdev->inputs.next, |
| 651 | struct hid_input, list); | 665 | struct hid_input, list); |
| 652 | struct input_dev *input_dev = hidinput->input; | 666 | struct input_dev *input_dev = hidinput->input; |
| 667 | struct sony_sc *sc = hid_get_drvdata(hdev); | ||
| 668 | |||
| 669 | sc->hdev = hdev; | ||
| 670 | INIT_WORK(&sc->rumble_worker, sony_rumble_worker); | ||
| 653 | 671 | ||
| 654 | input_set_capability(input_dev, EV_FF, FF_RUMBLE); | 672 | input_set_capability(input_dev, EV_FF, FF_RUMBLE); |
| 655 | return input_ff_create_memless(input_dev, NULL, sony_play_effect); | 673 | return input_ff_create_memless(input_dev, NULL, sony_play_effect); |
| 656 | } | 674 | } |
| 657 | 675 | ||
| 676 | static void sony_destroy_ff(struct hid_device *hdev) | ||
| 677 | { | ||
| 678 | struct sony_sc *sc = hid_get_drvdata(hdev); | ||
| 679 | |||
| 680 | cancel_work_sync(&sc->rumble_worker); | ||
| 681 | } | ||
| 682 | |||
| 658 | #else | 683 | #else |
| 659 | static int sony_init_ff(struct hid_device *hdev) | 684 | static int sony_init_ff(struct hid_device *hdev) |
| 660 | { | 685 | { |
| 661 | return 0; | 686 | return 0; |
| 662 | } | 687 | } |
| 688 | |||
| 689 | static void sony_destroy_ff(struct hid_device *hdev) | ||
| 690 | { | ||
| 691 | } | ||
| 663 | #endif | 692 | #endif |
| 664 | 693 | ||
| 665 | static int sony_probe(struct hid_device *hdev, const struct hid_device_id *id) | 694 | static int sony_probe(struct hid_device *hdev, const struct hid_device_id *id) |
| @@ -728,6 +757,8 @@ static void sony_remove(struct hid_device *hdev) | |||
| 728 | if (sc->quirks & BUZZ_CONTROLLER) | 757 | if (sc->quirks & BUZZ_CONTROLLER) |
| 729 | buzz_remove(hdev); | 758 | buzz_remove(hdev); |
| 730 | 759 | ||
| 760 | sony_destroy_ff(hdev); | ||
| 761 | |||
| 731 | hid_hw_stop(hdev); | 762 | hid_hw_stop(hdev); |
| 732 | } | 763 | } |
| 733 | 764 | ||
diff --git a/drivers/hid/hid-wiimote-core.c b/drivers/hid/hid-wiimote-core.c index 1446f526ee8b..abb20db2b443 100644 --- a/drivers/hid/hid-wiimote-core.c +++ b/drivers/hid/hid-wiimote-core.c | |||
| @@ -834,8 +834,7 @@ static void wiimote_init_set_type(struct wiimote_data *wdata, | |||
| 834 | goto done; | 834 | goto done; |
| 835 | } | 835 | } |
| 836 | 836 | ||
| 837 | if (vendor == USB_VENDOR_ID_NINTENDO || | 837 | if (vendor == USB_VENDOR_ID_NINTENDO) { |
| 838 | vendor == USB_VENDOR_ID_NINTENDO2) { | ||
| 839 | if (product == USB_DEVICE_ID_NINTENDO_WIIMOTE) { | 838 | if (product == USB_DEVICE_ID_NINTENDO_WIIMOTE) { |
| 840 | devtype = WIIMOTE_DEV_GEN10; | 839 | devtype = WIIMOTE_DEV_GEN10; |
| 841 | goto done; | 840 | goto done; |
| @@ -1856,8 +1855,6 @@ static void wiimote_hid_remove(struct hid_device *hdev) | |||
| 1856 | static const struct hid_device_id wiimote_hid_devices[] = { | 1855 | static const struct hid_device_id wiimote_hid_devices[] = { |
| 1857 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, | 1856 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, |
| 1858 | USB_DEVICE_ID_NINTENDO_WIIMOTE) }, | 1857 | USB_DEVICE_ID_NINTENDO_WIIMOTE) }, |
| 1859 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO2, | ||
| 1860 | USB_DEVICE_ID_NINTENDO_WIIMOTE) }, | ||
| 1861 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, | 1858 | { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO, |
| 1862 | USB_DEVICE_ID_NINTENDO_WIIMOTE2) }, | 1859 | USB_DEVICE_ID_NINTENDO_WIIMOTE2) }, |
| 1863 | { } | 1860 | { } |
diff --git a/drivers/hid/uhid.c b/drivers/hid/uhid.c index 93b00d76374c..cedc6da93c19 100644 --- a/drivers/hid/uhid.c +++ b/drivers/hid/uhid.c | |||
| @@ -287,7 +287,7 @@ static int uhid_event_from_user(const char __user *buffer, size_t len, | |||
| 287 | */ | 287 | */ |
| 288 | struct uhid_create_req_compat *compat; | 288 | struct uhid_create_req_compat *compat; |
| 289 | 289 | ||
| 290 | compat = kmalloc(sizeof(*compat), GFP_KERNEL); | 290 | compat = kzalloc(sizeof(*compat), GFP_KERNEL); |
| 291 | if (!compat) | 291 | if (!compat) |
| 292 | return -ENOMEM; | 292 | return -ENOMEM; |
| 293 | 293 | ||
diff --git a/drivers/hwmon/asus_atk0110.c b/drivers/hwmon/asus_atk0110.c index 1d7ff46812c3..dafc63c6932d 100644 --- a/drivers/hwmon/asus_atk0110.c +++ b/drivers/hwmon/asus_atk0110.c | |||
| @@ -18,7 +18,6 @@ | |||
| 18 | #include <linux/err.h> | 18 | #include <linux/err.h> |
| 19 | 19 | ||
| 20 | #include <acpi/acpi.h> | 20 | #include <acpi/acpi.h> |
| 21 | #include <acpi/acpixf.h> | ||
| 22 | #include <acpi/acpi_drivers.h> | 21 | #include <acpi/acpi_drivers.h> |
| 23 | #include <acpi/acpi_bus.h> | 22 | #include <acpi/acpi_bus.h> |
| 24 | 23 | ||
diff --git a/drivers/hwmon/hih6130.c b/drivers/hwmon/hih6130.c index 2dc37c7c6947..7d68a08baaa8 100644 --- a/drivers/hwmon/hih6130.c +++ b/drivers/hwmon/hih6130.c | |||
| @@ -43,6 +43,7 @@ | |||
| 43 | * @last_update: time of last update (jiffies) | 43 | * @last_update: time of last update (jiffies) |
| 44 | * @temperature: cached temperature measurement value | 44 | * @temperature: cached temperature measurement value |
| 45 | * @humidity: cached humidity measurement value | 45 | * @humidity: cached humidity measurement value |
| 46 | * @write_length: length for I2C measurement request | ||
| 46 | */ | 47 | */ |
| 47 | struct hih6130 { | 48 | struct hih6130 { |
| 48 | struct device *hwmon_dev; | 49 | struct device *hwmon_dev; |
| @@ -51,6 +52,7 @@ struct hih6130 { | |||
| 51 | unsigned long last_update; | 52 | unsigned long last_update; |
| 52 | int temperature; | 53 | int temperature; |
| 53 | int humidity; | 54 | int humidity; |
| 55 | size_t write_length; | ||
| 54 | }; | 56 | }; |
| 55 | 57 | ||
| 56 | /** | 58 | /** |
| @@ -121,8 +123,15 @@ static int hih6130_update_measurements(struct i2c_client *client) | |||
| 121 | */ | 123 | */ |
| 122 | if (time_after(jiffies, hih6130->last_update + HZ) || !hih6130->valid) { | 124 | if (time_after(jiffies, hih6130->last_update + HZ) || !hih6130->valid) { |
| 123 | 125 | ||
| 124 | /* write to slave address, no data, to request a measurement */ | 126 | /* |
| 125 | ret = i2c_master_send(client, tmp, 0); | 127 | * Write to slave address to request a measurement. |
| 128 | * According with the datasheet it should be with no data, but | ||
| 129 | * for systems with I2C bus drivers that do not allow zero | ||
| 130 | * length packets we write one dummy byte to allow sensor | ||
| 131 | * measurements on them. | ||
| 132 | */ | ||
| 133 | tmp[0] = 0; | ||
| 134 | ret = i2c_master_send(client, tmp, hih6130->write_length); | ||
| 126 | if (ret < 0) | 135 | if (ret < 0) |
| 127 | goto out; | 136 | goto out; |
| 128 | 137 | ||
| @@ -252,6 +261,9 @@ static int hih6130_probe(struct i2c_client *client, | |||
| 252 | goto fail_remove_sysfs; | 261 | goto fail_remove_sysfs; |
| 253 | } | 262 | } |
| 254 | 263 | ||
| 264 | if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_QUICK)) | ||
| 265 | hih6130->write_length = 1; | ||
| 266 | |||
| 255 | return 0; | 267 | return 0; |
| 256 | 268 | ||
| 257 | fail_remove_sysfs: | 269 | fail_remove_sysfs: |
diff --git a/drivers/hwmon/lm78.c b/drivers/hwmon/lm78.c index 6cf6bff79003..a2f3b4a365e4 100644 --- a/drivers/hwmon/lm78.c +++ b/drivers/hwmon/lm78.c | |||
| @@ -94,6 +94,8 @@ static inline u8 FAN_TO_REG(long rpm, int div) | |||
| 94 | { | 94 | { |
| 95 | if (rpm <= 0) | 95 | if (rpm <= 0) |
| 96 | return 255; | 96 | return 255; |
| 97 | if (rpm > 1350000) | ||
| 98 | return 1; | ||
| 97 | return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254); | 99 | return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254); |
| 98 | } | 100 | } |
| 99 | 101 | ||
diff --git a/drivers/hwmon/lm90.c b/drivers/hwmon/lm90.c index 4c4c1421bf28..8b8f3aa49726 100644 --- a/drivers/hwmon/lm90.c +++ b/drivers/hwmon/lm90.c | |||
| @@ -1610,12 +1610,14 @@ static int lm90_probe(struct i2c_client *client, | |||
| 1610 | "lm90", client); | 1610 | "lm90", client); |
| 1611 | if (err < 0) { | 1611 | if (err < 0) { |
| 1612 | dev_err(dev, "cannot request IRQ %d\n", client->irq); | 1612 | dev_err(dev, "cannot request IRQ %d\n", client->irq); |
| 1613 | goto exit_remove_files; | 1613 | goto exit_unregister; |
| 1614 | } | 1614 | } |
| 1615 | } | 1615 | } |
| 1616 | 1616 | ||
| 1617 | return 0; | 1617 | return 0; |
| 1618 | 1618 | ||
| 1619 | exit_unregister: | ||
| 1620 | hwmon_device_unregister(data->hwmon_dev); | ||
| 1619 | exit_remove_files: | 1621 | exit_remove_files: |
| 1620 | lm90_remove_files(client, data); | 1622 | lm90_remove_files(client, data); |
| 1621 | exit_restore: | 1623 | exit_restore: |
diff --git a/drivers/hwmon/sis5595.c b/drivers/hwmon/sis5595.c index 1404e6319deb..72a889702f0d 100644 --- a/drivers/hwmon/sis5595.c +++ b/drivers/hwmon/sis5595.c | |||
| @@ -141,6 +141,8 @@ static inline u8 FAN_TO_REG(long rpm, int div) | |||
| 141 | { | 141 | { |
| 142 | if (rpm <= 0) | 142 | if (rpm <= 0) |
| 143 | return 255; | 143 | return 255; |
| 144 | if (rpm > 1350000) | ||
| 145 | return 1; | ||
| 144 | return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254); | 146 | return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254); |
| 145 | } | 147 | } |
| 146 | 148 | ||
diff --git a/drivers/hwmon/vt8231.c b/drivers/hwmon/vt8231.c index 0e7017841f7d..aee14e2192f8 100644 --- a/drivers/hwmon/vt8231.c +++ b/drivers/hwmon/vt8231.c | |||
| @@ -145,7 +145,7 @@ static const u8 regtempmin[] = { 0x3a, 0x3e, 0x2c, 0x2e, 0x30, 0x32 }; | |||
| 145 | */ | 145 | */ |
| 146 | static inline u8 FAN_TO_REG(long rpm, int div) | 146 | static inline u8 FAN_TO_REG(long rpm, int div) |
| 147 | { | 147 | { |
| 148 | if (rpm == 0) | 148 | if (rpm <= 0 || rpm > 1310720) |
| 149 | return 0; | 149 | return 0; |
| 150 | return clamp_val(1310720 / (rpm * div), 1, 255); | 150 | return clamp_val(1310720 / (rpm * div), 1, 255); |
| 151 | } | 151 | } |
diff --git a/drivers/hwmon/w83l786ng.c b/drivers/hwmon/w83l786ng.c index edb06cda5a68..6ed76ceb9270 100644 --- a/drivers/hwmon/w83l786ng.c +++ b/drivers/hwmon/w83l786ng.c | |||
| @@ -481,9 +481,11 @@ store_pwm(struct device *dev, struct device_attribute *attr, | |||
| 481 | if (err) | 481 | if (err) |
| 482 | return err; | 482 | return err; |
| 483 | val = clamp_val(val, 0, 255); | 483 | val = clamp_val(val, 0, 255); |
| 484 | val = DIV_ROUND_CLOSEST(val, 0x11); | ||
| 484 | 485 | ||
| 485 | mutex_lock(&data->update_lock); | 486 | mutex_lock(&data->update_lock); |
| 486 | data->pwm[nr] = val; | 487 | data->pwm[nr] = val * 0x11; |
| 488 | val |= w83l786ng_read_value(client, W83L786NG_REG_PWM[nr]) & 0xf0; | ||
| 487 | w83l786ng_write_value(client, W83L786NG_REG_PWM[nr], val); | 489 | w83l786ng_write_value(client, W83L786NG_REG_PWM[nr], val); |
| 488 | mutex_unlock(&data->update_lock); | 490 | mutex_unlock(&data->update_lock); |
| 489 | return count; | 491 | return count; |
| @@ -510,7 +512,7 @@ store_pwm_enable(struct device *dev, struct device_attribute *attr, | |||
| 510 | mutex_lock(&data->update_lock); | 512 | mutex_lock(&data->update_lock); |
| 511 | reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG); | 513 | reg = w83l786ng_read_value(client, W83L786NG_REG_FAN_CFG); |
| 512 | data->pwm_enable[nr] = val; | 514 | data->pwm_enable[nr] = val; |
| 513 | reg &= ~(0x02 << W83L786NG_PWM_ENABLE_SHIFT[nr]); | 515 | reg &= ~(0x03 << W83L786NG_PWM_ENABLE_SHIFT[nr]); |
| 514 | reg |= (val - 1) << W83L786NG_PWM_ENABLE_SHIFT[nr]; | 516 | reg |= (val - 1) << W83L786NG_PWM_ENABLE_SHIFT[nr]; |
| 515 | w83l786ng_write_value(client, W83L786NG_REG_FAN_CFG, reg); | 517 | w83l786ng_write_value(client, W83L786NG_REG_FAN_CFG, reg); |
| 516 | mutex_unlock(&data->update_lock); | 518 | mutex_unlock(&data->update_lock); |
| @@ -776,9 +778,10 @@ static struct w83l786ng_data *w83l786ng_update_device(struct device *dev) | |||
| 776 | ((pwmcfg >> W83L786NG_PWM_MODE_SHIFT[i]) & 1) | 778 | ((pwmcfg >> W83L786NG_PWM_MODE_SHIFT[i]) & 1) |
| 777 | ? 0 : 1; | 779 | ? 0 : 1; |
| 778 | data->pwm_enable[i] = | 780 | data->pwm_enable[i] = |
| 779 | ((pwmcfg >> W83L786NG_PWM_ENABLE_SHIFT[i]) & 2) + 1; | 781 | ((pwmcfg >> W83L786NG_PWM_ENABLE_SHIFT[i]) & 3) + 1; |
| 780 | data->pwm[i] = w83l786ng_read_value(client, | 782 | data->pwm[i] = |
| 781 | W83L786NG_REG_PWM[i]); | 783 | (w83l786ng_read_value(client, W83L786NG_REG_PWM[i]) |
| 784 | & 0x0f) * 0x11; | ||
| 782 | } | 785 | } |
| 783 | 786 | ||
| 784 | 787 | ||
diff --git a/drivers/i2c/busses/i2c-bcm-kona.c b/drivers/i2c/busses/i2c-bcm-kona.c index 036cf03aeb61..18a74a6751a9 100644 --- a/drivers/i2c/busses/i2c-bcm-kona.c +++ b/drivers/i2c/busses/i2c-bcm-kona.c | |||
| @@ -20,7 +20,6 @@ | |||
| 20 | #include <linux/platform_device.h> | 20 | #include <linux/platform_device.h> |
| 21 | #include <linux/clk.h> | 21 | #include <linux/clk.h> |
| 22 | #include <linux/io.h> | 22 | #include <linux/io.h> |
| 23 | #include <linux/clk.h> | ||
| 24 | #include <linux/slab.h> | 23 | #include <linux/slab.h> |
| 25 | 24 | ||
| 26 | /* Hardware register offsets and field defintions */ | 25 | /* Hardware register offsets and field defintions */ |
| @@ -891,7 +890,7 @@ static const struct of_device_id bcm_kona_i2c_of_match[] = { | |||
| 891 | {.compatible = "brcm,kona-i2c",}, | 890 | {.compatible = "brcm,kona-i2c",}, |
| 892 | {}, | 891 | {}, |
| 893 | }; | 892 | }; |
| 894 | MODULE_DEVICE_TABLE(of, kona_i2c_of_match); | 893 | MODULE_DEVICE_TABLE(of, bcm_kona_i2c_of_match); |
| 895 | 894 | ||
| 896 | static struct platform_driver bcm_kona_i2c_driver = { | 895 | static struct platform_driver bcm_kona_i2c_driver = { |
| 897 | .driver = { | 896 | .driver = { |
diff --git a/drivers/i2c/busses/i2c-bcm2835.c b/drivers/i2c/busses/i2c-bcm2835.c index d7e8600f31fb..77df97b932af 100644 --- a/drivers/i2c/busses/i2c-bcm2835.c +++ b/drivers/i2c/busses/i2c-bcm2835.c | |||
| @@ -299,6 +299,7 @@ static int bcm2835_i2c_probe(struct platform_device *pdev) | |||
| 299 | strlcpy(adap->name, "bcm2835 I2C adapter", sizeof(adap->name)); | 299 | strlcpy(adap->name, "bcm2835 I2C adapter", sizeof(adap->name)); |
| 300 | adap->algo = &bcm2835_i2c_algo; | 300 | adap->algo = &bcm2835_i2c_algo; |
| 301 | adap->dev.parent = &pdev->dev; | 301 | adap->dev.parent = &pdev->dev; |
| 302 | adap->dev.of_node = pdev->dev.of_node; | ||
| 302 | 303 | ||
| 303 | bcm2835_i2c_writel(i2c_dev, BCM2835_I2C_C, 0); | 304 | bcm2835_i2c_writel(i2c_dev, BCM2835_I2C_C, 0); |
| 304 | 305 | ||
diff --git a/drivers/i2c/busses/i2c-davinci.c b/drivers/i2c/busses/i2c-davinci.c index ff05d9fef4a8..af0b5830303d 100644 --- a/drivers/i2c/busses/i2c-davinci.c +++ b/drivers/i2c/busses/i2c-davinci.c | |||
| @@ -125,12 +125,12 @@ static struct davinci_i2c_platform_data davinci_i2c_platform_data_default = { | |||
| 125 | static inline void davinci_i2c_write_reg(struct davinci_i2c_dev *i2c_dev, | 125 | static inline void davinci_i2c_write_reg(struct davinci_i2c_dev *i2c_dev, |
| 126 | int reg, u16 val) | 126 | int reg, u16 val) |
| 127 | { | 127 | { |
| 128 | __raw_writew(val, i2c_dev->base + reg); | 128 | writew_relaxed(val, i2c_dev->base + reg); |
| 129 | } | 129 | } |
| 130 | 130 | ||
| 131 | static inline u16 davinci_i2c_read_reg(struct davinci_i2c_dev *i2c_dev, int reg) | 131 | static inline u16 davinci_i2c_read_reg(struct davinci_i2c_dev *i2c_dev, int reg) |
| 132 | { | 132 | { |
| 133 | return __raw_readw(i2c_dev->base + reg); | 133 | return readw_relaxed(i2c_dev->base + reg); |
| 134 | } | 134 | } |
| 135 | 135 | ||
| 136 | /* Generate a pulse on the i2c clock pin. */ | 136 | /* Generate a pulse on the i2c clock pin. */ |
diff --git a/drivers/i2c/busses/i2c-diolan-u2c.c b/drivers/i2c/busses/i2c-diolan-u2c.c index dae3ddfe7619..721f7ebf9a3b 100644 --- a/drivers/i2c/busses/i2c-diolan-u2c.c +++ b/drivers/i2c/busses/i2c-diolan-u2c.c | |||
| @@ -25,8 +25,6 @@ | |||
| 25 | #define USB_VENDOR_ID_DIOLAN 0x0abf | 25 | #define USB_VENDOR_ID_DIOLAN 0x0abf |
| 26 | #define USB_DEVICE_ID_DIOLAN_U2C 0x3370 | 26 | #define USB_DEVICE_ID_DIOLAN_U2C 0x3370 |
| 27 | 27 | ||
| 28 | #define DIOLAN_OUT_EP 0x02 | ||
| 29 | #define DIOLAN_IN_EP 0x84 | ||
| 30 | 28 | ||
| 31 | /* commands via USB, must match command ids in the firmware */ | 29 | /* commands via USB, must match command ids in the firmware */ |
| 32 | #define CMD_I2C_READ 0x01 | 30 | #define CMD_I2C_READ 0x01 |
| @@ -84,6 +82,7 @@ | |||
| 84 | struct i2c_diolan_u2c { | 82 | struct i2c_diolan_u2c { |
| 85 | u8 obuffer[DIOLAN_OUTBUF_LEN]; /* output buffer */ | 83 | u8 obuffer[DIOLAN_OUTBUF_LEN]; /* output buffer */ |
| 86 | u8 ibuffer[DIOLAN_INBUF_LEN]; /* input buffer */ | 84 | u8 ibuffer[DIOLAN_INBUF_LEN]; /* input buffer */ |
| 85 | int ep_in, ep_out; /* Endpoints */ | ||
| 87 | struct usb_device *usb_dev; /* the usb device for this device */ | 86 | struct usb_device *usb_dev; /* the usb device for this device */ |
| 88 | struct usb_interface *interface;/* the interface for this device */ | 87 | struct usb_interface *interface;/* the interface for this device */ |
| 89 | struct i2c_adapter adapter; /* i2c related things */ | 88 | struct i2c_adapter adapter; /* i2c related things */ |
| @@ -109,7 +108,7 @@ static int diolan_usb_transfer(struct i2c_diolan_u2c *dev) | |||
| 109 | return -EINVAL; | 108 | return -EINVAL; |
| 110 | 109 | ||
| 111 | ret = usb_bulk_msg(dev->usb_dev, | 110 | ret = usb_bulk_msg(dev->usb_dev, |
| 112 | usb_sndbulkpipe(dev->usb_dev, DIOLAN_OUT_EP), | 111 | usb_sndbulkpipe(dev->usb_dev, dev->ep_out), |
| 113 | dev->obuffer, dev->olen, &actual, | 112 | dev->obuffer, dev->olen, &actual, |
| 114 | DIOLAN_USB_TIMEOUT); | 113 | DIOLAN_USB_TIMEOUT); |
| 115 | if (!ret) { | 114 | if (!ret) { |
| @@ -118,7 +117,7 @@ static int diolan_usb_transfer(struct i2c_diolan_u2c *dev) | |||
| 118 | 117 | ||
| 119 | tmpret = usb_bulk_msg(dev->usb_dev, | 118 | tmpret = usb_bulk_msg(dev->usb_dev, |
| 120 | usb_rcvbulkpipe(dev->usb_dev, | 119 | usb_rcvbulkpipe(dev->usb_dev, |
| 121 | DIOLAN_IN_EP), | 120 | dev->ep_in), |
| 122 | dev->ibuffer, | 121 | dev->ibuffer, |
| 123 | sizeof(dev->ibuffer), &actual, | 122 | sizeof(dev->ibuffer), &actual, |
| 124 | DIOLAN_USB_TIMEOUT); | 123 | DIOLAN_USB_TIMEOUT); |
| @@ -210,7 +209,7 @@ static void diolan_flush_input(struct i2c_diolan_u2c *dev) | |||
| 210 | int ret; | 209 | int ret; |
| 211 | 210 | ||
| 212 | ret = usb_bulk_msg(dev->usb_dev, | 211 | ret = usb_bulk_msg(dev->usb_dev, |
| 213 | usb_rcvbulkpipe(dev->usb_dev, DIOLAN_IN_EP), | 212 | usb_rcvbulkpipe(dev->usb_dev, dev->ep_in), |
| 214 | dev->ibuffer, sizeof(dev->ibuffer), &actual, | 213 | dev->ibuffer, sizeof(dev->ibuffer), &actual, |
| 215 | DIOLAN_USB_TIMEOUT); | 214 | DIOLAN_USB_TIMEOUT); |
| 216 | if (ret < 0 || actual == 0) | 215 | if (ret < 0 || actual == 0) |
| @@ -445,9 +444,14 @@ static void diolan_u2c_free(struct i2c_diolan_u2c *dev) | |||
| 445 | static int diolan_u2c_probe(struct usb_interface *interface, | 444 | static int diolan_u2c_probe(struct usb_interface *interface, |
| 446 | const struct usb_device_id *id) | 445 | const struct usb_device_id *id) |
| 447 | { | 446 | { |
| 447 | struct usb_host_interface *hostif = interface->cur_altsetting; | ||
| 448 | struct i2c_diolan_u2c *dev; | 448 | struct i2c_diolan_u2c *dev; |
| 449 | int ret; | 449 | int ret; |
| 450 | 450 | ||
| 451 | if (hostif->desc.bInterfaceNumber != 0 | ||
| 452 | || hostif->desc.bNumEndpoints < 2) | ||
| 453 | return -ENODEV; | ||
| 454 | |||
| 451 | /* allocate memory for our device state and initialize it */ | 455 | /* allocate memory for our device state and initialize it */ |
| 452 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); | 456 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
| 453 | if (dev == NULL) { | 457 | if (dev == NULL) { |
| @@ -455,6 +459,8 @@ static int diolan_u2c_probe(struct usb_interface *interface, | |||
| 455 | ret = -ENOMEM; | 459 | ret = -ENOMEM; |
| 456 | goto error; | 460 | goto error; |
| 457 | } | 461 | } |
| 462 | dev->ep_out = hostif->endpoint[0].desc.bEndpointAddress; | ||
| 463 | dev->ep_in = hostif->endpoint[1].desc.bEndpointAddress; | ||
| 458 | 464 | ||
| 459 | dev->usb_dev = usb_get_dev(interface_to_usbdev(interface)); | 465 | dev->usb_dev = usb_get_dev(interface_to_usbdev(interface)); |
| 460 | dev->interface = interface; | 466 | dev->interface = interface; |
diff --git a/drivers/i2c/busses/i2c-imx.c b/drivers/i2c/busses/i2c-imx.c index 1d7efa3169cd..d0cfbb4cb964 100644 --- a/drivers/i2c/busses/i2c-imx.c +++ b/drivers/i2c/busses/i2c-imx.c | |||
| @@ -312,7 +312,9 @@ static int i2c_imx_start(struct imx_i2c_struct *i2c_imx) | |||
| 312 | 312 | ||
| 313 | dev_dbg(&i2c_imx->adapter.dev, "<%s>\n", __func__); | 313 | dev_dbg(&i2c_imx->adapter.dev, "<%s>\n", __func__); |
| 314 | 314 | ||
| 315 | clk_prepare_enable(i2c_imx->clk); | 315 | result = clk_prepare_enable(i2c_imx->clk); |
| 316 | if (result) | ||
| 317 | return result; | ||
| 316 | imx_i2c_write_reg(i2c_imx->ifdr, i2c_imx, IMX_I2C_IFDR); | 318 | imx_i2c_write_reg(i2c_imx->ifdr, i2c_imx, IMX_I2C_IFDR); |
| 317 | /* Enable I2C controller */ | 319 | /* Enable I2C controller */ |
| 318 | imx_i2c_write_reg(i2c_imx->hwdata->i2sr_clr_opcode, i2c_imx, IMX_I2C_I2SR); | 320 | imx_i2c_write_reg(i2c_imx->hwdata->i2sr_clr_opcode, i2c_imx, IMX_I2C_I2SR); |
diff --git a/drivers/i2c/busses/i2c-omap.c b/drivers/i2c/busses/i2c-omap.c index a6a891d7970d..90dcc2eaac5f 100644 --- a/drivers/i2c/busses/i2c-omap.c +++ b/drivers/i2c/busses/i2c-omap.c | |||
| @@ -266,13 +266,13 @@ static const u8 reg_map_ip_v2[] = { | |||
| 266 | static inline void omap_i2c_write_reg(struct omap_i2c_dev *i2c_dev, | 266 | static inline void omap_i2c_write_reg(struct omap_i2c_dev *i2c_dev, |
| 267 | int reg, u16 val) | 267 | int reg, u16 val) |
| 268 | { | 268 | { |
| 269 | __raw_writew(val, i2c_dev->base + | 269 | writew_relaxed(val, i2c_dev->base + |
| 270 | (i2c_dev->regs[reg] << i2c_dev->reg_shift)); | 270 | (i2c_dev->regs[reg] << i2c_dev->reg_shift)); |
| 271 | } | 271 | } |
| 272 | 272 | ||
| 273 | static inline u16 omap_i2c_read_reg(struct omap_i2c_dev *i2c_dev, int reg) | 273 | static inline u16 omap_i2c_read_reg(struct omap_i2c_dev *i2c_dev, int reg) |
| 274 | { | 274 | { |
| 275 | return __raw_readw(i2c_dev->base + | 275 | return readw_relaxed(i2c_dev->base + |
| 276 | (i2c_dev->regs[reg] << i2c_dev->reg_shift)); | 276 | (i2c_dev->regs[reg] << i2c_dev->reg_shift)); |
| 277 | } | 277 | } |
| 278 | 278 | ||
| @@ -1037,6 +1037,20 @@ static const struct i2c_algorithm omap_i2c_algo = { | |||
| 1037 | }; | 1037 | }; |
| 1038 | 1038 | ||
| 1039 | #ifdef CONFIG_OF | 1039 | #ifdef CONFIG_OF |
| 1040 | static struct omap_i2c_bus_platform_data omap2420_pdata = { | ||
| 1041 | .rev = OMAP_I2C_IP_VERSION_1, | ||
| 1042 | .flags = OMAP_I2C_FLAG_NO_FIFO | | ||
| 1043 | OMAP_I2C_FLAG_SIMPLE_CLOCK | | ||
| 1044 | OMAP_I2C_FLAG_16BIT_DATA_REG | | ||
| 1045 | OMAP_I2C_FLAG_BUS_SHIFT_2, | ||
| 1046 | }; | ||
| 1047 | |||
| 1048 | static struct omap_i2c_bus_platform_data omap2430_pdata = { | ||
| 1049 | .rev = OMAP_I2C_IP_VERSION_1, | ||
| 1050 | .flags = OMAP_I2C_FLAG_BUS_SHIFT_2 | | ||
| 1051 | OMAP_I2C_FLAG_FORCE_19200_INT_CLK, | ||
| 1052 | }; | ||
| 1053 | |||
| 1040 | static struct omap_i2c_bus_platform_data omap3_pdata = { | 1054 | static struct omap_i2c_bus_platform_data omap3_pdata = { |
| 1041 | .rev = OMAP_I2C_IP_VERSION_1, | 1055 | .rev = OMAP_I2C_IP_VERSION_1, |
| 1042 | .flags = OMAP_I2C_FLAG_BUS_SHIFT_2, | 1056 | .flags = OMAP_I2C_FLAG_BUS_SHIFT_2, |
| @@ -1055,6 +1069,14 @@ static const struct of_device_id omap_i2c_of_match[] = { | |||
| 1055 | .compatible = "ti,omap3-i2c", | 1069 | .compatible = "ti,omap3-i2c", |
| 1056 | .data = &omap3_pdata, | 1070 | .data = &omap3_pdata, |
| 1057 | }, | 1071 | }, |
| 1072 | { | ||
| 1073 | .compatible = "ti,omap2430-i2c", | ||
| 1074 | .data = &omap2430_pdata, | ||
| 1075 | }, | ||
| 1076 | { | ||
| 1077 | .compatible = "ti,omap2420-i2c", | ||
| 1078 | .data = &omap2420_pdata, | ||
| 1079 | }, | ||
| 1058 | { }, | 1080 | { }, |
| 1059 | }; | 1081 | }; |
| 1060 | MODULE_DEVICE_TABLE(of, omap_i2c_of_match); | 1082 | MODULE_DEVICE_TABLE(of, omap_i2c_of_match); |
| @@ -1140,9 +1162,9 @@ omap_i2c_probe(struct platform_device *pdev) | |||
| 1140 | * Read the Rev hi bit-[15:14] ie scheme this is 1 indicates ver2. | 1162 | * Read the Rev hi bit-[15:14] ie scheme this is 1 indicates ver2. |
| 1141 | * On omap1/3/2 Offset 4 is IE Reg the bit [15:14] is 0 at reset. | 1163 | * On omap1/3/2 Offset 4 is IE Reg the bit [15:14] is 0 at reset. |
| 1142 | * Also since the omap_i2c_read_reg uses reg_map_ip_* a | 1164 | * Also since the omap_i2c_read_reg uses reg_map_ip_* a |
| 1143 | * raw_readw is done. | 1165 | * readw_relaxed is done. |
| 1144 | */ | 1166 | */ |
| 1145 | rev = __raw_readw(dev->base + 0x04); | 1167 | rev = readw_relaxed(dev->base + 0x04); |
| 1146 | 1168 | ||
| 1147 | dev->scheme = OMAP_I2C_SCHEME(rev); | 1169 | dev->scheme = OMAP_I2C_SCHEME(rev); |
| 1148 | switch (dev->scheme) { | 1170 | switch (dev->scheme) { |
diff --git a/drivers/i2c/i2c-mux.c b/drivers/i2c/i2c-mux.c index 797e3117bef7..2d0847b6be62 100644 --- a/drivers/i2c/i2c-mux.c +++ b/drivers/i2c/i2c-mux.c | |||
| @@ -139,6 +139,8 @@ struct i2c_adapter *i2c_add_mux_adapter(struct i2c_adapter *parent, | |||
| 139 | priv->adap.algo = &priv->algo; | 139 | priv->adap.algo = &priv->algo; |
| 140 | priv->adap.algo_data = priv; | 140 | priv->adap.algo_data = priv; |
| 141 | priv->adap.dev.parent = &parent->dev; | 141 | priv->adap.dev.parent = &parent->dev; |
| 142 | priv->adap.retries = parent->retries; | ||
| 143 | priv->adap.timeout = parent->timeout; | ||
| 142 | 144 | ||
| 143 | /* Sanity check on class */ | 145 | /* Sanity check on class */ |
| 144 | if (i2c_mux_parent_classes(parent) & class) | 146 | if (i2c_mux_parent_classes(parent) & class) |
diff --git a/drivers/idle/intel_idle.c b/drivers/idle/intel_idle.c index cbd4e9abc47e..92d1206482a6 100644 --- a/drivers/idle/intel_idle.c +++ b/drivers/idle/intel_idle.c | |||
| @@ -329,7 +329,7 @@ static struct cpuidle_state atom_cstates[] __initdata = { | |||
| 329 | { | 329 | { |
| 330 | .enter = NULL } | 330 | .enter = NULL } |
| 331 | }; | 331 | }; |
| 332 | static struct cpuidle_state avn_cstates[CPUIDLE_STATE_MAX] = { | 332 | static struct cpuidle_state avn_cstates[] __initdata = { |
| 333 | { | 333 | { |
| 334 | .name = "C1-AVN", | 334 | .name = "C1-AVN", |
| 335 | .desc = "MWAIT 0x00", | 335 | .desc = "MWAIT 0x00", |
| @@ -340,7 +340,7 @@ static struct cpuidle_state avn_cstates[CPUIDLE_STATE_MAX] = { | |||
| 340 | { | 340 | { |
| 341 | .name = "C6-AVN", | 341 | .name = "C6-AVN", |
| 342 | .desc = "MWAIT 0x51", | 342 | .desc = "MWAIT 0x51", |
| 343 | .flags = MWAIT2flg(0x58) | CPUIDLE_FLAG_TIME_VALID | CPUIDLE_FLAG_TLB_FLUSHED, | 343 | .flags = MWAIT2flg(0x51) | CPUIDLE_FLAG_TIME_VALID | CPUIDLE_FLAG_TLB_FLUSHED, |
| 344 | .exit_latency = 15, | 344 | .exit_latency = 15, |
| 345 | .target_residency = 45, | 345 | .target_residency = 45, |
| 346 | .enter = &intel_idle }, | 346 | .enter = &intel_idle }, |
diff --git a/drivers/iio/accel/hid-sensor-accel-3d.c b/drivers/iio/accel/hid-sensor-accel-3d.c index dcda17395c4e..1cae4e920c9b 100644 --- a/drivers/iio/accel/hid-sensor-accel-3d.c +++ b/drivers/iio/accel/hid-sensor-accel-3d.c | |||
| @@ -350,7 +350,7 @@ static int hid_accel_3d_probe(struct platform_device *pdev) | |||
| 350 | error_iio_unreg: | 350 | error_iio_unreg: |
| 351 | iio_device_unregister(indio_dev); | 351 | iio_device_unregister(indio_dev); |
| 352 | error_remove_trigger: | 352 | error_remove_trigger: |
| 353 | hid_sensor_remove_trigger(indio_dev); | 353 | hid_sensor_remove_trigger(&accel_state->common_attributes); |
| 354 | error_unreg_buffer_funcs: | 354 | error_unreg_buffer_funcs: |
| 355 | iio_triggered_buffer_cleanup(indio_dev); | 355 | iio_triggered_buffer_cleanup(indio_dev); |
| 356 | error_free_dev_mem: | 356 | error_free_dev_mem: |
| @@ -363,10 +363,11 @@ static int hid_accel_3d_remove(struct platform_device *pdev) | |||
| 363 | { | 363 | { |
| 364 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; | 364 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; |
| 365 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); | 365 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); |
| 366 | struct accel_3d_state *accel_state = iio_priv(indio_dev); | ||
| 366 | 367 | ||
| 367 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_ACCEL_3D); | 368 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_ACCEL_3D); |
| 368 | iio_device_unregister(indio_dev); | 369 | iio_device_unregister(indio_dev); |
| 369 | hid_sensor_remove_trigger(indio_dev); | 370 | hid_sensor_remove_trigger(&accel_state->common_attributes); |
| 370 | iio_triggered_buffer_cleanup(indio_dev); | 371 | iio_triggered_buffer_cleanup(indio_dev); |
| 371 | kfree(indio_dev->channels); | 372 | kfree(indio_dev->channels); |
| 372 | 373 | ||
diff --git a/drivers/iio/accel/kxsd9.c b/drivers/iio/accel/kxsd9.c index d72118d1189c..98ba761cbb9c 100644 --- a/drivers/iio/accel/kxsd9.c +++ b/drivers/iio/accel/kxsd9.c | |||
| @@ -112,9 +112,10 @@ static int kxsd9_read(struct iio_dev *indio_dev, u8 address) | |||
| 112 | mutex_lock(&st->buf_lock); | 112 | mutex_lock(&st->buf_lock); |
| 113 | st->tx[0] = KXSD9_READ(address); | 113 | st->tx[0] = KXSD9_READ(address); |
| 114 | ret = spi_sync_transfer(st->us, xfers, ARRAY_SIZE(xfers)); | 114 | ret = spi_sync_transfer(st->us, xfers, ARRAY_SIZE(xfers)); |
| 115 | if (ret) | 115 | if (!ret) |
| 116 | return ret; | 116 | ret = (((u16)(st->rx[0])) << 8) | (st->rx[1] & 0xF0); |
| 117 | return (((u16)(st->rx[0])) << 8) | (st->rx[1] & 0xF0); | 117 | mutex_unlock(&st->buf_lock); |
| 118 | return ret; | ||
| 118 | } | 119 | } |
| 119 | 120 | ||
| 120 | static IIO_CONST_ATTR(accel_scale_available, | 121 | static IIO_CONST_ATTR(accel_scale_available, |
diff --git a/drivers/iio/adc/at91_adc.c b/drivers/iio/adc/at91_adc.c index 17df74908db1..5b1aa027c034 100644 --- a/drivers/iio/adc/at91_adc.c +++ b/drivers/iio/adc/at91_adc.c | |||
| @@ -1047,6 +1047,7 @@ static int at91_adc_probe(struct platform_device *pdev) | |||
| 1047 | } else { | 1047 | } else { |
| 1048 | if (!st->caps->has_tsmr) { | 1048 | if (!st->caps->has_tsmr) { |
| 1049 | dev_err(&pdev->dev, "We don't support non-TSMR adc\n"); | 1049 | dev_err(&pdev->dev, "We don't support non-TSMR adc\n"); |
| 1050 | ret = -ENODEV; | ||
| 1050 | goto error_disable_adc_clk; | 1051 | goto error_disable_adc_clk; |
| 1051 | } | 1052 | } |
| 1052 | 1053 | ||
diff --git a/drivers/iio/adc/mcp3422.c b/drivers/iio/adc/mcp3422.c index 12948325431c..c8c1baaec6c1 100644 --- a/drivers/iio/adc/mcp3422.c +++ b/drivers/iio/adc/mcp3422.c | |||
| @@ -88,10 +88,10 @@ static const int mcp3422_sample_rates[4] = { | |||
| 88 | 88 | ||
| 89 | /* sample rates to sign extension table */ | 89 | /* sample rates to sign extension table */ |
| 90 | static const int mcp3422_sign_extend[4] = { | 90 | static const int mcp3422_sign_extend[4] = { |
| 91 | [MCP3422_SRATE_240] = 12, | 91 | [MCP3422_SRATE_240] = 11, |
| 92 | [MCP3422_SRATE_60] = 14, | 92 | [MCP3422_SRATE_60] = 13, |
| 93 | [MCP3422_SRATE_15] = 16, | 93 | [MCP3422_SRATE_15] = 15, |
| 94 | [MCP3422_SRATE_3] = 18 }; | 94 | [MCP3422_SRATE_3] = 17 }; |
| 95 | 95 | ||
| 96 | /* Client data (each client gets its own) */ | 96 | /* Client data (each client gets its own) */ |
| 97 | struct mcp3422 { | 97 | struct mcp3422 { |
diff --git a/drivers/iio/adc/ti_am335x_adc.c b/drivers/iio/adc/ti_am335x_adc.c index 728411ec7642..d4d748214e4b 100644 --- a/drivers/iio/adc/ti_am335x_adc.c +++ b/drivers/iio/adc/ti_am335x_adc.c | |||
| @@ -229,12 +229,15 @@ static int tiadc_iio_buffered_hardware_setup(struct iio_dev *indio_dev, | |||
| 229 | unsigned long flags, | 229 | unsigned long flags, |
| 230 | const struct iio_buffer_setup_ops *setup_ops) | 230 | const struct iio_buffer_setup_ops *setup_ops) |
| 231 | { | 231 | { |
| 232 | struct iio_buffer *buffer; | ||
| 232 | int ret; | 233 | int ret; |
| 233 | 234 | ||
| 234 | indio_dev->buffer = iio_kfifo_allocate(indio_dev); | 235 | buffer = iio_kfifo_allocate(indio_dev); |
| 235 | if (!indio_dev->buffer) | 236 | if (!buffer) |
| 236 | return -ENOMEM; | 237 | return -ENOMEM; |
| 237 | 238 | ||
| 239 | iio_device_attach_buffer(indio_dev, buffer); | ||
| 240 | |||
| 238 | ret = request_threaded_irq(irq, pollfunc_th, pollfunc_bh, | 241 | ret = request_threaded_irq(irq, pollfunc_th, pollfunc_bh, |
| 239 | flags, indio_dev->name, indio_dev); | 242 | flags, indio_dev->name, indio_dev); |
| 240 | if (ret) | 243 | if (ret) |
diff --git a/drivers/iio/common/hid-sensors/Kconfig b/drivers/iio/common/hid-sensors/Kconfig index 1178121b55b0..39188b72cd3b 100644 --- a/drivers/iio/common/hid-sensors/Kconfig +++ b/drivers/iio/common/hid-sensors/Kconfig | |||
| @@ -25,13 +25,4 @@ config HID_SENSOR_IIO_TRIGGER | |||
| 25 | If this driver is compiled as a module, it will be named | 25 | If this driver is compiled as a module, it will be named |
| 26 | hid-sensor-trigger. | 26 | hid-sensor-trigger. |
| 27 | 27 | ||
| 28 | config HID_SENSOR_ENUM_BASE_QUIRKS | ||
| 29 | bool "ENUM base quirks for HID Sensor IIO drivers" | ||
| 30 | depends on HID_SENSOR_IIO_COMMON | ||
| 31 | help | ||
| 32 | Say yes here to build support for sensor hub FW using | ||
| 33 | enumeration, which is using 1 as base instead of 0. | ||
| 34 | Since logical minimum is still set 0 instead of 1, | ||
| 35 | there is no easy way to differentiate. | ||
| 36 | |||
| 37 | endmenu | 28 | endmenu |
diff --git a/drivers/iio/common/hid-sensors/hid-sensor-trigger.c b/drivers/iio/common/hid-sensors/hid-sensor-trigger.c index b6e77e0fc420..7dcf83998e6f 100644 --- a/drivers/iio/common/hid-sensors/hid-sensor-trigger.c +++ b/drivers/iio/common/hid-sensors/hid-sensor-trigger.c | |||
| @@ -33,33 +33,42 @@ static int hid_sensor_data_rdy_trigger_set_state(struct iio_trigger *trig, | |||
| 33 | { | 33 | { |
| 34 | struct hid_sensor_common *st = iio_trigger_get_drvdata(trig); | 34 | struct hid_sensor_common *st = iio_trigger_get_drvdata(trig); |
| 35 | int state_val; | 35 | int state_val; |
| 36 | int report_val; | ||
| 36 | 37 | ||
| 37 | if (state) { | 38 | if (state) { |
| 38 | if (sensor_hub_device_open(st->hsdev)) | 39 | if (sensor_hub_device_open(st->hsdev)) |
| 39 | return -EIO; | 40 | return -EIO; |
| 40 | } else | 41 | state_val = |
| 42 | HID_USAGE_SENSOR_PROP_POWER_STATE_D0_FULL_POWER_ENUM; | ||
| 43 | report_val = | ||
| 44 | HID_USAGE_SENSOR_PROP_REPORTING_STATE_ALL_EVENTS_ENUM; | ||
| 45 | |||
| 46 | } else { | ||
| 41 | sensor_hub_device_close(st->hsdev); | 47 | sensor_hub_device_close(st->hsdev); |
| 48 | state_val = | ||
| 49 | HID_USAGE_SENSOR_PROP_POWER_STATE_D4_POWER_OFF_ENUM; | ||
| 50 | report_val = | ||
| 51 | HID_USAGE_SENSOR_PROP_REPORTING_STATE_NO_EVENTS_ENUM; | ||
| 52 | } | ||
| 42 | 53 | ||
| 43 | state_val = state ? 1 : 0; | ||
| 44 | if (IS_ENABLED(CONFIG_HID_SENSOR_ENUM_BASE_QUIRKS)) | ||
| 45 | ++state_val; | ||
| 46 | st->data_ready = state; | 54 | st->data_ready = state; |
| 55 | state_val += st->power_state.logical_minimum; | ||
| 56 | report_val += st->report_state.logical_minimum; | ||
| 47 | sensor_hub_set_feature(st->hsdev, st->power_state.report_id, | 57 | sensor_hub_set_feature(st->hsdev, st->power_state.report_id, |
| 48 | st->power_state.index, | 58 | st->power_state.index, |
| 49 | (s32)state_val); | 59 | (s32)state_val); |
| 50 | 60 | ||
| 51 | sensor_hub_set_feature(st->hsdev, st->report_state.report_id, | 61 | sensor_hub_set_feature(st->hsdev, st->report_state.report_id, |
| 52 | st->report_state.index, | 62 | st->report_state.index, |
| 53 | (s32)state_val); | 63 | (s32)report_val); |
| 54 | 64 | ||
| 55 | return 0; | 65 | return 0; |
| 56 | } | 66 | } |
| 57 | 67 | ||
| 58 | void hid_sensor_remove_trigger(struct iio_dev *indio_dev) | 68 | void hid_sensor_remove_trigger(struct hid_sensor_common *attrb) |
| 59 | { | 69 | { |
| 60 | iio_trigger_unregister(indio_dev->trig); | 70 | iio_trigger_unregister(attrb->trigger); |
| 61 | iio_trigger_free(indio_dev->trig); | 71 | iio_trigger_free(attrb->trigger); |
| 62 | indio_dev->trig = NULL; | ||
| 63 | } | 72 | } |
| 64 | EXPORT_SYMBOL(hid_sensor_remove_trigger); | 73 | EXPORT_SYMBOL(hid_sensor_remove_trigger); |
| 65 | 74 | ||
| @@ -90,7 +99,7 @@ int hid_sensor_setup_trigger(struct iio_dev *indio_dev, const char *name, | |||
| 90 | dev_err(&indio_dev->dev, "Trigger Register Failed\n"); | 99 | dev_err(&indio_dev->dev, "Trigger Register Failed\n"); |
| 91 | goto error_free_trig; | 100 | goto error_free_trig; |
| 92 | } | 101 | } |
| 93 | indio_dev->trig = trig; | 102 | indio_dev->trig = attrb->trigger = trig; |
| 94 | 103 | ||
| 95 | return ret; | 104 | return ret; |
| 96 | 105 | ||
diff --git a/drivers/iio/common/hid-sensors/hid-sensor-trigger.h b/drivers/iio/common/hid-sensors/hid-sensor-trigger.h index 9a8731478eda..ca02f7811aa8 100644 --- a/drivers/iio/common/hid-sensors/hid-sensor-trigger.h +++ b/drivers/iio/common/hid-sensors/hid-sensor-trigger.h | |||
| @@ -21,6 +21,6 @@ | |||
| 21 | 21 | ||
| 22 | int hid_sensor_setup_trigger(struct iio_dev *indio_dev, const char *name, | 22 | int hid_sensor_setup_trigger(struct iio_dev *indio_dev, const char *name, |
| 23 | struct hid_sensor_common *attrb); | 23 | struct hid_sensor_common *attrb); |
| 24 | void hid_sensor_remove_trigger(struct iio_dev *indio_dev); | 24 | void hid_sensor_remove_trigger(struct hid_sensor_common *attrb); |
| 25 | 25 | ||
| 26 | #endif | 26 | #endif |
diff --git a/drivers/iio/gyro/hid-sensor-gyro-3d.c b/drivers/iio/gyro/hid-sensor-gyro-3d.c index ea01c6bcfb56..e54f0f4959d3 100644 --- a/drivers/iio/gyro/hid-sensor-gyro-3d.c +++ b/drivers/iio/gyro/hid-sensor-gyro-3d.c | |||
| @@ -348,7 +348,7 @@ static int hid_gyro_3d_probe(struct platform_device *pdev) | |||
| 348 | error_iio_unreg: | 348 | error_iio_unreg: |
| 349 | iio_device_unregister(indio_dev); | 349 | iio_device_unregister(indio_dev); |
| 350 | error_remove_trigger: | 350 | error_remove_trigger: |
| 351 | hid_sensor_remove_trigger(indio_dev); | 351 | hid_sensor_remove_trigger(&gyro_state->common_attributes); |
| 352 | error_unreg_buffer_funcs: | 352 | error_unreg_buffer_funcs: |
| 353 | iio_triggered_buffer_cleanup(indio_dev); | 353 | iio_triggered_buffer_cleanup(indio_dev); |
| 354 | error_free_dev_mem: | 354 | error_free_dev_mem: |
| @@ -361,10 +361,11 @@ static int hid_gyro_3d_remove(struct platform_device *pdev) | |||
| 361 | { | 361 | { |
| 362 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; | 362 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; |
| 363 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); | 363 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); |
| 364 | struct gyro_3d_state *gyro_state = iio_priv(indio_dev); | ||
| 364 | 365 | ||
| 365 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_GYRO_3D); | 366 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_GYRO_3D); |
| 366 | iio_device_unregister(indio_dev); | 367 | iio_device_unregister(indio_dev); |
| 367 | hid_sensor_remove_trigger(indio_dev); | 368 | hid_sensor_remove_trigger(&gyro_state->common_attributes); |
| 368 | iio_triggered_buffer_cleanup(indio_dev); | 369 | iio_triggered_buffer_cleanup(indio_dev); |
| 369 | kfree(indio_dev->channels); | 370 | kfree(indio_dev->channels); |
| 370 | 371 | ||
diff --git a/drivers/iio/light/Kconfig b/drivers/iio/light/Kconfig index f98c2b509254..a022f27c6690 100644 --- a/drivers/iio/light/Kconfig +++ b/drivers/iio/light/Kconfig | |||
| @@ -43,6 +43,7 @@ config GP2AP020A00F | |||
| 43 | depends on I2C | 43 | depends on I2C |
| 44 | select IIO_BUFFER | 44 | select IIO_BUFFER |
| 45 | select IIO_TRIGGERED_BUFFER | 45 | select IIO_TRIGGERED_BUFFER |
| 46 | select IRQ_WORK | ||
| 46 | help | 47 | help |
| 47 | Say Y here if you have a Sharp GP2AP020A00F proximity/ALS combo-chip | 48 | Say Y here if you have a Sharp GP2AP020A00F proximity/ALS combo-chip |
| 48 | hooked to an I2C bus. | 49 | hooked to an I2C bus. |
| @@ -81,6 +82,8 @@ config SENSORS_LM3533 | |||
| 81 | config TCS3472 | 82 | config TCS3472 |
| 82 | tristate "TAOS TCS3472 color light-to-digital converter" | 83 | tristate "TAOS TCS3472 color light-to-digital converter" |
| 83 | depends on I2C | 84 | depends on I2C |
| 85 | select IIO_BUFFER | ||
| 86 | select IIO_TRIGGERED_BUFFER | ||
| 84 | help | 87 | help |
| 85 | If you say yes here you get support for the TAOS TCS3472 | 88 | If you say yes here you get support for the TAOS TCS3472 |
| 86 | family of color light-to-digital converters with IR filter. | 89 | family of color light-to-digital converters with IR filter. |
diff --git a/drivers/iio/light/hid-sensor-als.c b/drivers/iio/light/hid-sensor-als.c index fa6ae8cf89ea..8e8b9d722853 100644 --- a/drivers/iio/light/hid-sensor-als.c +++ b/drivers/iio/light/hid-sensor-als.c | |||
| @@ -314,7 +314,7 @@ static int hid_als_probe(struct platform_device *pdev) | |||
| 314 | error_iio_unreg: | 314 | error_iio_unreg: |
| 315 | iio_device_unregister(indio_dev); | 315 | iio_device_unregister(indio_dev); |
| 316 | error_remove_trigger: | 316 | error_remove_trigger: |
| 317 | hid_sensor_remove_trigger(indio_dev); | 317 | hid_sensor_remove_trigger(&als_state->common_attributes); |
| 318 | error_unreg_buffer_funcs: | 318 | error_unreg_buffer_funcs: |
| 319 | iio_triggered_buffer_cleanup(indio_dev); | 319 | iio_triggered_buffer_cleanup(indio_dev); |
| 320 | error_free_dev_mem: | 320 | error_free_dev_mem: |
| @@ -327,10 +327,11 @@ static int hid_als_remove(struct platform_device *pdev) | |||
| 327 | { | 327 | { |
| 328 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; | 328 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; |
| 329 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); | 329 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); |
| 330 | struct als_state *als_state = iio_priv(indio_dev); | ||
| 330 | 331 | ||
| 331 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_ALS); | 332 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_ALS); |
| 332 | iio_device_unregister(indio_dev); | 333 | iio_device_unregister(indio_dev); |
| 333 | hid_sensor_remove_trigger(indio_dev); | 334 | hid_sensor_remove_trigger(&als_state->common_attributes); |
| 334 | iio_triggered_buffer_cleanup(indio_dev); | 335 | iio_triggered_buffer_cleanup(indio_dev); |
| 335 | kfree(indio_dev->channels); | 336 | kfree(indio_dev->channels); |
| 336 | 337 | ||
diff --git a/drivers/iio/magnetometer/Kconfig b/drivers/iio/magnetometer/Kconfig index 0cf09637b35b..d86d226dcd67 100644 --- a/drivers/iio/magnetometer/Kconfig +++ b/drivers/iio/magnetometer/Kconfig | |||
| @@ -19,6 +19,8 @@ config AK8975 | |||
| 19 | config MAG3110 | 19 | config MAG3110 |
| 20 | tristate "Freescale MAG3110 3-Axis Magnetometer" | 20 | tristate "Freescale MAG3110 3-Axis Magnetometer" |
| 21 | depends on I2C | 21 | depends on I2C |
| 22 | select IIO_BUFFER | ||
| 23 | select IIO_TRIGGERED_BUFFER | ||
| 22 | help | 24 | help |
| 23 | Say yes here to build support for the Freescale MAG3110 3-Axis | 25 | Say yes here to build support for the Freescale MAG3110 3-Axis |
| 24 | magnetometer. | 26 | magnetometer. |
diff --git a/drivers/iio/magnetometer/hid-sensor-magn-3d.c b/drivers/iio/magnetometer/hid-sensor-magn-3d.c index 2634920562fb..b26e1028a0a0 100644 --- a/drivers/iio/magnetometer/hid-sensor-magn-3d.c +++ b/drivers/iio/magnetometer/hid-sensor-magn-3d.c | |||
| @@ -351,7 +351,7 @@ static int hid_magn_3d_probe(struct platform_device *pdev) | |||
| 351 | error_iio_unreg: | 351 | error_iio_unreg: |
| 352 | iio_device_unregister(indio_dev); | 352 | iio_device_unregister(indio_dev); |
| 353 | error_remove_trigger: | 353 | error_remove_trigger: |
| 354 | hid_sensor_remove_trigger(indio_dev); | 354 | hid_sensor_remove_trigger(&magn_state->common_attributes); |
| 355 | error_unreg_buffer_funcs: | 355 | error_unreg_buffer_funcs: |
| 356 | iio_triggered_buffer_cleanup(indio_dev); | 356 | iio_triggered_buffer_cleanup(indio_dev); |
| 357 | error_free_dev_mem: | 357 | error_free_dev_mem: |
| @@ -364,10 +364,11 @@ static int hid_magn_3d_remove(struct platform_device *pdev) | |||
| 364 | { | 364 | { |
| 365 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; | 365 | struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data; |
| 366 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); | 366 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); |
| 367 | struct magn_3d_state *magn_state = iio_priv(indio_dev); | ||
| 367 | 368 | ||
| 368 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_COMPASS_3D); | 369 | sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_COMPASS_3D); |
| 369 | iio_device_unregister(indio_dev); | 370 | iio_device_unregister(indio_dev); |
| 370 | hid_sensor_remove_trigger(indio_dev); | 371 | hid_sensor_remove_trigger(&magn_state->common_attributes); |
| 371 | iio_triggered_buffer_cleanup(indio_dev); | 372 | iio_triggered_buffer_cleanup(indio_dev); |
| 372 | kfree(indio_dev->channels); | 373 | kfree(indio_dev->channels); |
| 373 | 374 | ||
diff --git a/drivers/iio/magnetometer/mag3110.c b/drivers/iio/magnetometer/mag3110.c index 783c5b417356..becf54496967 100644 --- a/drivers/iio/magnetometer/mag3110.c +++ b/drivers/iio/magnetometer/mag3110.c | |||
| @@ -250,7 +250,12 @@ done: | |||
| 250 | .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SAMP_FREQ) | \ | 250 | .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SAMP_FREQ) | \ |
| 251 | BIT(IIO_CHAN_INFO_SCALE), \ | 251 | BIT(IIO_CHAN_INFO_SCALE), \ |
| 252 | .scan_index = idx, \ | 252 | .scan_index = idx, \ |
| 253 | .scan_type = IIO_ST('s', 16, 16, IIO_BE), \ | 253 | .scan_type = { \ |
| 254 | .sign = 's', \ | ||
| 255 | .realbits = 16, \ | ||
| 256 | .storagebits = 16, \ | ||
| 257 | .endianness = IIO_BE, \ | ||
| 258 | }, \ | ||
| 254 | } | 259 | } |
| 255 | 260 | ||
| 256 | static const struct iio_chan_spec mag3110_channels[] = { | 261 | static const struct iio_chan_spec mag3110_channels[] = { |
diff --git a/drivers/input/keyboard/adp5588-keys.c b/drivers/input/keyboard/adp5588-keys.c index dbd2047f1641..3ed23513d881 100644 --- a/drivers/input/keyboard/adp5588-keys.c +++ b/drivers/input/keyboard/adp5588-keys.c | |||
| @@ -536,7 +536,8 @@ static int adp5588_probe(struct i2c_client *client, | |||
| 536 | __set_bit(EV_REP, input->evbit); | 536 | __set_bit(EV_REP, input->evbit); |
| 537 | 537 | ||
| 538 | for (i = 0; i < input->keycodemax; i++) | 538 | for (i = 0; i < input->keycodemax; i++) |
| 539 | __set_bit(kpad->keycode[i] & KEY_MAX, input->keybit); | 539 | if (kpad->keycode[i] <= KEY_MAX) |
| 540 | __set_bit(kpad->keycode[i], input->keybit); | ||
| 540 | __clear_bit(KEY_RESERVED, input->keybit); | 541 | __clear_bit(KEY_RESERVED, input->keybit); |
| 541 | 542 | ||
| 542 | if (kpad->gpimapsize) | 543 | if (kpad->gpimapsize) |
diff --git a/drivers/input/keyboard/adp5589-keys.c b/drivers/input/keyboard/adp5589-keys.c index 67d12b3427c9..60dafd4fa692 100644 --- a/drivers/input/keyboard/adp5589-keys.c +++ b/drivers/input/keyboard/adp5589-keys.c | |||
| @@ -992,7 +992,8 @@ static int adp5589_probe(struct i2c_client *client, | |||
| 992 | __set_bit(EV_REP, input->evbit); | 992 | __set_bit(EV_REP, input->evbit); |
| 993 | 993 | ||
| 994 | for (i = 0; i < input->keycodemax; i++) | 994 | for (i = 0; i < input->keycodemax; i++) |
| 995 | __set_bit(kpad->keycode[i] & KEY_MAX, input->keybit); | 995 | if (kpad->keycode[i] <= KEY_MAX) |
| 996 | __set_bit(kpad->keycode[i], input->keybit); | ||
| 996 | __clear_bit(KEY_RESERVED, input->keybit); | 997 | __clear_bit(KEY_RESERVED, input->keybit); |
| 997 | 998 | ||
| 998 | if (kpad->gpimapsize) | 999 | if (kpad->gpimapsize) |
diff --git a/drivers/input/keyboard/bf54x-keys.c b/drivers/input/keyboard/bf54x-keys.c index fc88fb48d70d..09b91d093087 100644 --- a/drivers/input/keyboard/bf54x-keys.c +++ b/drivers/input/keyboard/bf54x-keys.c | |||
| @@ -289,7 +289,8 @@ static int bfin_kpad_probe(struct platform_device *pdev) | |||
| 289 | __set_bit(EV_REP, input->evbit); | 289 | __set_bit(EV_REP, input->evbit); |
| 290 | 290 | ||
| 291 | for (i = 0; i < input->keycodemax; i++) | 291 | for (i = 0; i < input->keycodemax; i++) |
| 292 | __set_bit(bf54x_kpad->keycode[i] & KEY_MAX, input->keybit); | 292 | if (bf54x_kpad->keycode[i] <= KEY_MAX) |
| 293 | __set_bit(bf54x_kpad->keycode[i], input->keybit); | ||
| 293 | __clear_bit(KEY_RESERVED, input->keybit); | 294 | __clear_bit(KEY_RESERVED, input->keybit); |
| 294 | 295 | ||
| 295 | error = input_register_device(input); | 296 | error = input_register_device(input); |
diff --git a/drivers/input/misc/adxl34x.c b/drivers/input/misc/adxl34x.c index 0735de3a6468..1cb1da294419 100644 --- a/drivers/input/misc/adxl34x.c +++ b/drivers/input/misc/adxl34x.c | |||
| @@ -158,7 +158,7 @@ | |||
| 158 | 158 | ||
| 159 | /* ORIENT ADXL346 only */ | 159 | /* ORIENT ADXL346 only */ |
| 160 | #define ADXL346_2D_VALID (1 << 6) | 160 | #define ADXL346_2D_VALID (1 << 6) |
| 161 | #define ADXL346_2D_ORIENT(x) (((x) & 0x3) >> 4) | 161 | #define ADXL346_2D_ORIENT(x) (((x) & 0x30) >> 4) |
| 162 | #define ADXL346_3D_VALID (1 << 3) | 162 | #define ADXL346_3D_VALID (1 << 3) |
| 163 | #define ADXL346_3D_ORIENT(x) ((x) & 0x7) | 163 | #define ADXL346_3D_ORIENT(x) ((x) & 0x7) |
| 164 | #define ADXL346_2D_PORTRAIT_POS 0 /* +X */ | 164 | #define ADXL346_2D_PORTRAIT_POS 0 /* +X */ |
diff --git a/drivers/input/misc/hp_sdc_rtc.c b/drivers/input/misc/hp_sdc_rtc.c index 86b822806e95..45e0e3e55de2 100644 --- a/drivers/input/misc/hp_sdc_rtc.c +++ b/drivers/input/misc/hp_sdc_rtc.c | |||
| @@ -180,7 +180,10 @@ static int64_t hp_sdc_rtc_read_i8042timer (uint8_t loadcmd, int numreg) | |||
| 180 | if (WARN_ON(down_interruptible(&i8042tregs))) | 180 | if (WARN_ON(down_interruptible(&i8042tregs))) |
| 181 | return -1; | 181 | return -1; |
| 182 | 182 | ||
| 183 | if (hp_sdc_enqueue_transaction(&t)) return -1; | 183 | if (hp_sdc_enqueue_transaction(&t)) { |
| 184 | up(&i8042tregs); | ||
| 185 | return -1; | ||
| 186 | } | ||
| 184 | 187 | ||
| 185 | /* Sleep until results come back. */ | 188 | /* Sleep until results come back. */ |
| 186 | if (WARN_ON(down_interruptible(&i8042tregs))) | 189 | if (WARN_ON(down_interruptible(&i8042tregs))) |
diff --git a/drivers/input/misc/pcf8574_keypad.c b/drivers/input/misc/pcf8574_keypad.c index e37392976fdd..0deca5a3c87f 100644 --- a/drivers/input/misc/pcf8574_keypad.c +++ b/drivers/input/misc/pcf8574_keypad.c | |||
| @@ -113,9 +113,12 @@ static int pcf8574_kp_probe(struct i2c_client *client, const struct i2c_device_i | |||
| 113 | idev->keycodemax = ARRAY_SIZE(lp->btncode); | 113 | idev->keycodemax = ARRAY_SIZE(lp->btncode); |
| 114 | 114 | ||
| 115 | for (i = 0; i < ARRAY_SIZE(pcf8574_kp_btncode); i++) { | 115 | for (i = 0; i < ARRAY_SIZE(pcf8574_kp_btncode); i++) { |
| 116 | lp->btncode[i] = pcf8574_kp_btncode[i]; | 116 | if (lp->btncode[i] <= KEY_MAX) { |
| 117 | __set_bit(lp->btncode[i] & KEY_MAX, idev->keybit); | 117 | lp->btncode[i] = pcf8574_kp_btncode[i]; |
| 118 | __set_bit(lp->btncode[i], idev->keybit); | ||
| 119 | } | ||
| 118 | } | 120 | } |
| 121 | __clear_bit(KEY_RESERVED, idev->keybit); | ||
| 119 | 122 | ||
| 120 | sprintf(lp->name, DRV_NAME); | 123 | sprintf(lp->name, DRV_NAME); |
| 121 | sprintf(lp->phys, "kp_data/input0"); | 124 | sprintf(lp->phys, "kp_data/input0"); |
diff --git a/drivers/input/mouse/alps.c b/drivers/input/mouse/alps.c index ca7a26f1dce8..5cf62e315218 100644 --- a/drivers/input/mouse/alps.c +++ b/drivers/input/mouse/alps.c | |||
| @@ -70,6 +70,25 @@ static const struct alps_nibble_commands alps_v4_nibble_commands[] = { | |||
| 70 | { PSMOUSE_CMD_SETSCALE11, 0x00 }, /* f */ | 70 | { PSMOUSE_CMD_SETSCALE11, 0x00 }, /* f */ |
| 71 | }; | 71 | }; |
| 72 | 72 | ||
| 73 | static const struct alps_nibble_commands alps_v6_nibble_commands[] = { | ||
| 74 | { PSMOUSE_CMD_ENABLE, 0x00 }, /* 0 */ | ||
| 75 | { PSMOUSE_CMD_SETRATE, 0x0a }, /* 1 */ | ||
| 76 | { PSMOUSE_CMD_SETRATE, 0x14 }, /* 2 */ | ||
| 77 | { PSMOUSE_CMD_SETRATE, 0x28 }, /* 3 */ | ||
| 78 | { PSMOUSE_CMD_SETRATE, 0x3c }, /* 4 */ | ||
| 79 | { PSMOUSE_CMD_SETRATE, 0x50 }, /* 5 */ | ||
| 80 | { PSMOUSE_CMD_SETRATE, 0x64 }, /* 6 */ | ||
| 81 | { PSMOUSE_CMD_SETRATE, 0xc8 }, /* 7 */ | ||
| 82 | { PSMOUSE_CMD_GETID, 0x00 }, /* 8 */ | ||
| 83 | { PSMOUSE_CMD_GETINFO, 0x00 }, /* 9 */ | ||
| 84 | { PSMOUSE_CMD_SETRES, 0x00 }, /* a */ | ||
| 85 | { PSMOUSE_CMD_SETRES, 0x01 }, /* b */ | ||
| 86 | { PSMOUSE_CMD_SETRES, 0x02 }, /* c */ | ||
| 87 | { PSMOUSE_CMD_SETRES, 0x03 }, /* d */ | ||
| 88 | { PSMOUSE_CMD_SETSCALE21, 0x00 }, /* e */ | ||
| 89 | { PSMOUSE_CMD_SETSCALE11, 0x00 }, /* f */ | ||
| 90 | }; | ||
| 91 | |||
| 73 | 92 | ||
| 74 | #define ALPS_DUALPOINT 0x02 /* touchpad has trackstick */ | 93 | #define ALPS_DUALPOINT 0x02 /* touchpad has trackstick */ |
| 75 | #define ALPS_PASS 0x04 /* device has a pass-through port */ | 94 | #define ALPS_PASS 0x04 /* device has a pass-through port */ |
| @@ -103,6 +122,7 @@ static const struct alps_model_info alps_model_data[] = { | |||
| 103 | /* Dell Latitude E5500, E6400, E6500, Precision M4400 */ | 122 | /* Dell Latitude E5500, E6400, E6500, Precision M4400 */ |
| 104 | { { 0x62, 0x02, 0x14 }, 0x00, ALPS_PROTO_V2, 0xcf, 0xcf, | 123 | { { 0x62, 0x02, 0x14 }, 0x00, ALPS_PROTO_V2, 0xcf, 0xcf, |
| 105 | ALPS_PASS | ALPS_DUALPOINT | ALPS_PS2_INTERLEAVED }, | 124 | ALPS_PASS | ALPS_DUALPOINT | ALPS_PS2_INTERLEAVED }, |
| 125 | { { 0x73, 0x00, 0x14 }, 0x00, ALPS_PROTO_V6, 0xff, 0xff, ALPS_DUALPOINT }, /* Dell XT2 */ | ||
| 106 | { { 0x73, 0x02, 0x50 }, 0x00, ALPS_PROTO_V2, 0xcf, 0xcf, ALPS_FOUR_BUTTONS }, /* Dell Vostro 1400 */ | 126 | { { 0x73, 0x02, 0x50 }, 0x00, ALPS_PROTO_V2, 0xcf, 0xcf, ALPS_FOUR_BUTTONS }, /* Dell Vostro 1400 */ |
| 107 | { { 0x52, 0x01, 0x14 }, 0x00, ALPS_PROTO_V2, 0xff, 0xff, | 127 | { { 0x52, 0x01, 0x14 }, 0x00, ALPS_PROTO_V2, 0xff, 0xff, |
| 108 | ALPS_PASS | ALPS_DUALPOINT | ALPS_PS2_INTERLEAVED }, /* Toshiba Tecra A11-11L */ | 128 | ALPS_PASS | ALPS_DUALPOINT | ALPS_PS2_INTERLEAVED }, /* Toshiba Tecra A11-11L */ |
| @@ -645,6 +665,76 @@ static void alps_process_packet_v3(struct psmouse *psmouse) | |||
| 645 | alps_process_touchpad_packet_v3(psmouse); | 665 | alps_process_touchpad_packet_v3(psmouse); |
| 646 | } | 666 | } |
| 647 | 667 | ||
| 668 | static void alps_process_packet_v6(struct psmouse *psmouse) | ||
| 669 | { | ||
| 670 | struct alps_data *priv = psmouse->private; | ||
| 671 | unsigned char *packet = psmouse->packet; | ||
| 672 | struct input_dev *dev = psmouse->dev; | ||
| 673 | struct input_dev *dev2 = priv->dev2; | ||
| 674 | int x, y, z, left, right, middle; | ||
| 675 | |||
| 676 | /* | ||
| 677 | * We can use Byte5 to distinguish if the packet is from Touchpad | ||
| 678 | * or Trackpoint. | ||
| 679 | * Touchpad: 0 - 0x7E | ||
| 680 | * Trackpoint: 0x7F | ||
| 681 | */ | ||
| 682 | if (packet[5] == 0x7F) { | ||
| 683 | /* It should be a DualPoint when received Trackpoint packet */ | ||
| 684 | if (!(priv->flags & ALPS_DUALPOINT)) | ||
| 685 | return; | ||
| 686 | |||
| 687 | /* Trackpoint packet */ | ||
| 688 | x = packet[1] | ((packet[3] & 0x20) << 2); | ||
| 689 | y = packet[2] | ((packet[3] & 0x40) << 1); | ||
| 690 | z = packet[4]; | ||
| 691 | left = packet[3] & 0x01; | ||
| 692 | right = packet[3] & 0x02; | ||
| 693 | middle = packet[3] & 0x04; | ||
| 694 | |||
| 695 | /* To prevent the cursor jump when finger lifted */ | ||
| 696 | if (x == 0x7F && y == 0x7F && z == 0x7F) | ||
| 697 | x = y = z = 0; | ||
| 698 | |||
| 699 | /* Divide 4 since trackpoint's speed is too fast */ | ||
| 700 | input_report_rel(dev2, REL_X, (char)x / 4); | ||
| 701 | input_report_rel(dev2, REL_Y, -((char)y / 4)); | ||
| 702 | |||
| 703 | input_report_key(dev2, BTN_LEFT, left); | ||
| 704 | input_report_key(dev2, BTN_RIGHT, right); | ||
| 705 | input_report_key(dev2, BTN_MIDDLE, middle); | ||
| 706 | |||
| 707 | input_sync(dev2); | ||
| 708 | return; | ||
| 709 | } | ||
| 710 | |||
| 711 | /* Touchpad packet */ | ||
| 712 | x = packet[1] | ((packet[3] & 0x78) << 4); | ||
| 713 | y = packet[2] | ((packet[4] & 0x78) << 4); | ||
| 714 | z = packet[5]; | ||
| 715 | left = packet[3] & 0x01; | ||
| 716 | right = packet[3] & 0x02; | ||
| 717 | |||
| 718 | if (z > 30) | ||
| 719 | input_report_key(dev, BTN_TOUCH, 1); | ||
| 720 | if (z < 25) | ||
| 721 | input_report_key(dev, BTN_TOUCH, 0); | ||
| 722 | |||
| 723 | if (z > 0) { | ||
| 724 | input_report_abs(dev, ABS_X, x); | ||
| 725 | input_report_abs(dev, ABS_Y, y); | ||
| 726 | } | ||
| 727 | |||
| 728 | input_report_abs(dev, ABS_PRESSURE, z); | ||
| 729 | input_report_key(dev, BTN_TOOL_FINGER, z > 0); | ||
| 730 | |||
| 731 | /* v6 touchpad does not have middle button */ | ||
| 732 | input_report_key(dev, BTN_LEFT, left); | ||
| 733 | input_report_key(dev, BTN_RIGHT, right); | ||
| 734 | |||
| 735 | input_sync(dev); | ||
| 736 | } | ||
| 737 | |||
| 648 | static void alps_process_packet_v4(struct psmouse *psmouse) | 738 | static void alps_process_packet_v4(struct psmouse *psmouse) |
| 649 | { | 739 | { |
| 650 | struct alps_data *priv = psmouse->private; | 740 | struct alps_data *priv = psmouse->private; |
| @@ -897,7 +987,7 @@ static psmouse_ret_t alps_process_byte(struct psmouse *psmouse) | |||
| 897 | } | 987 | } |
| 898 | 988 | ||
| 899 | /* Bytes 2 - pktsize should have 0 in the highest bit */ | 989 | /* Bytes 2 - pktsize should have 0 in the highest bit */ |
| 900 | if (priv->proto_version != ALPS_PROTO_V5 && | 990 | if ((priv->proto_version < ALPS_PROTO_V5) && |
| 901 | psmouse->pktcnt >= 2 && psmouse->pktcnt <= psmouse->pktsize && | 991 | psmouse->pktcnt >= 2 && psmouse->pktcnt <= psmouse->pktsize && |
| 902 | (psmouse->packet[psmouse->pktcnt - 1] & 0x80)) { | 992 | (psmouse->packet[psmouse->pktcnt - 1] & 0x80)) { |
| 903 | psmouse_dbg(psmouse, "refusing packet[%i] = %x\n", | 993 | psmouse_dbg(psmouse, "refusing packet[%i] = %x\n", |
| @@ -1085,6 +1175,80 @@ static int alps_absolute_mode_v1_v2(struct psmouse *psmouse) | |||
| 1085 | return ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETPOLL); | 1175 | return ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETPOLL); |
| 1086 | } | 1176 | } |
| 1087 | 1177 | ||
| 1178 | static int alps_monitor_mode_send_word(struct psmouse *psmouse, u16 word) | ||
| 1179 | { | ||
| 1180 | int i, nibble; | ||
| 1181 | |||
| 1182 | /* | ||
| 1183 | * b0-b11 are valid bits, send sequence is inverse. | ||
| 1184 | * e.g. when word = 0x0123, nibble send sequence is 3, 2, 1 | ||
| 1185 | */ | ||
| 1186 | for (i = 0; i <= 8; i += 4) { | ||
| 1187 | nibble = (word >> i) & 0xf; | ||
| 1188 | if (alps_command_mode_send_nibble(psmouse, nibble)) | ||
| 1189 | return -1; | ||
| 1190 | } | ||
| 1191 | |||
| 1192 | return 0; | ||
| 1193 | } | ||
| 1194 | |||
| 1195 | static int alps_monitor_mode_write_reg(struct psmouse *psmouse, | ||
| 1196 | u16 addr, u16 value) | ||
| 1197 | { | ||
| 1198 | struct ps2dev *ps2dev = &psmouse->ps2dev; | ||
| 1199 | |||
| 1200 | /* 0x0A0 is the command to write the word */ | ||
| 1201 | if (ps2_command(ps2dev, NULL, PSMOUSE_CMD_ENABLE) || | ||
| 1202 | alps_monitor_mode_send_word(psmouse, 0x0A0) || | ||
| 1203 | alps_monitor_mode_send_word(psmouse, addr) || | ||
| 1204 | alps_monitor_mode_send_word(psmouse, value) || | ||
| 1205 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_DISABLE)) | ||
| 1206 | return -1; | ||
| 1207 | |||
| 1208 | return 0; | ||
| 1209 | } | ||
| 1210 | |||
| 1211 | static int alps_monitor_mode(struct psmouse *psmouse, bool enable) | ||
| 1212 | { | ||
| 1213 | struct ps2dev *ps2dev = &psmouse->ps2dev; | ||
| 1214 | |||
| 1215 | if (enable) { | ||
| 1216 | /* EC E9 F5 F5 E7 E6 E7 E9 to enter monitor mode */ | ||
| 1217 | if (ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP) || | ||
| 1218 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_GETINFO) || | ||
| 1219 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_DISABLE) || | ||
| 1220 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_DISABLE) || | ||
| 1221 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21) || | ||
| 1222 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || | ||
| 1223 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE21) || | ||
| 1224 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_GETINFO)) | ||
| 1225 | return -1; | ||
| 1226 | } else { | ||
| 1227 | /* EC to exit monitor mode */ | ||
| 1228 | if (ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_WRAP)) | ||
| 1229 | return -1; | ||
| 1230 | } | ||
| 1231 | |||
| 1232 | return 0; | ||
| 1233 | } | ||
| 1234 | |||
| 1235 | static int alps_absolute_mode_v6(struct psmouse *psmouse) | ||
| 1236 | { | ||
| 1237 | u16 reg_val = 0x181; | ||
| 1238 | int ret = -1; | ||
| 1239 | |||
| 1240 | /* enter monitor mode, to write the register */ | ||
| 1241 | if (alps_monitor_mode(psmouse, true)) | ||
| 1242 | return -1; | ||
| 1243 | |||
| 1244 | ret = alps_monitor_mode_write_reg(psmouse, 0x000, reg_val); | ||
| 1245 | |||
| 1246 | if (alps_monitor_mode(psmouse, false)) | ||
| 1247 | ret = -1; | ||
| 1248 | |||
| 1249 | return ret; | ||
| 1250 | } | ||
| 1251 | |||
| 1088 | static int alps_get_status(struct psmouse *psmouse, char *param) | 1252 | static int alps_get_status(struct psmouse *psmouse, char *param) |
| 1089 | { | 1253 | { |
| 1090 | /* Get status: 0xF5 0xF5 0xF5 0xE9 */ | 1254 | /* Get status: 0xF5 0xF5 0xF5 0xE9 */ |
| @@ -1189,6 +1353,32 @@ static int alps_hw_init_v1_v2(struct psmouse *psmouse) | |||
| 1189 | return 0; | 1353 | return 0; |
| 1190 | } | 1354 | } |
| 1191 | 1355 | ||
| 1356 | static int alps_hw_init_v6(struct psmouse *psmouse) | ||
| 1357 | { | ||
| 1358 | unsigned char param[2] = {0xC8, 0x14}; | ||
| 1359 | |||
| 1360 | /* Enter passthrough mode to let trackpoint enter 6byte raw mode */ | ||
| 1361 | if (alps_passthrough_mode_v2(psmouse, true)) | ||
| 1362 | return -1; | ||
| 1363 | |||
| 1364 | if (ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || | ||
| 1365 | ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || | ||
| 1366 | ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || | ||
| 1367 | ps2_command(&psmouse->ps2dev, ¶m[0], PSMOUSE_CMD_SETRATE) || | ||
| 1368 | ps2_command(&psmouse->ps2dev, ¶m[1], PSMOUSE_CMD_SETRATE)) | ||
| 1369 | return -1; | ||
| 1370 | |||
| 1371 | if (alps_passthrough_mode_v2(psmouse, false)) | ||
| 1372 | return -1; | ||
| 1373 | |||
| 1374 | if (alps_absolute_mode_v6(psmouse)) { | ||
| 1375 | psmouse_err(psmouse, "Failed to enable absolute mode\n"); | ||
| 1376 | return -1; | ||
| 1377 | } | ||
| 1378 | |||
| 1379 | return 0; | ||
| 1380 | } | ||
| 1381 | |||
| 1192 | /* | 1382 | /* |
| 1193 | * Enable or disable passthrough mode to the trackstick. | 1383 | * Enable or disable passthrough mode to the trackstick. |
| 1194 | */ | 1384 | */ |
| @@ -1553,6 +1743,8 @@ static void alps_set_defaults(struct alps_data *priv) | |||
| 1553 | priv->hw_init = alps_hw_init_v1_v2; | 1743 | priv->hw_init = alps_hw_init_v1_v2; |
| 1554 | priv->process_packet = alps_process_packet_v1_v2; | 1744 | priv->process_packet = alps_process_packet_v1_v2; |
| 1555 | priv->set_abs_params = alps_set_abs_params_st; | 1745 | priv->set_abs_params = alps_set_abs_params_st; |
| 1746 | priv->x_max = 1023; | ||
| 1747 | priv->y_max = 767; | ||
| 1556 | break; | 1748 | break; |
| 1557 | case ALPS_PROTO_V3: | 1749 | case ALPS_PROTO_V3: |
| 1558 | priv->hw_init = alps_hw_init_v3; | 1750 | priv->hw_init = alps_hw_init_v3; |
| @@ -1584,6 +1776,14 @@ static void alps_set_defaults(struct alps_data *priv) | |||
| 1584 | priv->x_bits = 23; | 1776 | priv->x_bits = 23; |
| 1585 | priv->y_bits = 12; | 1777 | priv->y_bits = 12; |
| 1586 | break; | 1778 | break; |
| 1779 | case ALPS_PROTO_V6: | ||
| 1780 | priv->hw_init = alps_hw_init_v6; | ||
| 1781 | priv->process_packet = alps_process_packet_v6; | ||
| 1782 | priv->set_abs_params = alps_set_abs_params_st; | ||
| 1783 | priv->nibble_commands = alps_v6_nibble_commands; | ||
| 1784 | priv->x_max = 2047; | ||
| 1785 | priv->y_max = 1535; | ||
| 1786 | break; | ||
| 1587 | } | 1787 | } |
| 1588 | } | 1788 | } |
| 1589 | 1789 | ||
| @@ -1705,8 +1905,8 @@ static void alps_disconnect(struct psmouse *psmouse) | |||
| 1705 | static void alps_set_abs_params_st(struct alps_data *priv, | 1905 | static void alps_set_abs_params_st(struct alps_data *priv, |
| 1706 | struct input_dev *dev1) | 1906 | struct input_dev *dev1) |
| 1707 | { | 1907 | { |
| 1708 | input_set_abs_params(dev1, ABS_X, 0, 1023, 0, 0); | 1908 | input_set_abs_params(dev1, ABS_X, 0, priv->x_max, 0, 0); |
| 1709 | input_set_abs_params(dev1, ABS_Y, 0, 767, 0, 0); | 1909 | input_set_abs_params(dev1, ABS_Y, 0, priv->y_max, 0, 0); |
| 1710 | } | 1910 | } |
| 1711 | 1911 | ||
| 1712 | static void alps_set_abs_params_mt(struct alps_data *priv, | 1912 | static void alps_set_abs_params_mt(struct alps_data *priv, |
diff --git a/drivers/input/mouse/alps.h b/drivers/input/mouse/alps.h index eee59853b9ce..704f0f924307 100644 --- a/drivers/input/mouse/alps.h +++ b/drivers/input/mouse/alps.h | |||
| @@ -17,6 +17,7 @@ | |||
| 17 | #define ALPS_PROTO_V3 3 | 17 | #define ALPS_PROTO_V3 3 |
| 18 | #define ALPS_PROTO_V4 4 | 18 | #define ALPS_PROTO_V4 4 |
| 19 | #define ALPS_PROTO_V5 5 | 19 | #define ALPS_PROTO_V5 5 |
| 20 | #define ALPS_PROTO_V6 6 | ||
| 20 | 21 | ||
| 21 | /** | 22 | /** |
| 22 | * struct alps_model_info - touchpad ID table | 23 | * struct alps_model_info - touchpad ID table |
diff --git a/drivers/input/mouse/elantech.c b/drivers/input/mouse/elantech.c index 8551dcaf24db..597e9b8fc18d 100644 --- a/drivers/input/mouse/elantech.c +++ b/drivers/input/mouse/elantech.c | |||
| @@ -1313,6 +1313,7 @@ static int elantech_set_properties(struct elantech_data *etd) | |||
| 1313 | break; | 1313 | break; |
| 1314 | case 6: | 1314 | case 6: |
| 1315 | case 7: | 1315 | case 7: |
| 1316 | case 8: | ||
| 1316 | etd->hw_version = 4; | 1317 | etd->hw_version = 4; |
| 1317 | break; | 1318 | break; |
| 1318 | default: | 1319 | default: |
diff --git a/drivers/input/serio/serio.c b/drivers/input/serio/serio.c index 98707fb2cb5d..8f4c4ab04bc2 100644 --- a/drivers/input/serio/serio.c +++ b/drivers/input/serio/serio.c | |||
| @@ -455,16 +455,26 @@ static DEVICE_ATTR_RO(type); | |||
| 455 | static DEVICE_ATTR_RO(proto); | 455 | static DEVICE_ATTR_RO(proto); |
| 456 | static DEVICE_ATTR_RO(id); | 456 | static DEVICE_ATTR_RO(id); |
| 457 | static DEVICE_ATTR_RO(extra); | 457 | static DEVICE_ATTR_RO(extra); |
| 458 | static DEVICE_ATTR_RO(modalias); | ||
| 459 | static DEVICE_ATTR_WO(drvctl); | ||
| 460 | static DEVICE_ATTR(description, S_IRUGO, serio_show_description, NULL); | ||
| 461 | static DEVICE_ATTR(bind_mode, S_IWUSR | S_IRUGO, serio_show_bind_mode, serio_set_bind_mode); | ||
| 462 | 458 | ||
| 463 | static struct attribute *serio_device_id_attrs[] = { | 459 | static struct attribute *serio_device_id_attrs[] = { |
| 464 | &dev_attr_type.attr, | 460 | &dev_attr_type.attr, |
| 465 | &dev_attr_proto.attr, | 461 | &dev_attr_proto.attr, |
| 466 | &dev_attr_id.attr, | 462 | &dev_attr_id.attr, |
| 467 | &dev_attr_extra.attr, | 463 | &dev_attr_extra.attr, |
| 464 | NULL | ||
| 465 | }; | ||
| 466 | |||
| 467 | static struct attribute_group serio_id_attr_group = { | ||
| 468 | .name = "id", | ||
| 469 | .attrs = serio_device_id_attrs, | ||
| 470 | }; | ||
| 471 | |||
| 472 | static DEVICE_ATTR_RO(modalias); | ||
| 473 | static DEVICE_ATTR_WO(drvctl); | ||
| 474 | static DEVICE_ATTR(description, S_IRUGO, serio_show_description, NULL); | ||
| 475 | static DEVICE_ATTR(bind_mode, S_IWUSR | S_IRUGO, serio_show_bind_mode, serio_set_bind_mode); | ||
| 476 | |||
| 477 | static struct attribute *serio_device_attrs[] = { | ||
| 468 | &dev_attr_modalias.attr, | 478 | &dev_attr_modalias.attr, |
| 469 | &dev_attr_description.attr, | 479 | &dev_attr_description.attr, |
| 470 | &dev_attr_drvctl.attr, | 480 | &dev_attr_drvctl.attr, |
| @@ -472,13 +482,13 @@ static struct attribute *serio_device_id_attrs[] = { | |||
| 472 | NULL | 482 | NULL |
| 473 | }; | 483 | }; |
| 474 | 484 | ||
| 475 | static struct attribute_group serio_id_attr_group = { | 485 | static struct attribute_group serio_device_attr_group = { |
| 476 | .name = "id", | 486 | .attrs = serio_device_attrs, |
| 477 | .attrs = serio_device_id_attrs, | ||
| 478 | }; | 487 | }; |
| 479 | 488 | ||
| 480 | static const struct attribute_group *serio_device_attr_groups[] = { | 489 | static const struct attribute_group *serio_device_attr_groups[] = { |
| 481 | &serio_id_attr_group, | 490 | &serio_id_attr_group, |
| 491 | &serio_device_attr_group, | ||
| 482 | NULL | 492 | NULL |
| 483 | }; | 493 | }; |
| 484 | 494 | ||
diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig index 00d1e547b211..961d58d32647 100644 --- a/drivers/input/touchscreen/Kconfig +++ b/drivers/input/touchscreen/Kconfig | |||
| @@ -906,6 +906,17 @@ config TOUCHSCREEN_STMPE | |||
| 906 | To compile this driver as a module, choose M here: the | 906 | To compile this driver as a module, choose M here: the |
| 907 | module will be called stmpe-ts. | 907 | module will be called stmpe-ts. |
| 908 | 908 | ||
| 909 | config TOUCHSCREEN_SUR40 | ||
| 910 | tristate "Samsung SUR40 (Surface 2.0/PixelSense) touchscreen" | ||
| 911 | depends on USB | ||
| 912 | select INPUT_POLLDEV | ||
| 913 | help | ||
| 914 | Say Y here if you want support for the Samsung SUR40 touchscreen | ||
| 915 | (also known as Microsoft Surface 2.0 or Microsoft PixelSense). | ||
| 916 | |||
| 917 | To compile this driver as a module, choose M here: the | ||
| 918 | module will be called sur40. | ||
| 919 | |||
| 909 | config TOUCHSCREEN_TPS6507X | 920 | config TOUCHSCREEN_TPS6507X |
| 910 | tristate "TPS6507x based touchscreens" | 921 | tristate "TPS6507x based touchscreens" |
| 911 | depends on I2C | 922 | depends on I2C |
diff --git a/drivers/input/touchscreen/Makefile b/drivers/input/touchscreen/Makefile index 7587883b8d38..62801f213346 100644 --- a/drivers/input/touchscreen/Makefile +++ b/drivers/input/touchscreen/Makefile | |||
| @@ -54,6 +54,7 @@ obj-$(CONFIG_TOUCHSCREEN_PIXCIR) += pixcir_i2c_ts.o | |||
| 54 | obj-$(CONFIG_TOUCHSCREEN_S3C2410) += s3c2410_ts.o | 54 | obj-$(CONFIG_TOUCHSCREEN_S3C2410) += s3c2410_ts.o |
| 55 | obj-$(CONFIG_TOUCHSCREEN_ST1232) += st1232.o | 55 | obj-$(CONFIG_TOUCHSCREEN_ST1232) += st1232.o |
| 56 | obj-$(CONFIG_TOUCHSCREEN_STMPE) += stmpe-ts.o | 56 | obj-$(CONFIG_TOUCHSCREEN_STMPE) += stmpe-ts.o |
| 57 | obj-$(CONFIG_TOUCHSCREEN_SUR40) += sur40.o | ||
| 57 | obj-$(CONFIG_TOUCHSCREEN_TI_AM335X_TSC) += ti_am335x_tsc.o | 58 | obj-$(CONFIG_TOUCHSCREEN_TI_AM335X_TSC) += ti_am335x_tsc.o |
| 58 | obj-$(CONFIG_TOUCHSCREEN_TNETV107X) += tnetv107x-ts.o | 59 | obj-$(CONFIG_TOUCHSCREEN_TNETV107X) += tnetv107x-ts.o |
| 59 | obj-$(CONFIG_TOUCHSCREEN_TOUCHIT213) += touchit213.o | 60 | obj-$(CONFIG_TOUCHSCREEN_TOUCHIT213) += touchit213.o |
diff --git a/drivers/input/touchscreen/atmel-wm97xx.c b/drivers/input/touchscreen/atmel-wm97xx.c index 268a35e55d7f..279c0e42b8a7 100644 --- a/drivers/input/touchscreen/atmel-wm97xx.c +++ b/drivers/input/touchscreen/atmel-wm97xx.c | |||
| @@ -391,7 +391,7 @@ static int __exit atmel_wm97xx_remove(struct platform_device *pdev) | |||
| 391 | } | 391 | } |
| 392 | 392 | ||
| 393 | #ifdef CONFIG_PM_SLEEP | 393 | #ifdef CONFIG_PM_SLEEP |
| 394 | static int atmel_wm97xx_suspend(struct *dev) | 394 | static int atmel_wm97xx_suspend(struct device *dev) |
| 395 | { | 395 | { |
| 396 | struct platform_device *pdev = to_platform_device(dev); | 396 | struct platform_device *pdev = to_platform_device(dev); |
| 397 | struct atmel_wm97xx *atmel_wm97xx = platform_get_drvdata(pdev); | 397 | struct atmel_wm97xx *atmel_wm97xx = platform_get_drvdata(pdev); |
diff --git a/drivers/input/touchscreen/cyttsp4_core.c b/drivers/input/touchscreen/cyttsp4_core.c index 42d830efa316..a035a390f8e2 100644 --- a/drivers/input/touchscreen/cyttsp4_core.c +++ b/drivers/input/touchscreen/cyttsp4_core.c | |||
| @@ -1246,8 +1246,7 @@ static void cyttsp4_watchdog_timer(unsigned long handle) | |||
| 1246 | 1246 | ||
| 1247 | dev_vdbg(cd->dev, "%s: Watchdog timer triggered\n", __func__); | 1247 | dev_vdbg(cd->dev, "%s: Watchdog timer triggered\n", __func__); |
| 1248 | 1248 | ||
| 1249 | if (!work_pending(&cd->watchdog_work)) | 1249 | schedule_work(&cd->watchdog_work); |
| 1250 | schedule_work(&cd->watchdog_work); | ||
| 1251 | 1250 | ||
| 1252 | return; | 1251 | return; |
| 1253 | } | 1252 | } |
diff --git a/drivers/input/touchscreen/sur40.c b/drivers/input/touchscreen/sur40.c new file mode 100644 index 000000000000..f1cb05148b46 --- /dev/null +++ b/drivers/input/touchscreen/sur40.c | |||
| @@ -0,0 +1,466 @@ | |||
| 1 | /* | ||
| 2 | * Surface2.0/SUR40/PixelSense input driver | ||
| 3 | * | ||
| 4 | * Copyright (c) 2013 by Florian 'floe' Echtler <floe@butterbrot.org> | ||
| 5 | * | ||
| 6 | * Derived from the USB Skeleton driver 1.1, | ||
| 7 | * Copyright (c) 2003 Greg Kroah-Hartman (greg@kroah.com) | ||
| 8 | * | ||
| 9 | * and from the Apple USB BCM5974 multitouch driver, | ||
| 10 | * Copyright (c) 2008 Henrik Rydberg (rydberg@euromail.se) | ||
| 11 | * | ||
| 12 | * and from the generic hid-multitouch driver, | ||
| 13 | * Copyright (c) 2010-2012 Stephane Chatty <chatty@enac.fr> | ||
| 14 | * | ||
| 15 | * This program is free software; you can redistribute it and/or | ||
| 16 | * modify it under the terms of the GNU General Public License as | ||
| 17 | * published by the Free Software Foundation; either version 2 of | ||
| 18 | * the License, or (at your option) any later version. | ||
| 19 | */ | ||
| 20 | |||
| 21 | #include <linux/kernel.h> | ||
| 22 | #include <linux/errno.h> | ||
| 23 | #include <linux/delay.h> | ||
| 24 | #include <linux/init.h> | ||
| 25 | #include <linux/slab.h> | ||
| 26 | #include <linux/module.h> | ||
| 27 | #include <linux/completion.h> | ||
| 28 | #include <linux/uaccess.h> | ||
| 29 | #include <linux/usb.h> | ||
| 30 | #include <linux/printk.h> | ||
| 31 | #include <linux/input-polldev.h> | ||
| 32 | #include <linux/input/mt.h> | ||
| 33 | #include <linux/usb/input.h> | ||
| 34 | |||
| 35 | /* read 512 bytes from endpoint 0x86 -> get header + blobs */ | ||
| 36 | struct sur40_header { | ||
| 37 | |||
| 38 | __le16 type; /* always 0x0001 */ | ||
| 39 | __le16 count; /* count of blobs (if 0: continue prev. packet) */ | ||
| 40 | |||
| 41 | __le32 packet_id; /* unique ID for all packets in one frame */ | ||
| 42 | |||
| 43 | __le32 timestamp; /* milliseconds (inc. by 16 or 17 each frame) */ | ||
| 44 | __le32 unknown; /* "epoch?" always 02/03 00 00 00 */ | ||
| 45 | |||
| 46 | } __packed; | ||
| 47 | |||
| 48 | struct sur40_blob { | ||
| 49 | |||
| 50 | __le16 blob_id; | ||
| 51 | |||
| 52 | u8 action; /* 0x02 = enter/exit, 0x03 = update (?) */ | ||
| 53 | u8 unknown; /* always 0x01 or 0x02 (no idea what this is?) */ | ||
| 54 | |||
| 55 | __le16 bb_pos_x; /* upper left corner of bounding box */ | ||
| 56 | __le16 bb_pos_y; | ||
| 57 | |||
| 58 | __le16 bb_size_x; /* size of bounding box */ | ||
| 59 | __le16 bb_size_y; | ||
| 60 | |||
| 61 | __le16 pos_x; /* finger tip position */ | ||
| 62 | __le16 pos_y; | ||
| 63 | |||
| 64 | __le16 ctr_x; /* centroid position */ | ||
| 65 | __le16 ctr_y; | ||
| 66 | |||
| 67 | __le16 axis_x; /* somehow related to major/minor axis, mostly: */ | ||
| 68 | __le16 axis_y; /* axis_x == bb_size_y && axis_y == bb_size_x */ | ||
| 69 | |||
| 70 | __le32 angle; /* orientation in radians relative to x axis - | ||
| 71 | actually an IEEE754 float, don't use in kernel */ | ||
| 72 | |||
| 73 | __le32 area; /* size in pixels/pressure (?) */ | ||
| 74 | |||
| 75 | u8 padding[32]; | ||
| 76 | |||
| 77 | } __packed; | ||
| 78 | |||
| 79 | /* combined header/blob data */ | ||
| 80 | struct sur40_data { | ||
| 81 | struct sur40_header header; | ||
| 82 | struct sur40_blob blobs[]; | ||
| 83 | } __packed; | ||
| 84 | |||
| 85 | |||
| 86 | /* version information */ | ||
| 87 | #define DRIVER_SHORT "sur40" | ||
| 88 | #define DRIVER_AUTHOR "Florian 'floe' Echtler <floe@butterbrot.org>" | ||
| 89 | #define DRIVER_DESC "Surface2.0/SUR40/PixelSense input driver" | ||
| 90 | |||
| 91 | /* vendor and device IDs */ | ||
| 92 | #define ID_MICROSOFT 0x045e | ||
| 93 | #define ID_SUR40 0x0775 | ||
| 94 | |||
| 95 | /* sensor resolution */ | ||
| 96 | #define SENSOR_RES_X 1920 | ||
| 97 | #define SENSOR_RES_Y 1080 | ||
| 98 | |||
| 99 | /* touch data endpoint */ | ||
| 100 | #define TOUCH_ENDPOINT 0x86 | ||
| 101 | |||
| 102 | /* polling interval (ms) */ | ||
| 103 | #define POLL_INTERVAL 10 | ||
| 104 | |||
| 105 | /* maximum number of contacts FIXME: this is a guess? */ | ||
| 106 | #define MAX_CONTACTS 64 | ||
| 107 | |||
| 108 | /* control commands */ | ||
| 109 | #define SUR40_GET_VERSION 0xb0 /* 12 bytes string */ | ||
| 110 | #define SUR40_UNKNOWN1 0xb3 /* 5 bytes */ | ||
| 111 | #define SUR40_UNKNOWN2 0xc1 /* 24 bytes */ | ||
| 112 | |||
| 113 | #define SUR40_GET_STATE 0xc5 /* 4 bytes state (?) */ | ||
| 114 | #define SUR40_GET_SENSORS 0xb1 /* 8 bytes sensors */ | ||
| 115 | |||
| 116 | /* | ||
| 117 | * Note: an earlier, non-public version of this driver used USB_RECIP_ENDPOINT | ||
| 118 | * here by mistake which is very likely to have corrupted the firmware EEPROM | ||
| 119 | * on two separate SUR40 devices. Thanks to Alan Stern who spotted this bug. | ||
| 120 | * Should you ever run into a similar problem, the background story to this | ||
| 121 | * incident and instructions on how to fix the corrupted EEPROM are available | ||
| 122 | * at https://floe.butterbrot.org/matrix/hacking/surface/brick.html | ||
| 123 | */ | ||
| 124 | |||
| 125 | struct sur40_state { | ||
| 126 | |||
| 127 | struct usb_device *usbdev; | ||
| 128 | struct device *dev; | ||
| 129 | struct input_polled_dev *input; | ||
| 130 | |||
| 131 | struct sur40_data *bulk_in_buffer; | ||
| 132 | size_t bulk_in_size; | ||
| 133 | u8 bulk_in_epaddr; | ||
| 134 | |||
| 135 | char phys[64]; | ||
| 136 | }; | ||
| 137 | |||
| 138 | static int sur40_command(struct sur40_state *dev, | ||
| 139 | u8 command, u16 index, void *buffer, u16 size) | ||
| 140 | { | ||
| 141 | return usb_control_msg(dev->usbdev, usb_rcvctrlpipe(dev->usbdev, 0), | ||
| 142 | command, | ||
| 143 | USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, | ||
| 144 | 0x00, index, buffer, size, 1000); | ||
| 145 | } | ||
| 146 | |||
| 147 | /* Initialization routine, called from sur40_open */ | ||
| 148 | static int sur40_init(struct sur40_state *dev) | ||
| 149 | { | ||
| 150 | int result; | ||
| 151 | u8 buffer[24]; | ||
| 152 | |||
| 153 | /* stupidly replay the original MS driver init sequence */ | ||
| 154 | result = sur40_command(dev, SUR40_GET_VERSION, 0x00, buffer, 12); | ||
| 155 | if (result < 0) | ||
| 156 | return result; | ||
| 157 | |||
| 158 | result = sur40_command(dev, SUR40_GET_VERSION, 0x01, buffer, 12); | ||
| 159 | if (result < 0) | ||
| 160 | return result; | ||
| 161 | |||
| 162 | result = sur40_command(dev, SUR40_GET_VERSION, 0x02, buffer, 12); | ||
| 163 | if (result < 0) | ||
| 164 | return result; | ||
| 165 | |||
| 166 | result = sur40_command(dev, SUR40_UNKNOWN2, 0x00, buffer, 24); | ||
| 167 | if (result < 0) | ||
| 168 | return result; | ||
| 169 | |||
| 170 | result = sur40_command(dev, SUR40_UNKNOWN1, 0x00, buffer, 5); | ||
| 171 | if (result < 0) | ||
| 172 | return result; | ||
| 173 | |||
| 174 | result = sur40_command(dev, SUR40_GET_VERSION, 0x03, buffer, 12); | ||
| 175 | |||
| 176 | /* | ||
| 177 | * Discard the result buffer - no known data inside except | ||
| 178 | * some version strings, maybe extract these sometime... | ||
| 179 | */ | ||
| 180 | |||
| 181 | return result; | ||
| 182 | } | ||
| 183 | |||
| 184 | /* | ||
| 185 | * Callback routines from input_polled_dev | ||
| 186 | */ | ||
| 187 | |||
| 188 | /* Enable the device, polling will now start. */ | ||
| 189 | static void sur40_open(struct input_polled_dev *polldev) | ||
| 190 | { | ||
| 191 | struct sur40_state *sur40 = polldev->private; | ||
| 192 | |||
| 193 | dev_dbg(sur40->dev, "open\n"); | ||
| 194 | sur40_init(sur40); | ||
| 195 | } | ||
| 196 | |||
| 197 | /* Disable device, polling has stopped. */ | ||
| 198 | static void sur40_close(struct input_polled_dev *polldev) | ||
| 199 | { | ||
| 200 | struct sur40_state *sur40 = polldev->private; | ||
| 201 | |||
| 202 | dev_dbg(sur40->dev, "close\n"); | ||
| 203 | /* | ||
| 204 | * There is no known way to stop the device, so we simply | ||
| 205 | * stop polling. | ||
| 206 | */ | ||
| 207 | } | ||
| 208 | |||
| 209 | /* | ||
| 210 | * This function is called when a whole contact has been processed, | ||
| 211 | * so that it can assign it to a slot and store the data there. | ||
| 212 | */ | ||
| 213 | static void sur40_report_blob(struct sur40_blob *blob, struct input_dev *input) | ||
| 214 | { | ||
| 215 | int wide, major, minor; | ||
| 216 | |||
| 217 | int bb_size_x = le16_to_cpu(blob->bb_size_x); | ||
| 218 | int bb_size_y = le16_to_cpu(blob->bb_size_y); | ||
| 219 | |||
| 220 | int pos_x = le16_to_cpu(blob->pos_x); | ||
| 221 | int pos_y = le16_to_cpu(blob->pos_y); | ||
| 222 | |||
| 223 | int ctr_x = le16_to_cpu(blob->ctr_x); | ||
| 224 | int ctr_y = le16_to_cpu(blob->ctr_y); | ||
| 225 | |||
| 226 | int slotnum = input_mt_get_slot_by_key(input, blob->blob_id); | ||
| 227 | if (slotnum < 0 || slotnum >= MAX_CONTACTS) | ||
| 228 | return; | ||
| 229 | |||
| 230 | input_mt_slot(input, slotnum); | ||
| 231 | input_mt_report_slot_state(input, MT_TOOL_FINGER, 1); | ||
| 232 | wide = (bb_size_x > bb_size_y); | ||
| 233 | major = max(bb_size_x, bb_size_y); | ||
| 234 | minor = min(bb_size_x, bb_size_y); | ||
| 235 | |||
| 236 | input_report_abs(input, ABS_MT_POSITION_X, pos_x); | ||
| 237 | input_report_abs(input, ABS_MT_POSITION_Y, pos_y); | ||
| 238 | input_report_abs(input, ABS_MT_TOOL_X, ctr_x); | ||
| 239 | input_report_abs(input, ABS_MT_TOOL_Y, ctr_y); | ||
| 240 | |||
| 241 | /* TODO: use a better orientation measure */ | ||
| 242 | input_report_abs(input, ABS_MT_ORIENTATION, wide); | ||
| 243 | input_report_abs(input, ABS_MT_TOUCH_MAJOR, major); | ||
| 244 | input_report_abs(input, ABS_MT_TOUCH_MINOR, minor); | ||
| 245 | } | ||
| 246 | |||
| 247 | /* core function: poll for new input data */ | ||
| 248 | static void sur40_poll(struct input_polled_dev *polldev) | ||
| 249 | { | ||
| 250 | |||
| 251 | struct sur40_state *sur40 = polldev->private; | ||
| 252 | struct input_dev *input = polldev->input; | ||
| 253 | int result, bulk_read, need_blobs, packet_blobs, i; | ||
| 254 | u32 uninitialized_var(packet_id); | ||
| 255 | |||
| 256 | struct sur40_header *header = &sur40->bulk_in_buffer->header; | ||
| 257 | struct sur40_blob *inblob = &sur40->bulk_in_buffer->blobs[0]; | ||
| 258 | |||
| 259 | dev_dbg(sur40->dev, "poll\n"); | ||
| 260 | |||
| 261 | need_blobs = -1; | ||
| 262 | |||
| 263 | do { | ||
| 264 | |||
| 265 | /* perform a blocking bulk read to get data from the device */ | ||
| 266 | result = usb_bulk_msg(sur40->usbdev, | ||
| 267 | usb_rcvbulkpipe(sur40->usbdev, sur40->bulk_in_epaddr), | ||
| 268 | sur40->bulk_in_buffer, sur40->bulk_in_size, | ||
| 269 | &bulk_read, 1000); | ||
| 270 | |||
| 271 | dev_dbg(sur40->dev, "received %d bytes\n", bulk_read); | ||
| 272 | |||
| 273 | if (result < 0) { | ||
| 274 | dev_err(sur40->dev, "error in usb_bulk_read\n"); | ||
| 275 | return; | ||
| 276 | } | ||
| 277 | |||
| 278 | result = bulk_read - sizeof(struct sur40_header); | ||
| 279 | |||
| 280 | if (result % sizeof(struct sur40_blob) != 0) { | ||
| 281 | dev_err(sur40->dev, "transfer size mismatch\n"); | ||
| 282 | return; | ||
| 283 | } | ||
| 284 | |||
| 285 | /* first packet? */ | ||
| 286 | if (need_blobs == -1) { | ||
| 287 | need_blobs = le16_to_cpu(header->count); | ||
| 288 | dev_dbg(sur40->dev, "need %d blobs\n", need_blobs); | ||
| 289 | packet_id = le32_to_cpu(header->packet_id); | ||
| 290 | } | ||
| 291 | |||
| 292 | /* | ||
| 293 | * Sanity check. when video data is also being retrieved, the | ||
| 294 | * packet ID will usually increase in the middle of a series | ||
| 295 | * instead of at the end. | ||
| 296 | */ | ||
| 297 | if (packet_id != header->packet_id) | ||
| 298 | dev_warn(sur40->dev, "packet ID mismatch\n"); | ||
| 299 | |||
| 300 | packet_blobs = result / sizeof(struct sur40_blob); | ||
| 301 | dev_dbg(sur40->dev, "received %d blobs\n", packet_blobs); | ||
| 302 | |||
| 303 | /* packets always contain at least 4 blobs, even if empty */ | ||
| 304 | if (packet_blobs > need_blobs) | ||
| 305 | packet_blobs = need_blobs; | ||
| 306 | |||
| 307 | for (i = 0; i < packet_blobs; i++) { | ||
| 308 | need_blobs--; | ||
| 309 | dev_dbg(sur40->dev, "processing blob\n"); | ||
| 310 | sur40_report_blob(&(inblob[i]), input); | ||
| 311 | } | ||
| 312 | |||
| 313 | } while (need_blobs > 0); | ||
| 314 | |||
| 315 | input_mt_sync_frame(input); | ||
| 316 | input_sync(input); | ||
| 317 | } | ||
| 318 | |||
| 319 | /* Initialize input device parameters. */ | ||
| 320 | static void sur40_input_setup(struct input_dev *input_dev) | ||
| 321 | { | ||
| 322 | __set_bit(EV_KEY, input_dev->evbit); | ||
| 323 | __set_bit(EV_ABS, input_dev->evbit); | ||
| 324 | |||
| 325 | input_set_abs_params(input_dev, ABS_MT_POSITION_X, | ||
| 326 | 0, SENSOR_RES_X, 0, 0); | ||
| 327 | input_set_abs_params(input_dev, ABS_MT_POSITION_Y, | ||
| 328 | 0, SENSOR_RES_Y, 0, 0); | ||
| 329 | |||
| 330 | input_set_abs_params(input_dev, ABS_MT_TOOL_X, | ||
| 331 | 0, SENSOR_RES_X, 0, 0); | ||
| 332 | input_set_abs_params(input_dev, ABS_MT_TOOL_Y, | ||
| 333 | 0, SENSOR_RES_Y, 0, 0); | ||
| 334 | |||
| 335 | /* max value unknown, but major/minor axis | ||
| 336 | * can never be larger than screen */ | ||
| 337 | input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR, | ||
| 338 | 0, SENSOR_RES_X, 0, 0); | ||
| 339 | input_set_abs_params(input_dev, ABS_MT_TOUCH_MINOR, | ||
| 340 | 0, SENSOR_RES_Y, 0, 0); | ||
| 341 | |||
| 342 | input_set_abs_params(input_dev, ABS_MT_ORIENTATION, 0, 1, 0, 0); | ||
| 343 | |||
| 344 | input_mt_init_slots(input_dev, MAX_CONTACTS, | ||
| 345 | INPUT_MT_DIRECT | INPUT_MT_DROP_UNUSED); | ||
| 346 | } | ||
| 347 | |||
| 348 | /* Check candidate USB interface. */ | ||
| 349 | static int sur40_probe(struct usb_interface *interface, | ||
| 350 | const struct usb_device_id *id) | ||
| 351 | { | ||
| 352 | struct usb_device *usbdev = interface_to_usbdev(interface); | ||
| 353 | struct sur40_state *sur40; | ||
| 354 | struct usb_host_interface *iface_desc; | ||
| 355 | struct usb_endpoint_descriptor *endpoint; | ||
| 356 | struct input_polled_dev *poll_dev; | ||
| 357 | int error; | ||
| 358 | |||
| 359 | /* Check if we really have the right interface. */ | ||
| 360 | iface_desc = &interface->altsetting[0]; | ||
| 361 | if (iface_desc->desc.bInterfaceClass != 0xFF) | ||
| 362 | return -ENODEV; | ||
| 363 | |||
| 364 | /* Use endpoint #4 (0x86). */ | ||
| 365 | endpoint = &iface_desc->endpoint[4].desc; | ||
| 366 | if (endpoint->bEndpointAddress != TOUCH_ENDPOINT) | ||
| 367 | return -ENODEV; | ||
| 368 | |||
| 369 | /* Allocate memory for our device state and initialize it. */ | ||
| 370 | sur40 = kzalloc(sizeof(struct sur40_state), GFP_KERNEL); | ||
| 371 | if (!sur40) | ||
| 372 | return -ENOMEM; | ||
| 373 | |||
| 374 | poll_dev = input_allocate_polled_device(); | ||
| 375 | if (!poll_dev) { | ||
| 376 | error = -ENOMEM; | ||
| 377 | goto err_free_dev; | ||
| 378 | } | ||
| 379 | |||
| 380 | /* Set up polled input device control structure */ | ||
| 381 | poll_dev->private = sur40; | ||
| 382 | poll_dev->poll_interval = POLL_INTERVAL; | ||
| 383 | poll_dev->open = sur40_open; | ||
| 384 | poll_dev->poll = sur40_poll; | ||
| 385 | poll_dev->close = sur40_close; | ||
| 386 | |||
| 387 | /* Set up regular input device structure */ | ||
| 388 | sur40_input_setup(poll_dev->input); | ||
| 389 | |||
| 390 | poll_dev->input->name = "Samsung SUR40"; | ||
| 391 | usb_to_input_id(usbdev, &poll_dev->input->id); | ||
| 392 | usb_make_path(usbdev, sur40->phys, sizeof(sur40->phys)); | ||
| 393 | strlcat(sur40->phys, "/input0", sizeof(sur40->phys)); | ||
| 394 | poll_dev->input->phys = sur40->phys; | ||
| 395 | poll_dev->input->dev.parent = &interface->dev; | ||
| 396 | |||
| 397 | sur40->usbdev = usbdev; | ||
| 398 | sur40->dev = &interface->dev; | ||
| 399 | sur40->input = poll_dev; | ||
| 400 | |||
| 401 | /* use the bulk-in endpoint tested above */ | ||
| 402 | sur40->bulk_in_size = usb_endpoint_maxp(endpoint); | ||
| 403 | sur40->bulk_in_epaddr = endpoint->bEndpointAddress; | ||
| 404 | sur40->bulk_in_buffer = kmalloc(sur40->bulk_in_size, GFP_KERNEL); | ||
| 405 | if (!sur40->bulk_in_buffer) { | ||
| 406 | dev_err(&interface->dev, "Unable to allocate input buffer."); | ||
| 407 | error = -ENOMEM; | ||
| 408 | goto err_free_polldev; | ||
| 409 | } | ||
| 410 | |||
| 411 | error = input_register_polled_device(poll_dev); | ||
| 412 | if (error) { | ||
| 413 | dev_err(&interface->dev, | ||
| 414 | "Unable to register polled input device."); | ||
| 415 | goto err_free_buffer; | ||
| 416 | } | ||
| 417 | |||
| 418 | /* we can register the device now, as it is ready */ | ||
| 419 | usb_set_intfdata(interface, sur40); | ||
| 420 | dev_dbg(&interface->dev, "%s is now attached\n", DRIVER_DESC); | ||
| 421 | |||
| 422 | return 0; | ||
| 423 | |||
| 424 | err_free_buffer: | ||
| 425 | kfree(sur40->bulk_in_buffer); | ||
| 426 | err_free_polldev: | ||
| 427 | input_free_polled_device(sur40->input); | ||
| 428 | err_free_dev: | ||
| 429 | kfree(sur40); | ||
| 430 | |||
| 431 | return error; | ||
| 432 | } | ||
| 433 | |||
| 434 | /* Unregister device & clean up. */ | ||
| 435 | static void sur40_disconnect(struct usb_interface *interface) | ||
| 436 | { | ||
| 437 | struct sur40_state *sur40 = usb_get_intfdata(interface); | ||
| 438 | |||
| 439 | input_unregister_polled_device(sur40->input); | ||
| 440 | input_free_polled_device(sur40->input); | ||
| 441 | kfree(sur40->bulk_in_buffer); | ||
| 442 | kfree(sur40); | ||
| 443 | |||
| 444 | usb_set_intfdata(interface, NULL); | ||
| 445 | dev_dbg(&interface->dev, "%s is now disconnected\n", DRIVER_DESC); | ||
| 446 | } | ||
| 447 | |||
| 448 | static const struct usb_device_id sur40_table[] = { | ||
| 449 | { USB_DEVICE(ID_MICROSOFT, ID_SUR40) }, /* Samsung SUR40 */ | ||
| 450 | { } /* terminating null entry */ | ||
| 451 | }; | ||
| 452 | MODULE_DEVICE_TABLE(usb, sur40_table); | ||
| 453 | |||
| 454 | /* USB-specific object needed to register this driver with the USB subsystem. */ | ||
| 455 | static struct usb_driver sur40_driver = { | ||
| 456 | .name = DRIVER_SHORT, | ||
| 457 | .probe = sur40_probe, | ||
| 458 | .disconnect = sur40_disconnect, | ||
| 459 | .id_table = sur40_table, | ||
| 460 | }; | ||
| 461 | |||
| 462 | module_usb_driver(sur40_driver); | ||
| 463 | |||
| 464 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
| 465 | MODULE_DESCRIPTION(DRIVER_DESC); | ||
| 466 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/input/touchscreen/usbtouchscreen.c b/drivers/input/touchscreen/usbtouchscreen.c index ae4b6b903629..5f87bed05467 100644 --- a/drivers/input/touchscreen/usbtouchscreen.c +++ b/drivers/input/touchscreen/usbtouchscreen.c | |||
| @@ -106,6 +106,7 @@ struct usbtouch_device_info { | |||
| 106 | struct usbtouch_usb { | 106 | struct usbtouch_usb { |
| 107 | unsigned char *data; | 107 | unsigned char *data; |
| 108 | dma_addr_t data_dma; | 108 | dma_addr_t data_dma; |
| 109 | int data_size; | ||
| 109 | unsigned char *buffer; | 110 | unsigned char *buffer; |
| 110 | int buf_len; | 111 | int buf_len; |
| 111 | struct urb *irq; | 112 | struct urb *irq; |
| @@ -1521,7 +1522,7 @@ static int usbtouch_reset_resume(struct usb_interface *intf) | |||
| 1521 | static void usbtouch_free_buffers(struct usb_device *udev, | 1522 | static void usbtouch_free_buffers(struct usb_device *udev, |
| 1522 | struct usbtouch_usb *usbtouch) | 1523 | struct usbtouch_usb *usbtouch) |
| 1523 | { | 1524 | { |
| 1524 | usb_free_coherent(udev, usbtouch->type->rept_size, | 1525 | usb_free_coherent(udev, usbtouch->data_size, |
| 1525 | usbtouch->data, usbtouch->data_dma); | 1526 | usbtouch->data, usbtouch->data_dma); |
| 1526 | kfree(usbtouch->buffer); | 1527 | kfree(usbtouch->buffer); |
| 1527 | } | 1528 | } |
| @@ -1566,7 +1567,20 @@ static int usbtouch_probe(struct usb_interface *intf, | |||
| 1566 | if (!type->process_pkt) | 1567 | if (!type->process_pkt) |
| 1567 | type->process_pkt = usbtouch_process_pkt; | 1568 | type->process_pkt = usbtouch_process_pkt; |
| 1568 | 1569 | ||
| 1569 | usbtouch->data = usb_alloc_coherent(udev, type->rept_size, | 1570 | usbtouch->data_size = type->rept_size; |
| 1571 | if (type->get_pkt_len) { | ||
| 1572 | /* | ||
| 1573 | * When dealing with variable-length packets we should | ||
| 1574 | * not request more than wMaxPacketSize bytes at once | ||
| 1575 | * as we do not know if there is more data coming or | ||
| 1576 | * we filled exactly wMaxPacketSize bytes and there is | ||
| 1577 | * nothing else. | ||
| 1578 | */ | ||
| 1579 | usbtouch->data_size = min(usbtouch->data_size, | ||
| 1580 | usb_endpoint_maxp(endpoint)); | ||
| 1581 | } | ||
| 1582 | |||
| 1583 | usbtouch->data = usb_alloc_coherent(udev, usbtouch->data_size, | ||
| 1570 | GFP_KERNEL, &usbtouch->data_dma); | 1584 | GFP_KERNEL, &usbtouch->data_dma); |
| 1571 | if (!usbtouch->data) | 1585 | if (!usbtouch->data) |
| 1572 | goto out_free; | 1586 | goto out_free; |
| @@ -1626,12 +1640,12 @@ static int usbtouch_probe(struct usb_interface *intf, | |||
| 1626 | if (usb_endpoint_type(endpoint) == USB_ENDPOINT_XFER_INT) | 1640 | if (usb_endpoint_type(endpoint) == USB_ENDPOINT_XFER_INT) |
| 1627 | usb_fill_int_urb(usbtouch->irq, udev, | 1641 | usb_fill_int_urb(usbtouch->irq, udev, |
| 1628 | usb_rcvintpipe(udev, endpoint->bEndpointAddress), | 1642 | usb_rcvintpipe(udev, endpoint->bEndpointAddress), |
| 1629 | usbtouch->data, type->rept_size, | 1643 | usbtouch->data, usbtouch->data_size, |
| 1630 | usbtouch_irq, usbtouch, endpoint->bInterval); | 1644 | usbtouch_irq, usbtouch, endpoint->bInterval); |
| 1631 | else | 1645 | else |
| 1632 | usb_fill_bulk_urb(usbtouch->irq, udev, | 1646 | usb_fill_bulk_urb(usbtouch->irq, udev, |
| 1633 | usb_rcvbulkpipe(udev, endpoint->bEndpointAddress), | 1647 | usb_rcvbulkpipe(udev, endpoint->bEndpointAddress), |
| 1634 | usbtouch->data, type->rept_size, | 1648 | usbtouch->data, usbtouch->data_size, |
| 1635 | usbtouch_irq, usbtouch); | 1649 | usbtouch_irq, usbtouch); |
| 1636 | 1650 | ||
| 1637 | usbtouch->irq->dev = udev; | 1651 | usbtouch->irq->dev = udev; |
diff --git a/drivers/iommu/arm-smmu.c b/drivers/iommu/arm-smmu.c index 1abfb5684ab7..e46a88700b68 100644 --- a/drivers/iommu/arm-smmu.c +++ b/drivers/iommu/arm-smmu.c | |||
| @@ -392,7 +392,7 @@ struct arm_smmu_domain { | |||
| 392 | struct arm_smmu_cfg root_cfg; | 392 | struct arm_smmu_cfg root_cfg; |
| 393 | phys_addr_t output_mask; | 393 | phys_addr_t output_mask; |
| 394 | 394 | ||
| 395 | spinlock_t lock; | 395 | struct mutex lock; |
| 396 | }; | 396 | }; |
| 397 | 397 | ||
| 398 | static DEFINE_SPINLOCK(arm_smmu_devices_lock); | 398 | static DEFINE_SPINLOCK(arm_smmu_devices_lock); |
| @@ -900,7 +900,7 @@ static int arm_smmu_domain_init(struct iommu_domain *domain) | |||
| 900 | goto out_free_domain; | 900 | goto out_free_domain; |
| 901 | smmu_domain->root_cfg.pgd = pgd; | 901 | smmu_domain->root_cfg.pgd = pgd; |
| 902 | 902 | ||
| 903 | spin_lock_init(&smmu_domain->lock); | 903 | mutex_init(&smmu_domain->lock); |
| 904 | domain->priv = smmu_domain; | 904 | domain->priv = smmu_domain; |
| 905 | return 0; | 905 | return 0; |
| 906 | 906 | ||
| @@ -1137,7 +1137,7 @@ static int arm_smmu_attach_dev(struct iommu_domain *domain, struct device *dev) | |||
| 1137 | * Sanity check the domain. We don't currently support domains | 1137 | * Sanity check the domain. We don't currently support domains |
| 1138 | * that cross between different SMMU chains. | 1138 | * that cross between different SMMU chains. |
| 1139 | */ | 1139 | */ |
| 1140 | spin_lock(&smmu_domain->lock); | 1140 | mutex_lock(&smmu_domain->lock); |
| 1141 | if (!smmu_domain->leaf_smmu) { | 1141 | if (!smmu_domain->leaf_smmu) { |
| 1142 | /* Now that we have a master, we can finalise the domain */ | 1142 | /* Now that we have a master, we can finalise the domain */ |
| 1143 | ret = arm_smmu_init_domain_context(domain, dev); | 1143 | ret = arm_smmu_init_domain_context(domain, dev); |
| @@ -1152,7 +1152,7 @@ static int arm_smmu_attach_dev(struct iommu_domain *domain, struct device *dev) | |||
| 1152 | dev_name(device_smmu->dev)); | 1152 | dev_name(device_smmu->dev)); |
| 1153 | goto err_unlock; | 1153 | goto err_unlock; |
| 1154 | } | 1154 | } |
| 1155 | spin_unlock(&smmu_domain->lock); | 1155 | mutex_unlock(&smmu_domain->lock); |
| 1156 | 1156 | ||
| 1157 | /* Looks ok, so add the device to the domain */ | 1157 | /* Looks ok, so add the device to the domain */ |
| 1158 | master = find_smmu_master(smmu_domain->leaf_smmu, dev->of_node); | 1158 | master = find_smmu_master(smmu_domain->leaf_smmu, dev->of_node); |
| @@ -1162,7 +1162,7 @@ static int arm_smmu_attach_dev(struct iommu_domain *domain, struct device *dev) | |||
| 1162 | return arm_smmu_domain_add_master(smmu_domain, master); | 1162 | return arm_smmu_domain_add_master(smmu_domain, master); |
| 1163 | 1163 | ||
| 1164 | err_unlock: | 1164 | err_unlock: |
| 1165 | spin_unlock(&smmu_domain->lock); | 1165 | mutex_unlock(&smmu_domain->lock); |
| 1166 | return ret; | 1166 | return ret; |
| 1167 | } | 1167 | } |
| 1168 | 1168 | ||
| @@ -1394,7 +1394,7 @@ static int arm_smmu_handle_mapping(struct arm_smmu_domain *smmu_domain, | |||
| 1394 | if (paddr & ~output_mask) | 1394 | if (paddr & ~output_mask) |
| 1395 | return -ERANGE; | 1395 | return -ERANGE; |
| 1396 | 1396 | ||
| 1397 | spin_lock(&smmu_domain->lock); | 1397 | mutex_lock(&smmu_domain->lock); |
| 1398 | pgd += pgd_index(iova); | 1398 | pgd += pgd_index(iova); |
| 1399 | end = iova + size; | 1399 | end = iova + size; |
| 1400 | do { | 1400 | do { |
| @@ -1410,7 +1410,7 @@ static int arm_smmu_handle_mapping(struct arm_smmu_domain *smmu_domain, | |||
| 1410 | } while (pgd++, iova != end); | 1410 | } while (pgd++, iova != end); |
| 1411 | 1411 | ||
| 1412 | out_unlock: | 1412 | out_unlock: |
| 1413 | spin_unlock(&smmu_domain->lock); | 1413 | mutex_unlock(&smmu_domain->lock); |
| 1414 | 1414 | ||
| 1415 | /* Ensure new page tables are visible to the hardware walker */ | 1415 | /* Ensure new page tables are visible to the hardware walker */ |
| 1416 | if (smmu->features & ARM_SMMU_FEAT_COHERENT_WALK) | 1416 | if (smmu->features & ARM_SMMU_FEAT_COHERENT_WALK) |
| @@ -1423,9 +1423,8 @@ static int arm_smmu_map(struct iommu_domain *domain, unsigned long iova, | |||
| 1423 | phys_addr_t paddr, size_t size, int flags) | 1423 | phys_addr_t paddr, size_t size, int flags) |
| 1424 | { | 1424 | { |
| 1425 | struct arm_smmu_domain *smmu_domain = domain->priv; | 1425 | struct arm_smmu_domain *smmu_domain = domain->priv; |
| 1426 | struct arm_smmu_device *smmu = smmu_domain->leaf_smmu; | ||
| 1427 | 1426 | ||
| 1428 | if (!smmu_domain || !smmu) | 1427 | if (!smmu_domain) |
| 1429 | return -ENODEV; | 1428 | return -ENODEV; |
| 1430 | 1429 | ||
| 1431 | /* Check for silent address truncation up the SMMU chain. */ | 1430 | /* Check for silent address truncation up the SMMU chain. */ |
| @@ -1449,44 +1448,34 @@ static size_t arm_smmu_unmap(struct iommu_domain *domain, unsigned long iova, | |||
| 1449 | static phys_addr_t arm_smmu_iova_to_phys(struct iommu_domain *domain, | 1448 | static phys_addr_t arm_smmu_iova_to_phys(struct iommu_domain *domain, |
| 1450 | dma_addr_t iova) | 1449 | dma_addr_t iova) |
| 1451 | { | 1450 | { |
| 1452 | pgd_t *pgd; | 1451 | pgd_t *pgdp, pgd; |
| 1453 | pud_t *pud; | 1452 | pud_t pud; |
| 1454 | pmd_t *pmd; | 1453 | pmd_t pmd; |
| 1455 | pte_t *pte; | 1454 | pte_t pte; |
| 1456 | struct arm_smmu_domain *smmu_domain = domain->priv; | 1455 | struct arm_smmu_domain *smmu_domain = domain->priv; |
| 1457 | struct arm_smmu_cfg *root_cfg = &smmu_domain->root_cfg; | 1456 | struct arm_smmu_cfg *root_cfg = &smmu_domain->root_cfg; |
| 1458 | struct arm_smmu_device *smmu = root_cfg->smmu; | ||
| 1459 | 1457 | ||
| 1460 | spin_lock(&smmu_domain->lock); | 1458 | pgdp = root_cfg->pgd; |
| 1461 | pgd = root_cfg->pgd; | 1459 | if (!pgdp) |
| 1462 | if (!pgd) | 1460 | return 0; |
| 1463 | goto err_unlock; | ||
| 1464 | 1461 | ||
| 1465 | pgd += pgd_index(iova); | 1462 | pgd = *(pgdp + pgd_index(iova)); |
| 1466 | if (pgd_none_or_clear_bad(pgd)) | 1463 | if (pgd_none(pgd)) |
| 1467 | goto err_unlock; | 1464 | return 0; |
| 1468 | 1465 | ||
| 1469 | pud = pud_offset(pgd, iova); | 1466 | pud = *pud_offset(&pgd, iova); |
| 1470 | if (pud_none_or_clear_bad(pud)) | 1467 | if (pud_none(pud)) |
| 1471 | goto err_unlock; | 1468 | return 0; |
| 1472 | 1469 | ||
| 1473 | pmd = pmd_offset(pud, iova); | 1470 | pmd = *pmd_offset(&pud, iova); |
| 1474 | if (pmd_none_or_clear_bad(pmd)) | 1471 | if (pmd_none(pmd)) |
| 1475 | goto err_unlock; | 1472 | return 0; |
| 1476 | 1473 | ||
| 1477 | pte = pmd_page_vaddr(*pmd) + pte_index(iova); | 1474 | pte = *(pmd_page_vaddr(pmd) + pte_index(iova)); |
| 1478 | if (pte_none(pte)) | 1475 | if (pte_none(pte)) |
| 1479 | goto err_unlock; | 1476 | return 0; |
| 1480 | |||
| 1481 | spin_unlock(&smmu_domain->lock); | ||
| 1482 | return __pfn_to_phys(pte_pfn(*pte)) | (iova & ~PAGE_MASK); | ||
| 1483 | 1477 | ||
| 1484 | err_unlock: | 1478 | return __pfn_to_phys(pte_pfn(pte)) | (iova & ~PAGE_MASK); |
| 1485 | spin_unlock(&smmu_domain->lock); | ||
| 1486 | dev_warn(smmu->dev, | ||
| 1487 | "invalid (corrupt?) page tables detected for iova 0x%llx\n", | ||
| 1488 | (unsigned long long)iova); | ||
| 1489 | return -EINVAL; | ||
| 1490 | } | 1479 | } |
| 1491 | 1480 | ||
| 1492 | static int arm_smmu_domain_has_cap(struct iommu_domain *domain, | 1481 | static int arm_smmu_domain_has_cap(struct iommu_domain *domain, |
| @@ -1863,6 +1852,7 @@ static int arm_smmu_device_dt_probe(struct platform_device *pdev) | |||
| 1863 | dev_err(dev, | 1852 | dev_err(dev, |
| 1864 | "found only %d context interrupt(s) but %d required\n", | 1853 | "found only %d context interrupt(s) but %d required\n", |
| 1865 | smmu->num_context_irqs, smmu->num_context_banks); | 1854 | smmu->num_context_irqs, smmu->num_context_banks); |
| 1855 | err = -ENODEV; | ||
| 1866 | goto out_put_parent; | 1856 | goto out_put_parent; |
| 1867 | } | 1857 | } |
| 1868 | 1858 | ||
diff --git a/drivers/irqchip/irq-gic.c b/drivers/irqchip/irq-gic.c index 9031171c141b..341c6016812d 100644 --- a/drivers/irqchip/irq-gic.c +++ b/drivers/irqchip/irq-gic.c | |||
| @@ -957,12 +957,13 @@ void __init gic_init_bases(unsigned int gic_nr, int irq_start, | |||
| 957 | if (WARN_ON(!gic->domain)) | 957 | if (WARN_ON(!gic->domain)) |
| 958 | return; | 958 | return; |
| 959 | 959 | ||
| 960 | if (gic_nr == 0) { | ||
| 960 | #ifdef CONFIG_SMP | 961 | #ifdef CONFIG_SMP |
| 961 | set_smp_cross_call(gic_raise_softirq); | 962 | set_smp_cross_call(gic_raise_softirq); |
| 962 | register_cpu_notifier(&gic_cpu_notifier); | 963 | register_cpu_notifier(&gic_cpu_notifier); |
| 963 | #endif | 964 | #endif |
| 964 | 965 | set_handle_irq(gic_handle_irq); | |
| 965 | set_handle_irq(gic_handle_irq); | 966 | } |
| 966 | 967 | ||
| 967 | gic_chip.flags |= gic_arch_extn.flags; | 968 | gic_chip.flags |= gic_arch_extn.flags; |
| 968 | gic_dist_init(gic); | 969 | gic_dist_init(gic); |
diff --git a/drivers/leds/leds-pwm.c b/drivers/leds/leds-pwm.c index 2848171b8576..b31d8e99c419 100644 --- a/drivers/leds/leds-pwm.c +++ b/drivers/leds/leds-pwm.c | |||
| @@ -82,22 +82,12 @@ static inline size_t sizeof_pwm_leds_priv(int num_leds) | |||
| 82 | (sizeof(struct led_pwm_data) * num_leds); | 82 | (sizeof(struct led_pwm_data) * num_leds); |
| 83 | } | 83 | } |
| 84 | 84 | ||
| 85 | static struct led_pwm_priv *led_pwm_create_of(struct platform_device *pdev) | 85 | static int led_pwm_create_of(struct platform_device *pdev, |
| 86 | struct led_pwm_priv *priv) | ||
| 86 | { | 87 | { |
| 87 | struct device_node *node = pdev->dev.of_node; | 88 | struct device_node *node = pdev->dev.of_node; |
| 88 | struct device_node *child; | 89 | struct device_node *child; |
| 89 | struct led_pwm_priv *priv; | 90 | int ret; |
| 90 | int count, ret; | ||
| 91 | |||
| 92 | /* count LEDs in this device, so we know how much to allocate */ | ||
| 93 | count = of_get_child_count(node); | ||
| 94 | if (!count) | ||
| 95 | return NULL; | ||
| 96 | |||
| 97 | priv = devm_kzalloc(&pdev->dev, sizeof_pwm_leds_priv(count), | ||
| 98 | GFP_KERNEL); | ||
| 99 | if (!priv) | ||
| 100 | return NULL; | ||
| 101 | 91 | ||
| 102 | for_each_child_of_node(node, child) { | 92 | for_each_child_of_node(node, child) { |
| 103 | struct led_pwm_data *led_dat = &priv->leds[priv->num_leds]; | 93 | struct led_pwm_data *led_dat = &priv->leds[priv->num_leds]; |
| @@ -109,6 +99,7 @@ static struct led_pwm_priv *led_pwm_create_of(struct platform_device *pdev) | |||
| 109 | if (IS_ERR(led_dat->pwm)) { | 99 | if (IS_ERR(led_dat->pwm)) { |
| 110 | dev_err(&pdev->dev, "unable to request PWM for %s\n", | 100 | dev_err(&pdev->dev, "unable to request PWM for %s\n", |
| 111 | led_dat->cdev.name); | 101 | led_dat->cdev.name); |
| 102 | ret = PTR_ERR(led_dat->pwm); | ||
| 112 | goto err; | 103 | goto err; |
| 113 | } | 104 | } |
| 114 | /* Get the period from PWM core when n*/ | 105 | /* Get the period from PWM core when n*/ |
| @@ -137,28 +128,36 @@ static struct led_pwm_priv *led_pwm_create_of(struct platform_device *pdev) | |||
| 137 | priv->num_leds++; | 128 | priv->num_leds++; |
| 138 | } | 129 | } |
| 139 | 130 | ||
| 140 | return priv; | 131 | return 0; |
| 141 | err: | 132 | err: |
| 142 | while (priv->num_leds--) | 133 | while (priv->num_leds--) |
| 143 | led_classdev_unregister(&priv->leds[priv->num_leds].cdev); | 134 | led_classdev_unregister(&priv->leds[priv->num_leds].cdev); |
| 144 | 135 | ||
| 145 | return NULL; | 136 | return ret; |
| 146 | } | 137 | } |
| 147 | 138 | ||
| 148 | static int led_pwm_probe(struct platform_device *pdev) | 139 | static int led_pwm_probe(struct platform_device *pdev) |
| 149 | { | 140 | { |
| 150 | struct led_pwm_platform_data *pdata = dev_get_platdata(&pdev->dev); | 141 | struct led_pwm_platform_data *pdata = dev_get_platdata(&pdev->dev); |
| 151 | struct led_pwm_priv *priv; | 142 | struct led_pwm_priv *priv; |
| 152 | int i, ret = 0; | 143 | int count, i; |
| 144 | int ret = 0; | ||
| 145 | |||
| 146 | if (pdata) | ||
| 147 | count = pdata->num_leds; | ||
| 148 | else | ||
| 149 | count = of_get_child_count(pdev->dev.of_node); | ||
| 150 | |||
| 151 | if (!count) | ||
| 152 | return -EINVAL; | ||
| 153 | 153 | ||
| 154 | if (pdata && pdata->num_leds) { | 154 | priv = devm_kzalloc(&pdev->dev, sizeof_pwm_leds_priv(count), |
| 155 | priv = devm_kzalloc(&pdev->dev, | 155 | GFP_KERNEL); |
| 156 | sizeof_pwm_leds_priv(pdata->num_leds), | 156 | if (!priv) |
| 157 | GFP_KERNEL); | 157 | return -ENOMEM; |
| 158 | if (!priv) | ||
| 159 | return -ENOMEM; | ||
| 160 | 158 | ||
| 161 | for (i = 0; i < pdata->num_leds; i++) { | 159 | if (pdata) { |
| 160 | for (i = 0; i < count; i++) { | ||
| 162 | struct led_pwm *cur_led = &pdata->leds[i]; | 161 | struct led_pwm *cur_led = &pdata->leds[i]; |
| 163 | struct led_pwm_data *led_dat = &priv->leds[i]; | 162 | struct led_pwm_data *led_dat = &priv->leds[i]; |
| 164 | 163 | ||
| @@ -188,11 +187,11 @@ static int led_pwm_probe(struct platform_device *pdev) | |||
| 188 | if (ret < 0) | 187 | if (ret < 0) |
| 189 | goto err; | 188 | goto err; |
| 190 | } | 189 | } |
| 191 | priv->num_leds = pdata->num_leds; | 190 | priv->num_leds = count; |
| 192 | } else { | 191 | } else { |
| 193 | priv = led_pwm_create_of(pdev); | 192 | ret = led_pwm_create_of(pdev, priv); |
| 194 | if (!priv) | 193 | if (ret) |
| 195 | return -ENODEV; | 194 | return ret; |
| 196 | } | 195 | } |
| 197 | 196 | ||
| 198 | platform_set_drvdata(pdev, priv); | 197 | platform_set_drvdata(pdev, priv); |
diff --git a/drivers/macintosh/Makefile b/drivers/macintosh/Makefile index 6753b65f8ede..d2f0120bc878 100644 --- a/drivers/macintosh/Makefile +++ b/drivers/macintosh/Makefile | |||
| @@ -40,6 +40,7 @@ obj-$(CONFIG_WINDFARM_RM31) += windfarm_fcu_controls.o \ | |||
| 40 | windfarm_ad7417_sensor.o \ | 40 | windfarm_ad7417_sensor.o \ |
| 41 | windfarm_lm75_sensor.o \ | 41 | windfarm_lm75_sensor.o \ |
| 42 | windfarm_lm87_sensor.o \ | 42 | windfarm_lm87_sensor.o \ |
| 43 | windfarm_max6690_sensor.o \ | ||
| 43 | windfarm_pid.o \ | 44 | windfarm_pid.o \ |
| 44 | windfarm_cpufreq_clamp.o \ | 45 | windfarm_cpufreq_clamp.o \ |
| 45 | windfarm_rm31.o | 46 | windfarm_rm31.o |
diff --git a/drivers/md/dm-bufio.c b/drivers/md/dm-bufio.c index 173cbb20d104..54bdd923316f 100644 --- a/drivers/md/dm-bufio.c +++ b/drivers/md/dm-bufio.c | |||
| @@ -1717,6 +1717,11 @@ static int __init dm_bufio_init(void) | |||
| 1717 | { | 1717 | { |
| 1718 | __u64 mem; | 1718 | __u64 mem; |
| 1719 | 1719 | ||
| 1720 | dm_bufio_allocated_kmem_cache = 0; | ||
| 1721 | dm_bufio_allocated_get_free_pages = 0; | ||
| 1722 | dm_bufio_allocated_vmalloc = 0; | ||
| 1723 | dm_bufio_current_allocated = 0; | ||
| 1724 | |||
| 1720 | memset(&dm_bufio_caches, 0, sizeof dm_bufio_caches); | 1725 | memset(&dm_bufio_caches, 0, sizeof dm_bufio_caches); |
| 1721 | memset(&dm_bufio_cache_names, 0, sizeof dm_bufio_cache_names); | 1726 | memset(&dm_bufio_cache_names, 0, sizeof dm_bufio_cache_names); |
| 1722 | 1727 | ||
diff --git a/drivers/md/dm-cache-policy-mq.c b/drivers/md/dm-cache-policy-mq.c index 416b7b752a6e..64780ad73bb0 100644 --- a/drivers/md/dm-cache-policy-mq.c +++ b/drivers/md/dm-cache-policy-mq.c | |||
| @@ -730,15 +730,18 @@ static int pre_cache_entry_found(struct mq_policy *mq, struct entry *e, | |||
| 730 | int r = 0; | 730 | int r = 0; |
| 731 | bool updated = updated_this_tick(mq, e); | 731 | bool updated = updated_this_tick(mq, e); |
| 732 | 732 | ||
| 733 | requeue_and_update_tick(mq, e); | ||
| 734 | |||
| 735 | if ((!discarded_oblock && updated) || | 733 | if ((!discarded_oblock && updated) || |
| 736 | !should_promote(mq, e, discarded_oblock, data_dir)) | 734 | !should_promote(mq, e, discarded_oblock, data_dir)) { |
| 735 | requeue_and_update_tick(mq, e); | ||
| 737 | result->op = POLICY_MISS; | 736 | result->op = POLICY_MISS; |
| 738 | else if (!can_migrate) | 737 | |
| 738 | } else if (!can_migrate) | ||
| 739 | r = -EWOULDBLOCK; | 739 | r = -EWOULDBLOCK; |
| 740 | else | 740 | |
| 741 | else { | ||
| 742 | requeue_and_update_tick(mq, e); | ||
| 741 | r = pre_cache_to_cache(mq, e, result); | 743 | r = pre_cache_to_cache(mq, e, result); |
| 744 | } | ||
| 742 | 745 | ||
| 743 | return r; | 746 | return r; |
| 744 | } | 747 | } |
diff --git a/drivers/md/dm-cache-target.c b/drivers/md/dm-cache-target.c index 9efcf1059b99..1b1469ebe5cb 100644 --- a/drivers/md/dm-cache-target.c +++ b/drivers/md/dm-cache-target.c | |||
| @@ -2755,7 +2755,7 @@ static int resize_cache_dev(struct cache *cache, dm_cblock_t new_size) | |||
| 2755 | { | 2755 | { |
| 2756 | int r; | 2756 | int r; |
| 2757 | 2757 | ||
| 2758 | r = dm_cache_resize(cache->cmd, cache->cache_size); | 2758 | r = dm_cache_resize(cache->cmd, new_size); |
| 2759 | if (r) { | 2759 | if (r) { |
| 2760 | DMERR("could not resize cache metadata"); | 2760 | DMERR("could not resize cache metadata"); |
| 2761 | return r; | 2761 | return r; |
diff --git a/drivers/md/dm-delay.c b/drivers/md/dm-delay.c index 496d5f3646a5..2f91d6d4a2cc 100644 --- a/drivers/md/dm-delay.c +++ b/drivers/md/dm-delay.c | |||
| @@ -20,6 +20,7 @@ | |||
| 20 | struct delay_c { | 20 | struct delay_c { |
| 21 | struct timer_list delay_timer; | 21 | struct timer_list delay_timer; |
| 22 | struct mutex timer_lock; | 22 | struct mutex timer_lock; |
| 23 | struct workqueue_struct *kdelayd_wq; | ||
| 23 | struct work_struct flush_expired_bios; | 24 | struct work_struct flush_expired_bios; |
| 24 | struct list_head delayed_bios; | 25 | struct list_head delayed_bios; |
| 25 | atomic_t may_delay; | 26 | atomic_t may_delay; |
| @@ -45,14 +46,13 @@ struct dm_delay_info { | |||
| 45 | 46 | ||
| 46 | static DEFINE_MUTEX(delayed_bios_lock); | 47 | static DEFINE_MUTEX(delayed_bios_lock); |
| 47 | 48 | ||
| 48 | static struct workqueue_struct *kdelayd_wq; | ||
| 49 | static struct kmem_cache *delayed_cache; | 49 | static struct kmem_cache *delayed_cache; |
| 50 | 50 | ||
| 51 | static void handle_delayed_timer(unsigned long data) | 51 | static void handle_delayed_timer(unsigned long data) |
| 52 | { | 52 | { |
| 53 | struct delay_c *dc = (struct delay_c *)data; | 53 | struct delay_c *dc = (struct delay_c *)data; |
| 54 | 54 | ||
| 55 | queue_work(kdelayd_wq, &dc->flush_expired_bios); | 55 | queue_work(dc->kdelayd_wq, &dc->flush_expired_bios); |
| 56 | } | 56 | } |
| 57 | 57 | ||
| 58 | static void queue_timeout(struct delay_c *dc, unsigned long expires) | 58 | static void queue_timeout(struct delay_c *dc, unsigned long expires) |
| @@ -191,6 +191,12 @@ out: | |||
| 191 | goto bad_dev_write; | 191 | goto bad_dev_write; |
| 192 | } | 192 | } |
| 193 | 193 | ||
| 194 | dc->kdelayd_wq = alloc_workqueue("kdelayd", WQ_MEM_RECLAIM, 0); | ||
| 195 | if (!dc->kdelayd_wq) { | ||
| 196 | DMERR("Couldn't start kdelayd"); | ||
| 197 | goto bad_queue; | ||
| 198 | } | ||
| 199 | |||
| 194 | setup_timer(&dc->delay_timer, handle_delayed_timer, (unsigned long)dc); | 200 | setup_timer(&dc->delay_timer, handle_delayed_timer, (unsigned long)dc); |
| 195 | 201 | ||
| 196 | INIT_WORK(&dc->flush_expired_bios, flush_expired_bios); | 202 | INIT_WORK(&dc->flush_expired_bios, flush_expired_bios); |
| @@ -203,6 +209,8 @@ out: | |||
| 203 | ti->private = dc; | 209 | ti->private = dc; |
| 204 | return 0; | 210 | return 0; |
| 205 | 211 | ||
| 212 | bad_queue: | ||
| 213 | mempool_destroy(dc->delayed_pool); | ||
| 206 | bad_dev_write: | 214 | bad_dev_write: |
| 207 | if (dc->dev_write) | 215 | if (dc->dev_write) |
| 208 | dm_put_device(ti, dc->dev_write); | 216 | dm_put_device(ti, dc->dev_write); |
| @@ -217,7 +225,7 @@ static void delay_dtr(struct dm_target *ti) | |||
| 217 | { | 225 | { |
| 218 | struct delay_c *dc = ti->private; | 226 | struct delay_c *dc = ti->private; |
| 219 | 227 | ||
| 220 | flush_workqueue(kdelayd_wq); | 228 | destroy_workqueue(dc->kdelayd_wq); |
| 221 | 229 | ||
| 222 | dm_put_device(ti, dc->dev_read); | 230 | dm_put_device(ti, dc->dev_read); |
| 223 | 231 | ||
| @@ -350,12 +358,6 @@ static int __init dm_delay_init(void) | |||
| 350 | { | 358 | { |
| 351 | int r = -ENOMEM; | 359 | int r = -ENOMEM; |
| 352 | 360 | ||
| 353 | kdelayd_wq = alloc_workqueue("kdelayd", WQ_MEM_RECLAIM, 0); | ||
| 354 | if (!kdelayd_wq) { | ||
| 355 | DMERR("Couldn't start kdelayd"); | ||
| 356 | goto bad_queue; | ||
| 357 | } | ||
| 358 | |||
| 359 | delayed_cache = KMEM_CACHE(dm_delay_info, 0); | 361 | delayed_cache = KMEM_CACHE(dm_delay_info, 0); |
| 360 | if (!delayed_cache) { | 362 | if (!delayed_cache) { |
| 361 | DMERR("Couldn't create delayed bio cache."); | 363 | DMERR("Couldn't create delayed bio cache."); |
| @@ -373,8 +375,6 @@ static int __init dm_delay_init(void) | |||
| 373 | bad_register: | 375 | bad_register: |
| 374 | kmem_cache_destroy(delayed_cache); | 376 | kmem_cache_destroy(delayed_cache); |
| 375 | bad_memcache: | 377 | bad_memcache: |
| 376 | destroy_workqueue(kdelayd_wq); | ||
| 377 | bad_queue: | ||
| 378 | return r; | 378 | return r; |
| 379 | } | 379 | } |
| 380 | 380 | ||
| @@ -382,7 +382,6 @@ static void __exit dm_delay_exit(void) | |||
| 382 | { | 382 | { |
| 383 | dm_unregister_target(&delay_target); | 383 | dm_unregister_target(&delay_target); |
| 384 | kmem_cache_destroy(delayed_cache); | 384 | kmem_cache_destroy(delayed_cache); |
| 385 | destroy_workqueue(kdelayd_wq); | ||
| 386 | } | 385 | } |
| 387 | 386 | ||
| 388 | /* Module hooks */ | 387 | /* Module hooks */ |
diff --git a/drivers/md/dm-snap.c b/drivers/md/dm-snap.c index aec57d76db5d..944690bafd93 100644 --- a/drivers/md/dm-snap.c +++ b/drivers/md/dm-snap.c | |||
| @@ -66,6 +66,18 @@ struct dm_snapshot { | |||
| 66 | 66 | ||
| 67 | atomic_t pending_exceptions_count; | 67 | atomic_t pending_exceptions_count; |
| 68 | 68 | ||
| 69 | /* Protected by "lock" */ | ||
| 70 | sector_t exception_start_sequence; | ||
| 71 | |||
| 72 | /* Protected by kcopyd single-threaded callback */ | ||
| 73 | sector_t exception_complete_sequence; | ||
| 74 | |||
| 75 | /* | ||
| 76 | * A list of pending exceptions that completed out of order. | ||
| 77 | * Protected by kcopyd single-threaded callback. | ||
| 78 | */ | ||
| 79 | struct list_head out_of_order_list; | ||
| 80 | |||
| 69 | mempool_t *pending_pool; | 81 | mempool_t *pending_pool; |
| 70 | 82 | ||
| 71 | struct dm_exception_table pending; | 83 | struct dm_exception_table pending; |
| @@ -173,6 +185,14 @@ struct dm_snap_pending_exception { | |||
| 173 | */ | 185 | */ |
| 174 | int started; | 186 | int started; |
| 175 | 187 | ||
| 188 | /* There was copying error. */ | ||
| 189 | int copy_error; | ||
| 190 | |||
| 191 | /* A sequence number, it is used for in-order completion. */ | ||
| 192 | sector_t exception_sequence; | ||
| 193 | |||
| 194 | struct list_head out_of_order_entry; | ||
| 195 | |||
| 176 | /* | 196 | /* |
| 177 | * For writing a complete chunk, bypassing the copy. | 197 | * For writing a complete chunk, bypassing the copy. |
| 178 | */ | 198 | */ |
| @@ -1094,6 +1114,9 @@ static int snapshot_ctr(struct dm_target *ti, unsigned int argc, char **argv) | |||
| 1094 | s->valid = 1; | 1114 | s->valid = 1; |
| 1095 | s->active = 0; | 1115 | s->active = 0; |
| 1096 | atomic_set(&s->pending_exceptions_count, 0); | 1116 | atomic_set(&s->pending_exceptions_count, 0); |
| 1117 | s->exception_start_sequence = 0; | ||
| 1118 | s->exception_complete_sequence = 0; | ||
| 1119 | INIT_LIST_HEAD(&s->out_of_order_list); | ||
| 1097 | init_rwsem(&s->lock); | 1120 | init_rwsem(&s->lock); |
| 1098 | INIT_LIST_HEAD(&s->list); | 1121 | INIT_LIST_HEAD(&s->list); |
| 1099 | spin_lock_init(&s->pe_lock); | 1122 | spin_lock_init(&s->pe_lock); |
| @@ -1443,6 +1466,19 @@ static void commit_callback(void *context, int success) | |||
| 1443 | pending_complete(pe, success); | 1466 | pending_complete(pe, success); |
| 1444 | } | 1467 | } |
| 1445 | 1468 | ||
| 1469 | static void complete_exception(struct dm_snap_pending_exception *pe) | ||
| 1470 | { | ||
| 1471 | struct dm_snapshot *s = pe->snap; | ||
| 1472 | |||
| 1473 | if (unlikely(pe->copy_error)) | ||
| 1474 | pending_complete(pe, 0); | ||
| 1475 | |||
| 1476 | else | ||
| 1477 | /* Update the metadata if we are persistent */ | ||
| 1478 | s->store->type->commit_exception(s->store, &pe->e, | ||
| 1479 | commit_callback, pe); | ||
| 1480 | } | ||
| 1481 | |||
| 1446 | /* | 1482 | /* |
| 1447 | * Called when the copy I/O has finished. kcopyd actually runs | 1483 | * Called when the copy I/O has finished. kcopyd actually runs |
| 1448 | * this code so don't block. | 1484 | * this code so don't block. |
| @@ -1452,13 +1488,32 @@ static void copy_callback(int read_err, unsigned long write_err, void *context) | |||
| 1452 | struct dm_snap_pending_exception *pe = context; | 1488 | struct dm_snap_pending_exception *pe = context; |
| 1453 | struct dm_snapshot *s = pe->snap; | 1489 | struct dm_snapshot *s = pe->snap; |
| 1454 | 1490 | ||
| 1455 | if (read_err || write_err) | 1491 | pe->copy_error = read_err || write_err; |
| 1456 | pending_complete(pe, 0); | ||
| 1457 | 1492 | ||
| 1458 | else | 1493 | if (pe->exception_sequence == s->exception_complete_sequence) { |
| 1459 | /* Update the metadata if we are persistent */ | 1494 | s->exception_complete_sequence++; |
| 1460 | s->store->type->commit_exception(s->store, &pe->e, | 1495 | complete_exception(pe); |
| 1461 | commit_callback, pe); | 1496 | |
| 1497 | while (!list_empty(&s->out_of_order_list)) { | ||
| 1498 | pe = list_entry(s->out_of_order_list.next, | ||
| 1499 | struct dm_snap_pending_exception, out_of_order_entry); | ||
| 1500 | if (pe->exception_sequence != s->exception_complete_sequence) | ||
| 1501 | break; | ||
| 1502 | s->exception_complete_sequence++; | ||
| 1503 | list_del(&pe->out_of_order_entry); | ||
| 1504 | complete_exception(pe); | ||
| 1505 | } | ||
| 1506 | } else { | ||
| 1507 | struct list_head *lh; | ||
| 1508 | struct dm_snap_pending_exception *pe2; | ||
| 1509 | |||
| 1510 | list_for_each_prev(lh, &s->out_of_order_list) { | ||
| 1511 | pe2 = list_entry(lh, struct dm_snap_pending_exception, out_of_order_entry); | ||
| 1512 | if (pe2->exception_sequence < pe->exception_sequence) | ||
| 1513 | break; | ||
| 1514 | } | ||
| 1515 | list_add(&pe->out_of_order_entry, lh); | ||
| 1516 | } | ||
| 1462 | } | 1517 | } |
| 1463 | 1518 | ||
| 1464 | /* | 1519 | /* |
| @@ -1553,6 +1608,8 @@ __find_pending_exception(struct dm_snapshot *s, | |||
| 1553 | return NULL; | 1608 | return NULL; |
| 1554 | } | 1609 | } |
| 1555 | 1610 | ||
| 1611 | pe->exception_sequence = s->exception_start_sequence++; | ||
| 1612 | |||
| 1556 | dm_insert_exception(&s->pending, &pe->e); | 1613 | dm_insert_exception(&s->pending, &pe->e); |
| 1557 | 1614 | ||
| 1558 | return pe; | 1615 | return pe; |
| @@ -2192,7 +2249,7 @@ static struct target_type origin_target = { | |||
| 2192 | 2249 | ||
| 2193 | static struct target_type snapshot_target = { | 2250 | static struct target_type snapshot_target = { |
| 2194 | .name = "snapshot", | 2251 | .name = "snapshot", |
| 2195 | .version = {1, 11, 1}, | 2252 | .version = {1, 12, 0}, |
| 2196 | .module = THIS_MODULE, | 2253 | .module = THIS_MODULE, |
| 2197 | .ctr = snapshot_ctr, | 2254 | .ctr = snapshot_ctr, |
| 2198 | .dtr = snapshot_dtr, | 2255 | .dtr = snapshot_dtr, |
diff --git a/drivers/md/dm-stats.c b/drivers/md/dm-stats.c index 3d404c1371ed..28a90122a5a8 100644 --- a/drivers/md/dm-stats.c +++ b/drivers/md/dm-stats.c | |||
| @@ -964,6 +964,7 @@ int dm_stats_message(struct mapped_device *md, unsigned argc, char **argv, | |||
| 964 | 964 | ||
| 965 | int __init dm_statistics_init(void) | 965 | int __init dm_statistics_init(void) |
| 966 | { | 966 | { |
| 967 | shared_memory_amount = 0; | ||
| 967 | dm_stat_need_rcu_barrier = 0; | 968 | dm_stat_need_rcu_barrier = 0; |
| 968 | return 0; | 969 | return 0; |
| 969 | } | 970 | } |
diff --git a/drivers/md/dm-table.c b/drivers/md/dm-table.c index 465f08ca62b1..3ba6a3859ce3 100644 --- a/drivers/md/dm-table.c +++ b/drivers/md/dm-table.c | |||
| @@ -200,6 +200,11 @@ int dm_table_create(struct dm_table **result, fmode_t mode, | |||
| 200 | 200 | ||
| 201 | num_targets = dm_round_up(num_targets, KEYS_PER_NODE); | 201 | num_targets = dm_round_up(num_targets, KEYS_PER_NODE); |
| 202 | 202 | ||
| 203 | if (!num_targets) { | ||
| 204 | kfree(t); | ||
| 205 | return -ENOMEM; | ||
| 206 | } | ||
| 207 | |||
| 203 | if (alloc_targets(t, num_targets)) { | 208 | if (alloc_targets(t, num_targets)) { |
| 204 | kfree(t); | 209 | kfree(t); |
| 205 | return -ENOMEM; | 210 | return -ENOMEM; |
diff --git a/drivers/md/dm-thin-metadata.c b/drivers/md/dm-thin-metadata.c index 60bce435f4fa..8a30ad54bd46 100644 --- a/drivers/md/dm-thin-metadata.c +++ b/drivers/md/dm-thin-metadata.c | |||
| @@ -1697,6 +1697,14 @@ void dm_pool_metadata_read_only(struct dm_pool_metadata *pmd) | |||
| 1697 | up_write(&pmd->root_lock); | 1697 | up_write(&pmd->root_lock); |
| 1698 | } | 1698 | } |
| 1699 | 1699 | ||
| 1700 | void dm_pool_metadata_read_write(struct dm_pool_metadata *pmd) | ||
| 1701 | { | ||
| 1702 | down_write(&pmd->root_lock); | ||
| 1703 | pmd->read_only = false; | ||
| 1704 | dm_bm_set_read_write(pmd->bm); | ||
| 1705 | up_write(&pmd->root_lock); | ||
| 1706 | } | ||
| 1707 | |||
| 1700 | int dm_pool_register_metadata_threshold(struct dm_pool_metadata *pmd, | 1708 | int dm_pool_register_metadata_threshold(struct dm_pool_metadata *pmd, |
| 1701 | dm_block_t threshold, | 1709 | dm_block_t threshold, |
| 1702 | dm_sm_threshold_fn fn, | 1710 | dm_sm_threshold_fn fn, |
diff --git a/drivers/md/dm-thin-metadata.h b/drivers/md/dm-thin-metadata.h index 845ebbe589a9..7bcc0e1d6238 100644 --- a/drivers/md/dm-thin-metadata.h +++ b/drivers/md/dm-thin-metadata.h | |||
| @@ -193,6 +193,7 @@ int dm_pool_resize_metadata_dev(struct dm_pool_metadata *pmd, dm_block_t new_siz | |||
| 193 | * that nothing is changing. | 193 | * that nothing is changing. |
| 194 | */ | 194 | */ |
| 195 | void dm_pool_metadata_read_only(struct dm_pool_metadata *pmd); | 195 | void dm_pool_metadata_read_only(struct dm_pool_metadata *pmd); |
| 196 | void dm_pool_metadata_read_write(struct dm_pool_metadata *pmd); | ||
| 196 | 197 | ||
| 197 | int dm_pool_register_metadata_threshold(struct dm_pool_metadata *pmd, | 198 | int dm_pool_register_metadata_threshold(struct dm_pool_metadata *pmd, |
| 198 | dm_block_t threshold, | 199 | dm_block_t threshold, |
diff --git a/drivers/md/dm-thin.c b/drivers/md/dm-thin.c index 2c0cf511ec23..ee29037ffc2e 100644 --- a/drivers/md/dm-thin.c +++ b/drivers/md/dm-thin.c | |||
| @@ -640,7 +640,9 @@ static void process_prepared_mapping(struct dm_thin_new_mapping *m) | |||
| 640 | */ | 640 | */ |
| 641 | r = dm_thin_insert_block(tc->td, m->virt_block, m->data_block); | 641 | r = dm_thin_insert_block(tc->td, m->virt_block, m->data_block); |
| 642 | if (r) { | 642 | if (r) { |
| 643 | DMERR_LIMIT("dm_thin_insert_block() failed"); | 643 | DMERR_LIMIT("%s: dm_thin_insert_block() failed: error = %d", |
| 644 | dm_device_name(pool->pool_md), r); | ||
| 645 | set_pool_mode(pool, PM_READ_ONLY); | ||
| 644 | cell_error(pool, m->cell); | 646 | cell_error(pool, m->cell); |
| 645 | goto out; | 647 | goto out; |
| 646 | } | 648 | } |
| @@ -881,32 +883,23 @@ static void schedule_zero(struct thin_c *tc, dm_block_t virt_block, | |||
| 881 | } | 883 | } |
| 882 | } | 884 | } |
| 883 | 885 | ||
| 884 | static int commit(struct pool *pool) | ||
| 885 | { | ||
| 886 | int r; | ||
| 887 | |||
| 888 | r = dm_pool_commit_metadata(pool->pmd); | ||
| 889 | if (r) | ||
| 890 | DMERR_LIMIT("%s: commit failed: error = %d", | ||
| 891 | dm_device_name(pool->pool_md), r); | ||
| 892 | |||
| 893 | return r; | ||
| 894 | } | ||
| 895 | |||
| 896 | /* | 886 | /* |
| 897 | * A non-zero return indicates read_only or fail_io mode. | 887 | * A non-zero return indicates read_only or fail_io mode. |
| 898 | * Many callers don't care about the return value. | 888 | * Many callers don't care about the return value. |
| 899 | */ | 889 | */ |
| 900 | static int commit_or_fallback(struct pool *pool) | 890 | static int commit(struct pool *pool) |
| 901 | { | 891 | { |
| 902 | int r; | 892 | int r; |
| 903 | 893 | ||
| 904 | if (get_pool_mode(pool) != PM_WRITE) | 894 | if (get_pool_mode(pool) != PM_WRITE) |
| 905 | return -EINVAL; | 895 | return -EINVAL; |
| 906 | 896 | ||
| 907 | r = commit(pool); | 897 | r = dm_pool_commit_metadata(pool->pmd); |
| 908 | if (r) | 898 | if (r) { |
| 899 | DMERR_LIMIT("%s: dm_pool_commit_metadata failed: error = %d", | ||
| 900 | dm_device_name(pool->pool_md), r); | ||
| 909 | set_pool_mode(pool, PM_READ_ONLY); | 901 | set_pool_mode(pool, PM_READ_ONLY); |
| 902 | } | ||
| 910 | 903 | ||
| 911 | return r; | 904 | return r; |
| 912 | } | 905 | } |
| @@ -943,7 +936,9 @@ static int alloc_data_block(struct thin_c *tc, dm_block_t *result) | |||
| 943 | * Try to commit to see if that will free up some | 936 | * Try to commit to see if that will free up some |
| 944 | * more space. | 937 | * more space. |
| 945 | */ | 938 | */ |
| 946 | (void) commit_or_fallback(pool); | 939 | r = commit(pool); |
| 940 | if (r) | ||
| 941 | return r; | ||
| 947 | 942 | ||
| 948 | r = dm_pool_get_free_block_count(pool->pmd, &free_blocks); | 943 | r = dm_pool_get_free_block_count(pool->pmd, &free_blocks); |
| 949 | if (r) | 944 | if (r) |
| @@ -957,7 +952,7 @@ static int alloc_data_block(struct thin_c *tc, dm_block_t *result) | |||
| 957 | * table reload). | 952 | * table reload). |
| 958 | */ | 953 | */ |
| 959 | if (!free_blocks) { | 954 | if (!free_blocks) { |
| 960 | DMWARN("%s: no free space available.", | 955 | DMWARN("%s: no free data space available.", |
| 961 | dm_device_name(pool->pool_md)); | 956 | dm_device_name(pool->pool_md)); |
| 962 | spin_lock_irqsave(&pool->lock, flags); | 957 | spin_lock_irqsave(&pool->lock, flags); |
| 963 | pool->no_free_space = 1; | 958 | pool->no_free_space = 1; |
| @@ -967,8 +962,16 @@ static int alloc_data_block(struct thin_c *tc, dm_block_t *result) | |||
| 967 | } | 962 | } |
| 968 | 963 | ||
| 969 | r = dm_pool_alloc_data_block(pool->pmd, result); | 964 | r = dm_pool_alloc_data_block(pool->pmd, result); |
| 970 | if (r) | 965 | if (r) { |
| 966 | if (r == -ENOSPC && | ||
| 967 | !dm_pool_get_free_metadata_block_count(pool->pmd, &free_blocks) && | ||
| 968 | !free_blocks) { | ||
| 969 | DMWARN("%s: no free metadata space available.", | ||
| 970 | dm_device_name(pool->pool_md)); | ||
| 971 | set_pool_mode(pool, PM_READ_ONLY); | ||
| 972 | } | ||
| 971 | return r; | 973 | return r; |
| 974 | } | ||
| 972 | 975 | ||
| 973 | return 0; | 976 | return 0; |
| 974 | } | 977 | } |
| @@ -1349,7 +1352,7 @@ static void process_deferred_bios(struct pool *pool) | |||
| 1349 | if (bio_list_empty(&bios) && !need_commit_due_to_time(pool)) | 1352 | if (bio_list_empty(&bios) && !need_commit_due_to_time(pool)) |
| 1350 | return; | 1353 | return; |
| 1351 | 1354 | ||
| 1352 | if (commit_or_fallback(pool)) { | 1355 | if (commit(pool)) { |
| 1353 | while ((bio = bio_list_pop(&bios))) | 1356 | while ((bio = bio_list_pop(&bios))) |
| 1354 | bio_io_error(bio); | 1357 | bio_io_error(bio); |
| 1355 | return; | 1358 | return; |
| @@ -1397,6 +1400,7 @@ static void set_pool_mode(struct pool *pool, enum pool_mode mode) | |||
| 1397 | case PM_FAIL: | 1400 | case PM_FAIL: |
| 1398 | DMERR("%s: switching pool to failure mode", | 1401 | DMERR("%s: switching pool to failure mode", |
| 1399 | dm_device_name(pool->pool_md)); | 1402 | dm_device_name(pool->pool_md)); |
| 1403 | dm_pool_metadata_read_only(pool->pmd); | ||
| 1400 | pool->process_bio = process_bio_fail; | 1404 | pool->process_bio = process_bio_fail; |
| 1401 | pool->process_discard = process_bio_fail; | 1405 | pool->process_discard = process_bio_fail; |
| 1402 | pool->process_prepared_mapping = process_prepared_mapping_fail; | 1406 | pool->process_prepared_mapping = process_prepared_mapping_fail; |
| @@ -1421,6 +1425,7 @@ static void set_pool_mode(struct pool *pool, enum pool_mode mode) | |||
| 1421 | break; | 1425 | break; |
| 1422 | 1426 | ||
| 1423 | case PM_WRITE: | 1427 | case PM_WRITE: |
| 1428 | dm_pool_metadata_read_write(pool->pmd); | ||
| 1424 | pool->process_bio = process_bio; | 1429 | pool->process_bio = process_bio; |
| 1425 | pool->process_discard = process_discard; | 1430 | pool->process_discard = process_discard; |
| 1426 | pool->process_prepared_mapping = process_prepared_mapping; | 1431 | pool->process_prepared_mapping = process_prepared_mapping; |
| @@ -1637,12 +1642,19 @@ static int bind_control_target(struct pool *pool, struct dm_target *ti) | |||
| 1637 | struct pool_c *pt = ti->private; | 1642 | struct pool_c *pt = ti->private; |
| 1638 | 1643 | ||
| 1639 | /* | 1644 | /* |
| 1640 | * We want to make sure that degraded pools are never upgraded. | 1645 | * We want to make sure that a pool in PM_FAIL mode is never upgraded. |
| 1641 | */ | 1646 | */ |
| 1642 | enum pool_mode old_mode = pool->pf.mode; | 1647 | enum pool_mode old_mode = pool->pf.mode; |
| 1643 | enum pool_mode new_mode = pt->adjusted_pf.mode; | 1648 | enum pool_mode new_mode = pt->adjusted_pf.mode; |
| 1644 | 1649 | ||
| 1645 | if (old_mode > new_mode) | 1650 | /* |
| 1651 | * If we were in PM_FAIL mode, rollback of metadata failed. We're | ||
| 1652 | * not going to recover without a thin_repair. So we never let the | ||
| 1653 | * pool move out of the old mode. On the other hand a PM_READ_ONLY | ||
| 1654 | * may have been due to a lack of metadata or data space, and may | ||
| 1655 | * now work (ie. if the underlying devices have been resized). | ||
| 1656 | */ | ||
| 1657 | if (old_mode == PM_FAIL) | ||
| 1646 | new_mode = old_mode; | 1658 | new_mode = old_mode; |
| 1647 | 1659 | ||
| 1648 | pool->ti = ti; | 1660 | pool->ti = ti; |
| @@ -2266,7 +2278,7 @@ static int pool_preresume(struct dm_target *ti) | |||
| 2266 | return r; | 2278 | return r; |
| 2267 | 2279 | ||
| 2268 | if (need_commit1 || need_commit2) | 2280 | if (need_commit1 || need_commit2) |
| 2269 | (void) commit_or_fallback(pool); | 2281 | (void) commit(pool); |
| 2270 | 2282 | ||
| 2271 | return 0; | 2283 | return 0; |
| 2272 | } | 2284 | } |
| @@ -2293,7 +2305,7 @@ static void pool_postsuspend(struct dm_target *ti) | |||
| 2293 | 2305 | ||
| 2294 | cancel_delayed_work(&pool->waker); | 2306 | cancel_delayed_work(&pool->waker); |
| 2295 | flush_workqueue(pool->wq); | 2307 | flush_workqueue(pool->wq); |
| 2296 | (void) commit_or_fallback(pool); | 2308 | (void) commit(pool); |
| 2297 | } | 2309 | } |
| 2298 | 2310 | ||
| 2299 | static int check_arg_count(unsigned argc, unsigned args_required) | 2311 | static int check_arg_count(unsigned argc, unsigned args_required) |
| @@ -2427,7 +2439,7 @@ static int process_reserve_metadata_snap_mesg(unsigned argc, char **argv, struct | |||
| 2427 | if (r) | 2439 | if (r) |
| 2428 | return r; | 2440 | return r; |
| 2429 | 2441 | ||
| 2430 | (void) commit_or_fallback(pool); | 2442 | (void) commit(pool); |
| 2431 | 2443 | ||
| 2432 | r = dm_pool_reserve_metadata_snap(pool->pmd); | 2444 | r = dm_pool_reserve_metadata_snap(pool->pmd); |
| 2433 | if (r) | 2445 | if (r) |
| @@ -2489,7 +2501,7 @@ static int pool_message(struct dm_target *ti, unsigned argc, char **argv) | |||
| 2489 | DMWARN("Unrecognised thin pool target message received: %s", argv[0]); | 2501 | DMWARN("Unrecognised thin pool target message received: %s", argv[0]); |
| 2490 | 2502 | ||
| 2491 | if (!r) | 2503 | if (!r) |
| 2492 | (void) commit_or_fallback(pool); | 2504 | (void) commit(pool); |
| 2493 | 2505 | ||
| 2494 | return r; | 2506 | return r; |
| 2495 | } | 2507 | } |
| @@ -2544,7 +2556,7 @@ static void pool_status(struct dm_target *ti, status_type_t type, | |||
| 2544 | 2556 | ||
| 2545 | /* Commit to ensure statistics aren't out-of-date */ | 2557 | /* Commit to ensure statistics aren't out-of-date */ |
| 2546 | if (!(status_flags & DM_STATUS_NOFLUSH_FLAG) && !dm_suspended(ti)) | 2558 | if (!(status_flags & DM_STATUS_NOFLUSH_FLAG) && !dm_suspended(ti)) |
| 2547 | (void) commit_or_fallback(pool); | 2559 | (void) commit(pool); |
| 2548 | 2560 | ||
| 2549 | r = dm_pool_get_metadata_transaction_id(pool->pmd, &transaction_id); | 2561 | r = dm_pool_get_metadata_transaction_id(pool->pmd, &transaction_id); |
| 2550 | if (r) { | 2562 | if (r) { |
diff --git a/drivers/md/md.c b/drivers/md/md.c index b6b7a2866c9e..21f4d7ff0da2 100644 --- a/drivers/md/md.c +++ b/drivers/md/md.c | |||
| @@ -776,16 +776,10 @@ void md_super_wait(struct mddev *mddev) | |||
| 776 | finish_wait(&mddev->sb_wait, &wq); | 776 | finish_wait(&mddev->sb_wait, &wq); |
| 777 | } | 777 | } |
| 778 | 778 | ||
| 779 | static void bi_complete(struct bio *bio, int error) | ||
| 780 | { | ||
| 781 | complete((struct completion*)bio->bi_private); | ||
| 782 | } | ||
| 783 | |||
| 784 | int sync_page_io(struct md_rdev *rdev, sector_t sector, int size, | 779 | int sync_page_io(struct md_rdev *rdev, sector_t sector, int size, |
| 785 | struct page *page, int rw, bool metadata_op) | 780 | struct page *page, int rw, bool metadata_op) |
| 786 | { | 781 | { |
| 787 | struct bio *bio = bio_alloc_mddev(GFP_NOIO, 1, rdev->mddev); | 782 | struct bio *bio = bio_alloc_mddev(GFP_NOIO, 1, rdev->mddev); |
| 788 | struct completion event; | ||
| 789 | int ret; | 783 | int ret; |
| 790 | 784 | ||
| 791 | rw |= REQ_SYNC; | 785 | rw |= REQ_SYNC; |
| @@ -801,11 +795,7 @@ int sync_page_io(struct md_rdev *rdev, sector_t sector, int size, | |||
| 801 | else | 795 | else |
| 802 | bio->bi_sector = sector + rdev->data_offset; | 796 | bio->bi_sector = sector + rdev->data_offset; |
| 803 | bio_add_page(bio, page, size, 0); | 797 | bio_add_page(bio, page, size, 0); |
| 804 | init_completion(&event); | 798 | submit_bio_wait(rw, bio); |
| 805 | bio->bi_private = &event; | ||
| 806 | bio->bi_end_io = bi_complete; | ||
| 807 | submit_bio(rw, bio); | ||
| 808 | wait_for_completion(&event); | ||
| 809 | 799 | ||
| 810 | ret = test_bit(BIO_UPTODATE, &bio->bi_flags); | 800 | ret = test_bit(BIO_UPTODATE, &bio->bi_flags); |
| 811 | bio_put(bio); | 801 | bio_put(bio); |
| @@ -7777,7 +7767,7 @@ void md_check_recovery(struct mddev *mddev) | |||
| 7777 | if (mddev->ro && !test_bit(MD_RECOVERY_NEEDED, &mddev->recovery)) | 7767 | if (mddev->ro && !test_bit(MD_RECOVERY_NEEDED, &mddev->recovery)) |
| 7778 | return; | 7768 | return; |
| 7779 | if ( ! ( | 7769 | if ( ! ( |
| 7780 | (mddev->flags & ~ (1<<MD_CHANGE_PENDING)) || | 7770 | (mddev->flags & MD_UPDATE_SB_FLAGS & ~ (1<<MD_CHANGE_PENDING)) || |
| 7781 | test_bit(MD_RECOVERY_NEEDED, &mddev->recovery) || | 7771 | test_bit(MD_RECOVERY_NEEDED, &mddev->recovery) || |
| 7782 | test_bit(MD_RECOVERY_DONE, &mddev->recovery) || | 7772 | test_bit(MD_RECOVERY_DONE, &mddev->recovery) || |
| 7783 | (mddev->external == 0 && mddev->safemode == 1) || | 7773 | (mddev->external == 0 && mddev->safemode == 1) || |
diff --git a/drivers/md/persistent-data/dm-array.c b/drivers/md/persistent-data/dm-array.c index af96e24ec328..1d75b1dc1e2e 100644 --- a/drivers/md/persistent-data/dm-array.c +++ b/drivers/md/persistent-data/dm-array.c | |||
| @@ -317,8 +317,16 @@ static int shadow_ablock(struct dm_array_info *info, dm_block_t *root, | |||
| 317 | * The shadow op will often be a noop. Only insert if it really | 317 | * The shadow op will often be a noop. Only insert if it really |
| 318 | * copied data. | 318 | * copied data. |
| 319 | */ | 319 | */ |
| 320 | if (dm_block_location(*block) != b) | 320 | if (dm_block_location(*block) != b) { |
| 321 | /* | ||
| 322 | * dm_tm_shadow_block will have already decremented the old | ||
| 323 | * block, but it is still referenced by the btree. We | ||
| 324 | * increment to stop the insert decrementing it below zero | ||
| 325 | * when overwriting the old value. | ||
| 326 | */ | ||
| 327 | dm_tm_inc(info->btree_info.tm, b); | ||
| 321 | r = insert_ablock(info, index, *block, root); | 328 | r = insert_ablock(info, index, *block, root); |
| 329 | } | ||
| 322 | 330 | ||
| 323 | return r; | 331 | return r; |
| 324 | } | 332 | } |
diff --git a/drivers/md/persistent-data/dm-block-manager.c b/drivers/md/persistent-data/dm-block-manager.c index a7e8bf296388..064a3c271baa 100644 --- a/drivers/md/persistent-data/dm-block-manager.c +++ b/drivers/md/persistent-data/dm-block-manager.c | |||
| @@ -626,6 +626,12 @@ void dm_bm_set_read_only(struct dm_block_manager *bm) | |||
| 626 | } | 626 | } |
| 627 | EXPORT_SYMBOL_GPL(dm_bm_set_read_only); | 627 | EXPORT_SYMBOL_GPL(dm_bm_set_read_only); |
| 628 | 628 | ||
| 629 | void dm_bm_set_read_write(struct dm_block_manager *bm) | ||
| 630 | { | ||
| 631 | bm->read_only = false; | ||
| 632 | } | ||
| 633 | EXPORT_SYMBOL_GPL(dm_bm_set_read_write); | ||
| 634 | |||
| 629 | u32 dm_bm_checksum(const void *data, size_t len, u32 init_xor) | 635 | u32 dm_bm_checksum(const void *data, size_t len, u32 init_xor) |
| 630 | { | 636 | { |
| 631 | return crc32c(~(u32) 0, data, len) ^ init_xor; | 637 | return crc32c(~(u32) 0, data, len) ^ init_xor; |
diff --git a/drivers/md/persistent-data/dm-block-manager.h b/drivers/md/persistent-data/dm-block-manager.h index 9a82083a66b6..13cd58e1fe69 100644 --- a/drivers/md/persistent-data/dm-block-manager.h +++ b/drivers/md/persistent-data/dm-block-manager.h | |||
| @@ -108,9 +108,9 @@ int dm_bm_unlock(struct dm_block *b); | |||
| 108 | int dm_bm_flush_and_unlock(struct dm_block_manager *bm, | 108 | int dm_bm_flush_and_unlock(struct dm_block_manager *bm, |
| 109 | struct dm_block *superblock); | 109 | struct dm_block *superblock); |
| 110 | 110 | ||
| 111 | /* | 111 | /* |
| 112 | * Request data be prefetched into the cache. | 112 | * Request data is prefetched into the cache. |
| 113 | */ | 113 | */ |
| 114 | void dm_bm_prefetch(struct dm_block_manager *bm, dm_block_t b); | 114 | void dm_bm_prefetch(struct dm_block_manager *bm, dm_block_t b); |
| 115 | 115 | ||
| 116 | /* | 116 | /* |
| @@ -125,6 +125,7 @@ void dm_bm_prefetch(struct dm_block_manager *bm, dm_block_t b); | |||
| 125 | * be returned if you do. | 125 | * be returned if you do. |
| 126 | */ | 126 | */ |
| 127 | void dm_bm_set_read_only(struct dm_block_manager *bm); | 127 | void dm_bm_set_read_only(struct dm_block_manager *bm); |
| 128 | void dm_bm_set_read_write(struct dm_block_manager *bm); | ||
| 128 | 129 | ||
| 129 | u32 dm_bm_checksum(const void *data, size_t len, u32 init_xor); | 130 | u32 dm_bm_checksum(const void *data, size_t len, u32 init_xor); |
| 130 | 131 | ||
diff --git a/drivers/md/persistent-data/dm-space-map-common.c b/drivers/md/persistent-data/dm-space-map-common.c index 6058569fe86c..466a60bbd716 100644 --- a/drivers/md/persistent-data/dm-space-map-common.c +++ b/drivers/md/persistent-data/dm-space-map-common.c | |||
| @@ -381,7 +381,7 @@ int sm_ll_find_free_block(struct ll_disk *ll, dm_block_t begin, | |||
| 381 | } | 381 | } |
| 382 | 382 | ||
| 383 | static int sm_ll_mutate(struct ll_disk *ll, dm_block_t b, | 383 | static int sm_ll_mutate(struct ll_disk *ll, dm_block_t b, |
| 384 | uint32_t (*mutator)(void *context, uint32_t old), | 384 | int (*mutator)(void *context, uint32_t old, uint32_t *new), |
| 385 | void *context, enum allocation_event *ev) | 385 | void *context, enum allocation_event *ev) |
| 386 | { | 386 | { |
| 387 | int r; | 387 | int r; |
| @@ -410,11 +410,17 @@ static int sm_ll_mutate(struct ll_disk *ll, dm_block_t b, | |||
| 410 | 410 | ||
| 411 | if (old > 2) { | 411 | if (old > 2) { |
| 412 | r = sm_ll_lookup_big_ref_count(ll, b, &old); | 412 | r = sm_ll_lookup_big_ref_count(ll, b, &old); |
| 413 | if (r < 0) | 413 | if (r < 0) { |
| 414 | dm_tm_unlock(ll->tm, nb); | ||
| 414 | return r; | 415 | return r; |
| 416 | } | ||
| 415 | } | 417 | } |
| 416 | 418 | ||
| 417 | ref_count = mutator(context, old); | 419 | r = mutator(context, old, &ref_count); |
| 420 | if (r) { | ||
| 421 | dm_tm_unlock(ll->tm, nb); | ||
| 422 | return r; | ||
| 423 | } | ||
| 418 | 424 | ||
| 419 | if (ref_count <= 2) { | 425 | if (ref_count <= 2) { |
| 420 | sm_set_bitmap(bm_le, bit, ref_count); | 426 | sm_set_bitmap(bm_le, bit, ref_count); |
| @@ -465,9 +471,10 @@ static int sm_ll_mutate(struct ll_disk *ll, dm_block_t b, | |||
| 465 | return ll->save_ie(ll, index, &ie_disk); | 471 | return ll->save_ie(ll, index, &ie_disk); |
| 466 | } | 472 | } |
| 467 | 473 | ||
| 468 | static uint32_t set_ref_count(void *context, uint32_t old) | 474 | static int set_ref_count(void *context, uint32_t old, uint32_t *new) |
| 469 | { | 475 | { |
| 470 | return *((uint32_t *) context); | 476 | *new = *((uint32_t *) context); |
| 477 | return 0; | ||
| 471 | } | 478 | } |
| 472 | 479 | ||
| 473 | int sm_ll_insert(struct ll_disk *ll, dm_block_t b, | 480 | int sm_ll_insert(struct ll_disk *ll, dm_block_t b, |
| @@ -476,9 +483,10 @@ int sm_ll_insert(struct ll_disk *ll, dm_block_t b, | |||
| 476 | return sm_ll_mutate(ll, b, set_ref_count, &ref_count, ev); | 483 | return sm_ll_mutate(ll, b, set_ref_count, &ref_count, ev); |
| 477 | } | 484 | } |
| 478 | 485 | ||
| 479 | static uint32_t inc_ref_count(void *context, uint32_t old) | 486 | static int inc_ref_count(void *context, uint32_t old, uint32_t *new) |
| 480 | { | 487 | { |
| 481 | return old + 1; | 488 | *new = old + 1; |
| 489 | return 0; | ||
| 482 | } | 490 | } |
| 483 | 491 | ||
| 484 | int sm_ll_inc(struct ll_disk *ll, dm_block_t b, enum allocation_event *ev) | 492 | int sm_ll_inc(struct ll_disk *ll, dm_block_t b, enum allocation_event *ev) |
| @@ -486,9 +494,15 @@ int sm_ll_inc(struct ll_disk *ll, dm_block_t b, enum allocation_event *ev) | |||
| 486 | return sm_ll_mutate(ll, b, inc_ref_count, NULL, ev); | 494 | return sm_ll_mutate(ll, b, inc_ref_count, NULL, ev); |
| 487 | } | 495 | } |
| 488 | 496 | ||
| 489 | static uint32_t dec_ref_count(void *context, uint32_t old) | 497 | static int dec_ref_count(void *context, uint32_t old, uint32_t *new) |
| 490 | { | 498 | { |
| 491 | return old - 1; | 499 | if (!old) { |
| 500 | DMERR_LIMIT("unable to decrement a reference count below 0"); | ||
| 501 | return -EINVAL; | ||
| 502 | } | ||
| 503 | |||
| 504 | *new = old - 1; | ||
| 505 | return 0; | ||
| 492 | } | 506 | } |
| 493 | 507 | ||
| 494 | int sm_ll_dec(struct ll_disk *ll, dm_block_t b, enum allocation_event *ev) | 508 | int sm_ll_dec(struct ll_disk *ll, dm_block_t b, enum allocation_event *ev) |
diff --git a/drivers/md/persistent-data/dm-space-map-metadata.c b/drivers/md/persistent-data/dm-space-map-metadata.c index 1c959684caef..58fc1eef7499 100644 --- a/drivers/md/persistent-data/dm-space-map-metadata.c +++ b/drivers/md/persistent-data/dm-space-map-metadata.c | |||
| @@ -384,12 +384,16 @@ static int sm_metadata_new_block(struct dm_space_map *sm, dm_block_t *b) | |||
| 384 | struct sm_metadata *smm = container_of(sm, struct sm_metadata, sm); | 384 | struct sm_metadata *smm = container_of(sm, struct sm_metadata, sm); |
| 385 | 385 | ||
| 386 | int r = sm_metadata_new_block_(sm, b); | 386 | int r = sm_metadata_new_block_(sm, b); |
| 387 | if (r) | 387 | if (r) { |
| 388 | DMERR("unable to allocate new metadata block"); | 388 | DMERR("unable to allocate new metadata block"); |
| 389 | return r; | ||
| 390 | } | ||
| 389 | 391 | ||
| 390 | r = sm_metadata_get_nr_free(sm, &count); | 392 | r = sm_metadata_get_nr_free(sm, &count); |
| 391 | if (r) | 393 | if (r) { |
| 392 | DMERR("couldn't get free block count"); | 394 | DMERR("couldn't get free block count"); |
| 395 | return r; | ||
| 396 | } | ||
| 393 | 397 | ||
| 394 | check_threshold(&smm->threshold, count); | 398 | check_threshold(&smm->threshold, count); |
| 395 | 399 | ||
diff --git a/drivers/md/raid5.c b/drivers/md/raid5.c index 47da0af6322b..cc055da02e2a 100644 --- a/drivers/md/raid5.c +++ b/drivers/md/raid5.c | |||
| @@ -678,26 +678,23 @@ get_active_stripe(struct r5conf *conf, sector_t sector, | |||
| 678 | } else | 678 | } else |
| 679 | init_stripe(sh, sector, previous); | 679 | init_stripe(sh, sector, previous); |
| 680 | } else { | 680 | } else { |
| 681 | spin_lock(&conf->device_lock); | ||
| 681 | if (atomic_read(&sh->count)) { | 682 | if (atomic_read(&sh->count)) { |
| 682 | BUG_ON(!list_empty(&sh->lru) | 683 | BUG_ON(!list_empty(&sh->lru) |
| 683 | && !test_bit(STRIPE_EXPANDING, &sh->state) | 684 | && !test_bit(STRIPE_EXPANDING, &sh->state) |
| 684 | && !test_bit(STRIPE_ON_UNPLUG_LIST, &sh->state) | 685 | && !test_bit(STRIPE_ON_UNPLUG_LIST, &sh->state) |
| 685 | && !test_bit(STRIPE_ON_RELEASE_LIST, &sh->state)); | 686 | ); |
| 686 | } else { | 687 | } else { |
| 687 | spin_lock(&conf->device_lock); | ||
| 688 | if (!test_bit(STRIPE_HANDLE, &sh->state)) | 688 | if (!test_bit(STRIPE_HANDLE, &sh->state)) |
| 689 | atomic_inc(&conf->active_stripes); | 689 | atomic_inc(&conf->active_stripes); |
| 690 | if (list_empty(&sh->lru) && | 690 | BUG_ON(list_empty(&sh->lru)); |
| 691 | !test_bit(STRIPE_ON_RELEASE_LIST, &sh->state) && | ||
| 692 | !test_bit(STRIPE_EXPANDING, &sh->state)) | ||
| 693 | BUG(); | ||
| 694 | list_del_init(&sh->lru); | 691 | list_del_init(&sh->lru); |
| 695 | if (sh->group) { | 692 | if (sh->group) { |
| 696 | sh->group->stripes_cnt--; | 693 | sh->group->stripes_cnt--; |
| 697 | sh->group = NULL; | 694 | sh->group = NULL; |
| 698 | } | 695 | } |
| 699 | spin_unlock(&conf->device_lock); | ||
| 700 | } | 696 | } |
| 697 | spin_unlock(&conf->device_lock); | ||
| 701 | } | 698 | } |
| 702 | } while (sh == NULL); | 699 | } while (sh == NULL); |
| 703 | 700 | ||
| @@ -5471,7 +5468,7 @@ static int alloc_thread_groups(struct r5conf *conf, int cnt, | |||
| 5471 | for (i = 0; i < *group_cnt; i++) { | 5468 | for (i = 0; i < *group_cnt; i++) { |
| 5472 | struct r5worker_group *group; | 5469 | struct r5worker_group *group; |
| 5473 | 5470 | ||
| 5474 | group = worker_groups[i]; | 5471 | group = &(*worker_groups)[i]; |
| 5475 | INIT_LIST_HEAD(&group->handle_list); | 5472 | INIT_LIST_HEAD(&group->handle_list); |
| 5476 | group->conf = conf; | 5473 | group->conf = conf; |
| 5477 | group->workers = workers + i * cnt; | 5474 | group->workers = workers + i * cnt; |
diff --git a/drivers/media/common/siano/smscoreapi.h b/drivers/media/common/siano/smscoreapi.h index d0799e323364..9c9063cd3208 100644 --- a/drivers/media/common/siano/smscoreapi.h +++ b/drivers/media/common/siano/smscoreapi.h | |||
| @@ -955,7 +955,7 @@ struct sms_rx_stats { | |||
| 955 | u32 modem_state; /* from SMSHOSTLIB_DVB_MODEM_STATE_ET */ | 955 | u32 modem_state; /* from SMSHOSTLIB_DVB_MODEM_STATE_ET */ |
| 956 | s32 SNR; /* dB */ | 956 | s32 SNR; /* dB */ |
| 957 | u32 ber; /* Post Viterbi ber [1E-5] */ | 957 | u32 ber; /* Post Viterbi ber [1E-5] */ |
| 958 | u32 ber_error_count; /* Number of erronous SYNC bits. */ | 958 | u32 ber_error_count; /* Number of erroneous SYNC bits. */ |
| 959 | u32 ber_bit_count; /* Total number of SYNC bits. */ | 959 | u32 ber_bit_count; /* Total number of SYNC bits. */ |
| 960 | u32 ts_per; /* Transport stream PER, | 960 | u32 ts_per; /* Transport stream PER, |
| 961 | 0xFFFFFFFF indicate N/A */ | 961 | 0xFFFFFFFF indicate N/A */ |
| @@ -981,7 +981,7 @@ struct sms_rx_stats_ex { | |||
| 981 | u32 modem_state; /* from SMSHOSTLIB_DVB_MODEM_STATE_ET */ | 981 | u32 modem_state; /* from SMSHOSTLIB_DVB_MODEM_STATE_ET */ |
| 982 | s32 SNR; /* dB */ | 982 | s32 SNR; /* dB */ |
| 983 | u32 ber; /* Post Viterbi ber [1E-5] */ | 983 | u32 ber; /* Post Viterbi ber [1E-5] */ |
| 984 | u32 ber_error_count; /* Number of erronous SYNC bits. */ | 984 | u32 ber_error_count; /* Number of erroneous SYNC bits. */ |
| 985 | u32 ber_bit_count; /* Total number of SYNC bits. */ | 985 | u32 ber_bit_count; /* Total number of SYNC bits. */ |
| 986 | u32 ts_per; /* Transport stream PER, | 986 | u32 ts_per; /* Transport stream PER, |
| 987 | 0xFFFFFFFF indicate N/A */ | 987 | 0xFFFFFFFF indicate N/A */ |
diff --git a/drivers/media/common/siano/smsdvb.h b/drivers/media/common/siano/smsdvb.h index 92c413ba0c79..ae36d0ae0fb1 100644 --- a/drivers/media/common/siano/smsdvb.h +++ b/drivers/media/common/siano/smsdvb.h | |||
| @@ -95,7 +95,7 @@ struct RECEPTION_STATISTICS_PER_SLICES_S { | |||
| 95 | u32 is_demod_locked; /* 0 - not locked, 1 - locked */ | 95 | u32 is_demod_locked; /* 0 - not locked, 1 - locked */ |
| 96 | 96 | ||
| 97 | u32 ber_bit_count; /* Total number of SYNC bits. */ | 97 | u32 ber_bit_count; /* Total number of SYNC bits. */ |
| 98 | u32 ber_error_count; /* Number of erronous SYNC bits. */ | 98 | u32 ber_error_count; /* Number of erroneous SYNC bits. */ |
| 99 | 99 | ||
| 100 | s32 MRC_SNR; /* dB */ | 100 | s32 MRC_SNR; /* dB */ |
| 101 | s32 mrc_in_band_pwr; /* In band power in dBM */ | 101 | s32 mrc_in_band_pwr; /* In band power in dBM */ |
diff --git a/drivers/media/dvb-core/dvb_demux.c b/drivers/media/dvb-core/dvb_demux.c index 58de4410c525..6c7ff0cdcd32 100644 --- a/drivers/media/dvb-core/dvb_demux.c +++ b/drivers/media/dvb-core/dvb_demux.c | |||
| @@ -435,7 +435,7 @@ static void dvb_dmx_swfilter_packet(struct dvb_demux *demux, const u8 *buf) | |||
| 435 | dprintk_tscheck("TEI detected. " | 435 | dprintk_tscheck("TEI detected. " |
| 436 | "PID=0x%x data1=0x%x\n", | 436 | "PID=0x%x data1=0x%x\n", |
| 437 | pid, buf[1]); | 437 | pid, buf[1]); |
| 438 | /* data in this packet cant be trusted - drop it unless | 438 | /* data in this packet can't be trusted - drop it unless |
| 439 | * module option dvb_demux_feed_err_pkts is set */ | 439 | * module option dvb_demux_feed_err_pkts is set */ |
| 440 | if (!dvb_demux_feed_err_pkts) | 440 | if (!dvb_demux_feed_err_pkts) |
| 441 | return; | 441 | return; |
| @@ -1032,8 +1032,13 @@ static int dmx_section_feed_release_filter(struct dmx_section_feed *feed, | |||
| 1032 | return -EINVAL; | 1032 | return -EINVAL; |
| 1033 | } | 1033 | } |
| 1034 | 1034 | ||
| 1035 | if (feed->is_filtering) | 1035 | if (feed->is_filtering) { |
| 1036 | /* release dvbdmx->mutex as far as it is | ||
| 1037 | acquired by stop_filtering() itself */ | ||
| 1038 | mutex_unlock(&dvbdmx->mutex); | ||
| 1036 | feed->stop_filtering(feed); | 1039 | feed->stop_filtering(feed); |
| 1040 | mutex_lock(&dvbdmx->mutex); | ||
| 1041 | } | ||
| 1037 | 1042 | ||
| 1038 | spin_lock_irq(&dvbdmx->lock); | 1043 | spin_lock_irq(&dvbdmx->lock); |
| 1039 | f = dvbdmxfeed->filter; | 1044 | f = dvbdmxfeed->filter; |
diff --git a/drivers/media/dvb-frontends/af9033.c b/drivers/media/dvb-frontends/af9033.c index 30ee59052157..65728c25ea05 100644 --- a/drivers/media/dvb-frontends/af9033.c +++ b/drivers/media/dvb-frontends/af9033.c | |||
| @@ -170,18 +170,18 @@ static int af9033_rd_reg_mask(struct af9033_state *state, u32 reg, u8 *val, | |||
| 170 | static int af9033_wr_reg_val_tab(struct af9033_state *state, | 170 | static int af9033_wr_reg_val_tab(struct af9033_state *state, |
| 171 | const struct reg_val *tab, int tab_len) | 171 | const struct reg_val *tab, int tab_len) |
| 172 | { | 172 | { |
| 173 | #define MAX_TAB_LEN 212 | ||
| 173 | int ret, i, j; | 174 | int ret, i, j; |
| 174 | u8 buf[MAX_XFER_SIZE]; | 175 | u8 buf[1 + MAX_TAB_LEN]; |
| 176 | |||
| 177 | dev_dbg(&state->i2c->dev, "%s: tab_len=%d\n", __func__, tab_len); | ||
| 175 | 178 | ||
| 176 | if (tab_len > sizeof(buf)) { | 179 | if (tab_len > sizeof(buf)) { |
| 177 | dev_warn(&state->i2c->dev, | 180 | dev_warn(&state->i2c->dev, "%s: tab len %d is too big\n", |
| 178 | "%s: i2c wr len=%d is too big!\n", | 181 | KBUILD_MODNAME, tab_len); |
| 179 | KBUILD_MODNAME, tab_len); | ||
| 180 | return -EINVAL; | 182 | return -EINVAL; |
| 181 | } | 183 | } |
| 182 | 184 | ||
| 183 | dev_dbg(&state->i2c->dev, "%s: tab_len=%d\n", __func__, tab_len); | ||
| 184 | |||
| 185 | for (i = 0, j = 0; i < tab_len; i++) { | 185 | for (i = 0, j = 0; i < tab_len; i++) { |
| 186 | buf[j] = tab[i].val; | 186 | buf[j] = tab[i].val; |
| 187 | 187 | ||
diff --git a/drivers/media/dvb-frontends/cxd2820r_c.c b/drivers/media/dvb-frontends/cxd2820r_c.c index 125a44041011..5c6ab4921bf1 100644 --- a/drivers/media/dvb-frontends/cxd2820r_c.c +++ b/drivers/media/dvb-frontends/cxd2820r_c.c | |||
| @@ -78,7 +78,7 @@ int cxd2820r_set_frontend_c(struct dvb_frontend *fe) | |||
| 78 | 78 | ||
| 79 | num = if_freq / 1000; /* Hz => kHz */ | 79 | num = if_freq / 1000; /* Hz => kHz */ |
| 80 | num *= 0x4000; | 80 | num *= 0x4000; |
| 81 | if_ctl = cxd2820r_div_u64_round_closest(num, 41000); | 81 | if_ctl = 0x4000 - cxd2820r_div_u64_round_closest(num, 41000); |
| 82 | buf[0] = (if_ctl >> 8) & 0x3f; | 82 | buf[0] = (if_ctl >> 8) & 0x3f; |
| 83 | buf[1] = (if_ctl >> 0) & 0xff; | 83 | buf[1] = (if_ctl >> 0) & 0xff; |
| 84 | 84 | ||
diff --git a/drivers/media/dvb-frontends/dib8000.c b/drivers/media/dvb-frontends/dib8000.c index 90536147bf04..6dbbee453ee1 100644 --- a/drivers/media/dvb-frontends/dib8000.c +++ b/drivers/media/dvb-frontends/dib8000.c | |||
| @@ -3048,7 +3048,7 @@ static int dib8000_tune(struct dvb_frontend *fe) | |||
| 3048 | dib8000_set_diversity_in(state->fe[0], state->diversity_onoff); | 3048 | dib8000_set_diversity_in(state->fe[0], state->diversity_onoff); |
| 3049 | 3049 | ||
| 3050 | locks = (dib8000_read_word(state, 180) >> 6) & 0x3f; /* P_coff_winlen ? */ | 3050 | locks = (dib8000_read_word(state, 180) >> 6) & 0x3f; /* P_coff_winlen ? */ |
| 3051 | /* coff should lock over P_coff_winlen ofdm symbols : give 3 times this lenght to lock */ | 3051 | /* coff should lock over P_coff_winlen ofdm symbols : give 3 times this length to lock */ |
| 3052 | *timeout = dib8000_get_timeout(state, 2 * locks, SYMBOL_DEPENDENT_ON); | 3052 | *timeout = dib8000_get_timeout(state, 2 * locks, SYMBOL_DEPENDENT_ON); |
| 3053 | *tune_state = CT_DEMOD_STEP_5; | 3053 | *tune_state = CT_DEMOD_STEP_5; |
| 3054 | break; | 3054 | break; |
| @@ -3115,7 +3115,7 @@ static int dib8000_tune(struct dvb_frontend *fe) | |||
| 3115 | 3115 | ||
| 3116 | case CT_DEMOD_STEP_9: /* 39 */ | 3116 | case CT_DEMOD_STEP_9: /* 39 */ |
| 3117 | if ((state->revision == 0x8090) || ((dib8000_read_word(state, 1291) >> 9) & 0x1)) { /* fe capable of deinterleaving : esram */ | 3117 | if ((state->revision == 0x8090) || ((dib8000_read_word(state, 1291) >> 9) & 0x1)) { /* fe capable of deinterleaving : esram */ |
| 3118 | /* defines timeout for mpeg lock depending on interleaver lenght of longest layer */ | 3118 | /* defines timeout for mpeg lock depending on interleaver length of longest layer */ |
| 3119 | for (i = 0; i < 3; i++) { | 3119 | for (i = 0; i < 3; i++) { |
| 3120 | if (c->layer[i].interleaving >= deeper_interleaver) { | 3120 | if (c->layer[i].interleaving >= deeper_interleaver) { |
| 3121 | dprintk("layer%i: time interleaver = %d ", i, c->layer[i].interleaving); | 3121 | dprintk("layer%i: time interleaver = %d ", i, c->layer[i].interleaving); |
diff --git a/drivers/media/dvb-frontends/drxk_hard.c b/drivers/media/dvb-frontends/drxk_hard.c index d416c15691da..bf29a3f0e6f0 100644 --- a/drivers/media/dvb-frontends/drxk_hard.c +++ b/drivers/media/dvb-frontends/drxk_hard.c | |||
| @@ -1191,7 +1191,7 @@ static int mpegts_configure_pins(struct drxk_state *state, bool mpeg_enable) | |||
| 1191 | goto error; | 1191 | goto error; |
| 1192 | 1192 | ||
| 1193 | if (state->m_enable_parallel == true) { | 1193 | if (state->m_enable_parallel == true) { |
| 1194 | /* paralel -> enable MD1 to MD7 */ | 1194 | /* parallel -> enable MD1 to MD7 */ |
| 1195 | status = write16(state, SIO_PDR_MD1_CFG__A, | 1195 | status = write16(state, SIO_PDR_MD1_CFG__A, |
| 1196 | sio_pdr_mdx_cfg); | 1196 | sio_pdr_mdx_cfg); |
| 1197 | if (status < 0) | 1197 | if (status < 0) |
| @@ -1428,7 +1428,7 @@ static int mpegts_stop(struct drxk_state *state) | |||
| 1428 | 1428 | ||
| 1429 | dprintk(1, "\n"); | 1429 | dprintk(1, "\n"); |
| 1430 | 1430 | ||
| 1431 | /* Gracefull shutdown (byte boundaries) */ | 1431 | /* Graceful shutdown (byte boundaries) */ |
| 1432 | status = read16(state, FEC_OC_SNC_MODE__A, &fec_oc_snc_mode); | 1432 | status = read16(state, FEC_OC_SNC_MODE__A, &fec_oc_snc_mode); |
| 1433 | if (status < 0) | 1433 | if (status < 0) |
| 1434 | goto error; | 1434 | goto error; |
| @@ -2021,7 +2021,7 @@ static int mpegts_dto_setup(struct drxk_state *state, | |||
| 2021 | fec_oc_dto_burst_len = 204; | 2021 | fec_oc_dto_burst_len = 204; |
| 2022 | } | 2022 | } |
| 2023 | 2023 | ||
| 2024 | /* Check serial or parrallel output */ | 2024 | /* Check serial or parallel output */ |
| 2025 | fec_oc_reg_ipr_mode &= (~(FEC_OC_IPR_MODE_SERIAL__M)); | 2025 | fec_oc_reg_ipr_mode &= (~(FEC_OC_IPR_MODE_SERIAL__M)); |
| 2026 | if (state->m_enable_parallel == false) { | 2026 | if (state->m_enable_parallel == false) { |
| 2027 | /* MPEG data output is serial -> set ipr_mode[0] */ | 2027 | /* MPEG data output is serial -> set ipr_mode[0] */ |
| @@ -2908,7 +2908,7 @@ static int adc_synchronization(struct drxk_state *state) | |||
| 2908 | goto error; | 2908 | goto error; |
| 2909 | 2909 | ||
| 2910 | if (count == 1) { | 2910 | if (count == 1) { |
| 2911 | /* Try sampling on a diffrent edge */ | 2911 | /* Try sampling on a different edge */ |
| 2912 | u16 clk_neg = 0; | 2912 | u16 clk_neg = 0; |
| 2913 | 2913 | ||
| 2914 | status = read16(state, IQM_AF_CLKNEG__A, &clk_neg); | 2914 | status = read16(state, IQM_AF_CLKNEG__A, &clk_neg); |
| @@ -3306,7 +3306,7 @@ static int dvbt_sc_command(struct drxk_state *state, | |||
| 3306 | if (status < 0) | 3306 | if (status < 0) |
| 3307 | goto error; | 3307 | goto error; |
| 3308 | 3308 | ||
| 3309 | /* Retreive results parameters from SC */ | 3309 | /* Retrieve results parameters from SC */ |
| 3310 | switch (cmd) { | 3310 | switch (cmd) { |
| 3311 | /* All commands yielding 5 results */ | 3311 | /* All commands yielding 5 results */ |
| 3312 | /* All commands yielding 4 results */ | 3312 | /* All commands yielding 4 results */ |
| @@ -3849,7 +3849,7 @@ static int set_dvbt(struct drxk_state *state, u16 intermediate_freqk_hz, | |||
| 3849 | break; | 3849 | break; |
| 3850 | } | 3850 | } |
| 3851 | #if 0 | 3851 | #if 0 |
| 3852 | /* No hierachical channels support in BDA */ | 3852 | /* No hierarchical channels support in BDA */ |
| 3853 | /* Priority (only for hierarchical channels) */ | 3853 | /* Priority (only for hierarchical channels) */ |
| 3854 | switch (channel->priority) { | 3854 | switch (channel->priority) { |
| 3855 | case DRX_PRIORITY_LOW: | 3855 | case DRX_PRIORITY_LOW: |
| @@ -4081,7 +4081,7 @@ error: | |||
| 4081 | /*============================================================================*/ | 4081 | /*============================================================================*/ |
| 4082 | 4082 | ||
| 4083 | /** | 4083 | /** |
| 4084 | * \brief Retreive lock status . | 4084 | * \brief Retrieve lock status . |
| 4085 | * \param demod Pointer to demodulator instance. | 4085 | * \param demod Pointer to demodulator instance. |
| 4086 | * \param lockStat Pointer to lock status structure. | 4086 | * \param lockStat Pointer to lock status structure. |
| 4087 | * \return DRXStatus_t. | 4087 | * \return DRXStatus_t. |
| @@ -6174,7 +6174,7 @@ static int init_drxk(struct drxk_state *state) | |||
| 6174 | goto error; | 6174 | goto error; |
| 6175 | 6175 | ||
| 6176 | /* Stamp driver version number in SCU data RAM in BCD code | 6176 | /* Stamp driver version number in SCU data RAM in BCD code |
| 6177 | Done to enable field application engineers to retreive drxdriver version | 6177 | Done to enable field application engineers to retrieve drxdriver version |
| 6178 | via I2C from SCU RAM. | 6178 | via I2C from SCU RAM. |
| 6179 | Not using SCU command interface for SCU register access since no | 6179 | Not using SCU command interface for SCU register access since no |
| 6180 | microcode may be present. | 6180 | microcode may be present. |
| @@ -6399,7 +6399,7 @@ static int drxk_set_parameters(struct dvb_frontend *fe) | |||
| 6399 | fe->ops.tuner_ops.get_if_frequency(fe, &IF); | 6399 | fe->ops.tuner_ops.get_if_frequency(fe, &IF); |
| 6400 | start(state, 0, IF); | 6400 | start(state, 0, IF); |
| 6401 | 6401 | ||
| 6402 | /* After set_frontend, stats aren't avaliable */ | 6402 | /* After set_frontend, stats aren't available */ |
| 6403 | p->strength.stat[0].scale = FE_SCALE_RELATIVE; | 6403 | p->strength.stat[0].scale = FE_SCALE_RELATIVE; |
| 6404 | p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; | 6404 | p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
| 6405 | p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; | 6405 | p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
diff --git a/drivers/media/dvb-frontends/rtl2830.c b/drivers/media/dvb-frontends/rtl2830.c index 7efb796c472c..50e8b63e5169 100644 --- a/drivers/media/dvb-frontends/rtl2830.c +++ b/drivers/media/dvb-frontends/rtl2830.c | |||
| @@ -710,6 +710,7 @@ struct dvb_frontend *rtl2830_attach(const struct rtl2830_config *cfg, | |||
| 710 | sizeof(priv->tuner_i2c_adapter.name)); | 710 | sizeof(priv->tuner_i2c_adapter.name)); |
| 711 | priv->tuner_i2c_adapter.algo = &rtl2830_tuner_i2c_algo; | 711 | priv->tuner_i2c_adapter.algo = &rtl2830_tuner_i2c_algo; |
| 712 | priv->tuner_i2c_adapter.algo_data = NULL; | 712 | priv->tuner_i2c_adapter.algo_data = NULL; |
| 713 | priv->tuner_i2c_adapter.dev.parent = &i2c->dev; | ||
| 713 | i2c_set_adapdata(&priv->tuner_i2c_adapter, priv); | 714 | i2c_set_adapdata(&priv->tuner_i2c_adapter, priv); |
| 714 | if (i2c_add_adapter(&priv->tuner_i2c_adapter) < 0) { | 715 | if (i2c_add_adapter(&priv->tuner_i2c_adapter) < 0) { |
| 715 | dev_err(&i2c->dev, | 716 | dev_err(&i2c->dev, |
diff --git a/drivers/media/i2c/adv7183_regs.h b/drivers/media/i2c/adv7183_regs.h index 4a5b7d211d2f..b253d400e817 100644 --- a/drivers/media/i2c/adv7183_regs.h +++ b/drivers/media/i2c/adv7183_regs.h | |||
| @@ -52,9 +52,9 @@ | |||
| 52 | #define ADV7183_VS_FIELD_CTRL_1 0x31 /* Vsync field control 1 */ | 52 | #define ADV7183_VS_FIELD_CTRL_1 0x31 /* Vsync field control 1 */ |
| 53 | #define ADV7183_VS_FIELD_CTRL_2 0x32 /* Vsync field control 2 */ | 53 | #define ADV7183_VS_FIELD_CTRL_2 0x32 /* Vsync field control 2 */ |
| 54 | #define ADV7183_VS_FIELD_CTRL_3 0x33 /* Vsync field control 3 */ | 54 | #define ADV7183_VS_FIELD_CTRL_3 0x33 /* Vsync field control 3 */ |
| 55 | #define ADV7183_HS_POS_CTRL_1 0x34 /* Hsync positon control 1 */ | 55 | #define ADV7183_HS_POS_CTRL_1 0x34 /* Hsync position control 1 */ |
| 56 | #define ADV7183_HS_POS_CTRL_2 0x35 /* Hsync positon control 2 */ | 56 | #define ADV7183_HS_POS_CTRL_2 0x35 /* Hsync position control 2 */ |
| 57 | #define ADV7183_HS_POS_CTRL_3 0x36 /* Hsync positon control 3 */ | 57 | #define ADV7183_HS_POS_CTRL_3 0x36 /* Hsync position control 3 */ |
| 58 | #define ADV7183_POLARITY 0x37 /* Polarity */ | 58 | #define ADV7183_POLARITY 0x37 /* Polarity */ |
| 59 | #define ADV7183_NTSC_COMB_CTRL 0x38 /* NTSC comb control */ | 59 | #define ADV7183_NTSC_COMB_CTRL 0x38 /* NTSC comb control */ |
| 60 | #define ADV7183_PAL_COMB_CTRL 0x39 /* PAL comb control */ | 60 | #define ADV7183_PAL_COMB_CTRL 0x39 /* PAL comb control */ |
diff --git a/drivers/media/i2c/adv7604.c b/drivers/media/i2c/adv7604.c index fbfdd2fc2a36..a324106b9f11 100644 --- a/drivers/media/i2c/adv7604.c +++ b/drivers/media/i2c/adv7604.c | |||
| @@ -877,7 +877,7 @@ static void configure_custom_video_timings(struct v4l2_subdev *sd, | |||
| 877 | break; | 877 | break; |
| 878 | case ADV7604_MODE_HDMI: | 878 | case ADV7604_MODE_HDMI: |
| 879 | /* set default prim_mode/vid_std for HDMI | 879 | /* set default prim_mode/vid_std for HDMI |
| 880 | accoring to [REF_03, c. 4.2] */ | 880 | according to [REF_03, c. 4.2] */ |
| 881 | io_write(sd, 0x00, 0x02); /* video std */ | 881 | io_write(sd, 0x00, 0x02); /* video std */ |
| 882 | io_write(sd, 0x01, 0x06); /* prim mode */ | 882 | io_write(sd, 0x01, 0x06); /* prim mode */ |
| 883 | break; | 883 | break; |
diff --git a/drivers/media/i2c/adv7842.c b/drivers/media/i2c/adv7842.c index 22f729d66a96..b154f36740b4 100644 --- a/drivers/media/i2c/adv7842.c +++ b/drivers/media/i2c/adv7842.c | |||
| @@ -1013,7 +1013,7 @@ static void configure_custom_video_timings(struct v4l2_subdev *sd, | |||
| 1013 | break; | 1013 | break; |
| 1014 | case ADV7842_MODE_HDMI: | 1014 | case ADV7842_MODE_HDMI: |
| 1015 | /* set default prim_mode/vid_std for HDMI | 1015 | /* set default prim_mode/vid_std for HDMI |
| 1016 | accoring to [REF_03, c. 4.2] */ | 1016 | according to [REF_03, c. 4.2] */ |
| 1017 | io_write(sd, 0x00, 0x02); /* video std */ | 1017 | io_write(sd, 0x00, 0x02); /* video std */ |
| 1018 | io_write(sd, 0x01, 0x06); /* prim mode */ | 1018 | io_write(sd, 0x01, 0x06); /* prim mode */ |
| 1019 | break; | 1019 | break; |
diff --git a/drivers/media/i2c/ir-kbd-i2c.c b/drivers/media/i2c/ir-kbd-i2c.c index 82bf5679da30..99ee456700f4 100644 --- a/drivers/media/i2c/ir-kbd-i2c.c +++ b/drivers/media/i2c/ir-kbd-i2c.c | |||
| @@ -394,7 +394,7 @@ static int ir_probe(struct i2c_client *client, const struct i2c_device_id *id) | |||
| 394 | 394 | ||
| 395 | if (!rc) { | 395 | if (!rc) { |
| 396 | /* | 396 | /* |
| 397 | * If platform_data doesn't specify rc_dev, initilize it | 397 | * If platform_data doesn't specify rc_dev, initialize it |
| 398 | * internally | 398 | * internally |
| 399 | */ | 399 | */ |
| 400 | rc = rc_allocate_device(); | 400 | rc = rc_allocate_device(); |
diff --git a/drivers/media/i2c/m5mols/m5mols_controls.c b/drivers/media/i2c/m5mols/m5mols_controls.c index f34429e452ab..a60931e66312 100644 --- a/drivers/media/i2c/m5mols/m5mols_controls.c +++ b/drivers/media/i2c/m5mols/m5mols_controls.c | |||
| @@ -544,7 +544,7 @@ int m5mols_init_controls(struct v4l2_subdev *sd) | |||
| 544 | u16 zoom_step; | 544 | u16 zoom_step; |
| 545 | int ret; | 545 | int ret; |
| 546 | 546 | ||
| 547 | /* Determine the firmware dependant control range and step values */ | 547 | /* Determine the firmware dependent control range and step values */ |
| 548 | ret = m5mols_read_u16(sd, AE_MAX_GAIN_MON, &exposure_max); | 548 | ret = m5mols_read_u16(sd, AE_MAX_GAIN_MON, &exposure_max); |
| 549 | if (ret < 0) | 549 | if (ret < 0) |
| 550 | return ret; | 550 | return ret; |
diff --git a/drivers/media/i2c/mt9p031.c b/drivers/media/i2c/mt9p031.c index 4734836fe5a4..1c2303d18bf4 100644 --- a/drivers/media/i2c/mt9p031.c +++ b/drivers/media/i2c/mt9p031.c | |||
| @@ -19,6 +19,7 @@ | |||
| 19 | #include <linux/i2c.h> | 19 | #include <linux/i2c.h> |
| 20 | #include <linux/log2.h> | 20 | #include <linux/log2.h> |
| 21 | #include <linux/module.h> | 21 | #include <linux/module.h> |
| 22 | #include <linux/of.h> | ||
| 22 | #include <linux/of_gpio.h> | 23 | #include <linux/of_gpio.h> |
| 23 | #include <linux/pm.h> | 24 | #include <linux/pm.h> |
| 24 | #include <linux/regulator/consumer.h> | 25 | #include <linux/regulator/consumer.h> |
diff --git a/drivers/media/i2c/s5c73m3/s5c73m3-core.c b/drivers/media/i2c/s5c73m3/s5c73m3-core.c index 6fec9384d86e..e7f555cc827a 100644 --- a/drivers/media/i2c/s5c73m3/s5c73m3-core.c +++ b/drivers/media/i2c/s5c73m3/s5c73m3-core.c | |||
| @@ -1460,7 +1460,7 @@ static int s5c73m3_oif_registered(struct v4l2_subdev *sd) | |||
| 1460 | mutex_unlock(&state->lock); | 1460 | mutex_unlock(&state->lock); |
| 1461 | 1461 | ||
| 1462 | v4l2_dbg(1, s5c73m3_dbg, sd, "%s: Booting %s (%d)\n", | 1462 | v4l2_dbg(1, s5c73m3_dbg, sd, "%s: Booting %s (%d)\n", |
| 1463 | __func__, ret ? "failed" : "succeded", ret); | 1463 | __func__, ret ? "failed" : "succeeded", ret); |
| 1464 | 1464 | ||
| 1465 | return ret; | 1465 | return ret; |
| 1466 | } | 1466 | } |
diff --git a/drivers/media/i2c/s5c73m3/s5c73m3.h b/drivers/media/i2c/s5c73m3/s5c73m3.h index 9d2c08652246..9dfa516f6944 100644 --- a/drivers/media/i2c/s5c73m3/s5c73m3.h +++ b/drivers/media/i2c/s5c73m3/s5c73m3.h | |||
| @@ -393,7 +393,7 @@ struct s5c73m3 { | |||
| 393 | 393 | ||
| 394 | /* External master clock frequency */ | 394 | /* External master clock frequency */ |
| 395 | u32 mclk_frequency; | 395 | u32 mclk_frequency; |
| 396 | /* Video bus type - MIPI-CSI2/paralell */ | 396 | /* Video bus type - MIPI-CSI2/parallel */ |
| 397 | enum v4l2_mbus_type bus_type; | 397 | enum v4l2_mbus_type bus_type; |
| 398 | 398 | ||
| 399 | const struct s5c73m3_frame_size *sensor_pix_size[2]; | 399 | const struct s5c73m3_frame_size *sensor_pix_size[2]; |
diff --git a/drivers/media/i2c/saa7115.c b/drivers/media/i2c/saa7115.c index 637d02634527..afdbcb045cee 100644 --- a/drivers/media/i2c/saa7115.c +++ b/drivers/media/i2c/saa7115.c | |||
| @@ -1699,7 +1699,7 @@ static void saa711x_write_platform_data(struct saa711x_state *state, | |||
| 1699 | * the analog demod. | 1699 | * the analog demod. |
| 1700 | * If the tuner is not found, it returns -ENODEV. | 1700 | * If the tuner is not found, it returns -ENODEV. |
| 1701 | * If auto-detection is disabled and the tuner doesn't match what it was | 1701 | * If auto-detection is disabled and the tuner doesn't match what it was |
| 1702 | * requred, it returns -EINVAL and fills 'name'. | 1702 | * required, it returns -EINVAL and fills 'name'. |
| 1703 | * If the chip is found, it returns the chip ID and fills 'name'. | 1703 | * If the chip is found, it returns the chip ID and fills 'name'. |
| 1704 | */ | 1704 | */ |
| 1705 | static int saa711x_detect_chip(struct i2c_client *client, | 1705 | static int saa711x_detect_chip(struct i2c_client *client, |
diff --git a/drivers/media/i2c/soc_camera/ov5642.c b/drivers/media/i2c/soc_camera/ov5642.c index 0a5c5d4fedd6..d2daa6a8f272 100644 --- a/drivers/media/i2c/soc_camera/ov5642.c +++ b/drivers/media/i2c/soc_camera/ov5642.c | |||
| @@ -642,7 +642,7 @@ static const struct ov5642_datafmt | |||
| 642 | static int reg_read(struct i2c_client *client, u16 reg, u8 *val) | 642 | static int reg_read(struct i2c_client *client, u16 reg, u8 *val) |
| 643 | { | 643 | { |
| 644 | int ret; | 644 | int ret; |
| 645 | /* We have 16-bit i2c addresses - care for endianess */ | 645 | /* We have 16-bit i2c addresses - care for endianness */ |
| 646 | unsigned char data[2] = { reg >> 8, reg & 0xff }; | 646 | unsigned char data[2] = { reg >> 8, reg & 0xff }; |
| 647 | 647 | ||
| 648 | ret = i2c_master_send(client, data, 2); | 648 | ret = i2c_master_send(client, data, 2); |
diff --git a/drivers/media/i2c/ths7303.c b/drivers/media/i2c/ths7303.c index 42276d93624c..ed9ae8875348 100644 --- a/drivers/media/i2c/ths7303.c +++ b/drivers/media/i2c/ths7303.c | |||
| @@ -83,7 +83,8 @@ static int ths7303_write(struct v4l2_subdev *sd, u8 reg, u8 val) | |||
| 83 | } | 83 | } |
| 84 | 84 | ||
| 85 | /* following function is used to set ths7303 */ | 85 | /* following function is used to set ths7303 */ |
| 86 | int ths7303_setval(struct v4l2_subdev *sd, enum ths7303_filter_mode mode) | 86 | static int ths7303_setval(struct v4l2_subdev *sd, |
| 87 | enum ths7303_filter_mode mode) | ||
| 87 | { | 88 | { |
| 88 | struct i2c_client *client = v4l2_get_subdevdata(sd); | 89 | struct i2c_client *client = v4l2_get_subdevdata(sd); |
| 89 | struct ths7303_state *state = to_state(sd); | 90 | struct ths7303_state *state = to_state(sd); |
diff --git a/drivers/media/i2c/wm8775.c b/drivers/media/i2c/wm8775.c index 3f584a7d0781..bee7946faa7c 100644 --- a/drivers/media/i2c/wm8775.c +++ b/drivers/media/i2c/wm8775.c | |||
| @@ -130,12 +130,10 @@ static int wm8775_s_routing(struct v4l2_subdev *sd, | |||
| 130 | return -EINVAL; | 130 | return -EINVAL; |
| 131 | } | 131 | } |
| 132 | state->input = input; | 132 | state->input = input; |
| 133 | if (!v4l2_ctrl_g_ctrl(state->mute)) | 133 | if (v4l2_ctrl_g_ctrl(state->mute)) |
| 134 | return 0; | 134 | return 0; |
| 135 | if (!v4l2_ctrl_g_ctrl(state->vol)) | 135 | if (!v4l2_ctrl_g_ctrl(state->vol)) |
| 136 | return 0; | 136 | return 0; |
| 137 | if (!v4l2_ctrl_g_ctrl(state->bal)) | ||
| 138 | return 0; | ||
| 139 | wm8775_set_audio(sd, 1); | 137 | wm8775_set_audio(sd, 1); |
| 140 | return 0; | 138 | return 0; |
| 141 | } | 139 | } |
diff --git a/drivers/media/pci/bt8xx/bttv-driver.c b/drivers/media/pci/bt8xx/bttv-driver.c index a3b1ee9c00d7..92a06fd85865 100644 --- a/drivers/media/pci/bt8xx/bttv-driver.c +++ b/drivers/media/pci/bt8xx/bttv-driver.c | |||
| @@ -4182,7 +4182,8 @@ static int bttv_probe(struct pci_dev *dev, const struct pci_device_id *pci_id) | |||
| 4182 | } | 4182 | } |
| 4183 | btv->std = V4L2_STD_PAL; | 4183 | btv->std = V4L2_STD_PAL; |
| 4184 | init_irqreg(btv); | 4184 | init_irqreg(btv); |
| 4185 | v4l2_ctrl_handler_setup(hdl); | 4185 | if (!bttv_tvcards[btv->c.type].no_video) |
| 4186 | v4l2_ctrl_handler_setup(hdl); | ||
| 4186 | if (hdl->error) { | 4187 | if (hdl->error) { |
| 4187 | result = hdl->error; | 4188 | result = hdl->error; |
| 4188 | goto fail2; | 4189 | goto fail2; |
diff --git a/drivers/media/pci/cx18/cx18-driver.h b/drivers/media/pci/cx18/cx18-driver.h index 2767c64df0c8..57f4688ea55b 100644 --- a/drivers/media/pci/cx18/cx18-driver.h +++ b/drivers/media/pci/cx18/cx18-driver.h | |||
| @@ -262,7 +262,7 @@ struct cx18_options { | |||
| 262 | }; | 262 | }; |
| 263 | 263 | ||
| 264 | /* per-mdl bit flags */ | 264 | /* per-mdl bit flags */ |
| 265 | #define CX18_F_M_NEED_SWAP 0 /* mdl buffer data must be endianess swapped */ | 265 | #define CX18_F_M_NEED_SWAP 0 /* mdl buffer data must be endianness swapped */ |
| 266 | 266 | ||
| 267 | /* per-stream, s_flags */ | 267 | /* per-stream, s_flags */ |
| 268 | #define CX18_F_S_CLAIMED 3 /* this stream is claimed */ | 268 | #define CX18_F_S_CLAIMED 3 /* this stream is claimed */ |
diff --git a/drivers/media/pci/cx23885/cx23885-417.c b/drivers/media/pci/cx23885/cx23885-417.c index e3fc2c71808a..95666eee7b27 100644 --- a/drivers/media/pci/cx23885/cx23885-417.c +++ b/drivers/media/pci/cx23885/cx23885-417.c | |||
| @@ -427,7 +427,7 @@ int mc417_register_read(struct cx23885_dev *dev, u16 address, u32 *value) | |||
| 427 | cx_write(MC417_RWD, regval); | 427 | cx_write(MC417_RWD, regval); |
| 428 | 428 | ||
| 429 | /* Transition RD to effect read transaction across bus. | 429 | /* Transition RD to effect read transaction across bus. |
| 430 | * Transtion 0x5000 -> 0x9000 correct (RD/RDY -> WR/RDY)? | 430 | * Transition 0x5000 -> 0x9000 correct (RD/RDY -> WR/RDY)? |
| 431 | * Should it be 0x9000 -> 0xF000 (also why is RDY being set, its | 431 | * Should it be 0x9000 -> 0xF000 (also why is RDY being set, its |
| 432 | * input only...) | 432 | * input only...) |
| 433 | */ | 433 | */ |
diff --git a/drivers/media/pci/pluto2/pluto2.c b/drivers/media/pci/pluto2/pluto2.c index 8164d74b46a4..655d6854a8d7 100644 --- a/drivers/media/pci/pluto2/pluto2.c +++ b/drivers/media/pci/pluto2/pluto2.c | |||
| @@ -401,7 +401,7 @@ static int pluto_hw_init(struct pluto *pluto) | |||
| 401 | /* set automatic LED control by FPGA */ | 401 | /* set automatic LED control by FPGA */ |
| 402 | pluto_rw(pluto, REG_MISC, MISC_ALED, MISC_ALED); | 402 | pluto_rw(pluto, REG_MISC, MISC_ALED, MISC_ALED); |
| 403 | 403 | ||
| 404 | /* set data endianess */ | 404 | /* set data endianness */ |
| 405 | #ifdef __LITTLE_ENDIAN | 405 | #ifdef __LITTLE_ENDIAN |
| 406 | pluto_rw(pluto, REG_PIDn(0), PID0_END, PID0_END); | 406 | pluto_rw(pluto, REG_PIDn(0), PID0_END, PID0_END); |
| 407 | #else | 407 | #else |
diff --git a/drivers/media/pci/saa7164/saa7164-core.c b/drivers/media/pci/saa7164/saa7164-core.c index 57ef5456f1e8..1bf06970ca3e 100644 --- a/drivers/media/pci/saa7164/saa7164-core.c +++ b/drivers/media/pci/saa7164/saa7164-core.c | |||
| @@ -1354,9 +1354,11 @@ static int saa7164_initdev(struct pci_dev *pci_dev, | |||
| 1354 | if (fw_debug) { | 1354 | if (fw_debug) { |
| 1355 | dev->kthread = kthread_run(saa7164_thread_function, dev, | 1355 | dev->kthread = kthread_run(saa7164_thread_function, dev, |
| 1356 | "saa7164 debug"); | 1356 | "saa7164 debug"); |
| 1357 | if (!dev->kthread) | 1357 | if (IS_ERR(dev->kthread)) { |
| 1358 | dev->kthread = NULL; | ||
| 1358 | printk(KERN_ERR "%s() Failed to create " | 1359 | printk(KERN_ERR "%s() Failed to create " |
| 1359 | "debug kernel thread\n", __func__); | 1360 | "debug kernel thread\n", __func__); |
| 1361 | } | ||
| 1360 | } | 1362 | } |
| 1361 | 1363 | ||
| 1362 | } /* != BOARD_UNKNOWN */ | 1364 | } /* != BOARD_UNKNOWN */ |
diff --git a/drivers/media/platform/coda.c b/drivers/media/platform/coda.c index bd72fb97fea5..61f3dbcc259f 100644 --- a/drivers/media/platform/coda.c +++ b/drivers/media/platform/coda.c | |||
| @@ -1434,7 +1434,7 @@ static void coda_buf_queue(struct vb2_buffer *vb) | |||
| 1434 | if (q_data->fourcc == V4L2_PIX_FMT_H264 && | 1434 | if (q_data->fourcc == V4L2_PIX_FMT_H264 && |
| 1435 | vb->vb2_queue->type == V4L2_BUF_TYPE_VIDEO_OUTPUT) { | 1435 | vb->vb2_queue->type == V4L2_BUF_TYPE_VIDEO_OUTPUT) { |
| 1436 | /* | 1436 | /* |
| 1437 | * For backwards compatiblity, queuing an empty buffer marks | 1437 | * For backwards compatibility, queuing an empty buffer marks |
| 1438 | * the stream end | 1438 | * the stream end |
| 1439 | */ | 1439 | */ |
| 1440 | if (vb2_get_plane_payload(vb, 0) == 0) | 1440 | if (vb2_get_plane_payload(vb, 0) == 0) |
diff --git a/drivers/media/platform/exynos4-is/fimc-core.c b/drivers/media/platform/exynos4-is/fimc-core.c index 3d66d88ea3a1..f7915695c907 100644 --- a/drivers/media/platform/exynos4-is/fimc-core.c +++ b/drivers/media/platform/exynos4-is/fimc-core.c | |||
| @@ -1039,7 +1039,7 @@ static int fimc_runtime_resume(struct device *dev) | |||
| 1039 | 1039 | ||
| 1040 | dbg("fimc%d: state: 0x%lx", fimc->id, fimc->state); | 1040 | dbg("fimc%d: state: 0x%lx", fimc->id, fimc->state); |
| 1041 | 1041 | ||
| 1042 | /* Enable clocks and perform basic initalization */ | 1042 | /* Enable clocks and perform basic initialization */ |
| 1043 | clk_enable(fimc->clock[CLK_GATE]); | 1043 | clk_enable(fimc->clock[CLK_GATE]); |
| 1044 | fimc_hw_reset(fimc); | 1044 | fimc_hw_reset(fimc); |
| 1045 | 1045 | ||
diff --git a/drivers/media/platform/exynos4-is/media-dev.c b/drivers/media/platform/exynos4-is/media-dev.c index 7a4ee4c0449d..c1bce170df6f 100644 --- a/drivers/media/platform/exynos4-is/media-dev.c +++ b/drivers/media/platform/exynos4-is/media-dev.c | |||
| @@ -759,7 +759,7 @@ static int fimc_md_register_platform_entity(struct fimc_md *fmd, | |||
| 759 | goto dev_unlock; | 759 | goto dev_unlock; |
| 760 | 760 | ||
| 761 | drvdata = dev_get_drvdata(dev); | 761 | drvdata = dev_get_drvdata(dev); |
| 762 | /* Some subdev didn't probe succesfully id drvdata is NULL */ | 762 | /* Some subdev didn't probe successfully id drvdata is NULL */ |
| 763 | if (drvdata) { | 763 | if (drvdata) { |
| 764 | switch (plat_entity) { | 764 | switch (plat_entity) { |
| 765 | case IDX_FIMC: | 765 | case IDX_FIMC: |
diff --git a/drivers/media/platform/marvell-ccic/mmp-driver.c b/drivers/media/platform/marvell-ccic/mmp-driver.c index 3458fa0e2fd5..054507f16734 100644 --- a/drivers/media/platform/marvell-ccic/mmp-driver.c +++ b/drivers/media/platform/marvell-ccic/mmp-driver.c | |||
| @@ -142,12 +142,6 @@ static int mmpcam_power_up(struct mcam_camera *mcam) | |||
| 142 | struct mmp_camera *cam = mcam_to_cam(mcam); | 142 | struct mmp_camera *cam = mcam_to_cam(mcam); |
| 143 | struct mmp_camera_platform_data *pdata; | 143 | struct mmp_camera_platform_data *pdata; |
| 144 | 144 | ||
| 145 | if (mcam->bus_type == V4L2_MBUS_CSI2) { | ||
| 146 | cam->mipi_clk = devm_clk_get(mcam->dev, "mipi"); | ||
| 147 | if ((IS_ERR(cam->mipi_clk) && mcam->dphy[2] == 0)) | ||
| 148 | return PTR_ERR(cam->mipi_clk); | ||
| 149 | } | ||
| 150 | |||
| 151 | /* | 145 | /* |
| 152 | * Turn on power and clocks to the controller. | 146 | * Turn on power and clocks to the controller. |
| 153 | */ | 147 | */ |
| @@ -186,12 +180,6 @@ static void mmpcam_power_down(struct mcam_camera *mcam) | |||
| 186 | gpio_set_value(pdata->sensor_power_gpio, 0); | 180 | gpio_set_value(pdata->sensor_power_gpio, 0); |
| 187 | gpio_set_value(pdata->sensor_reset_gpio, 0); | 181 | gpio_set_value(pdata->sensor_reset_gpio, 0); |
| 188 | 182 | ||
| 189 | if (mcam->bus_type == V4L2_MBUS_CSI2 && !IS_ERR(cam->mipi_clk)) { | ||
| 190 | if (cam->mipi_clk) | ||
| 191 | devm_clk_put(mcam->dev, cam->mipi_clk); | ||
| 192 | cam->mipi_clk = NULL; | ||
| 193 | } | ||
| 194 | |||
| 195 | mcam_clk_disable(mcam); | 183 | mcam_clk_disable(mcam); |
| 196 | } | 184 | } |
| 197 | 185 | ||
| @@ -292,8 +280,9 @@ void mmpcam_calc_dphy(struct mcam_camera *mcam) | |||
| 292 | return; | 280 | return; |
| 293 | 281 | ||
| 294 | /* get the escape clk, this is hard coded */ | 282 | /* get the escape clk, this is hard coded */ |
| 283 | clk_prepare_enable(cam->mipi_clk); | ||
| 295 | tx_clk_esc = (clk_get_rate(cam->mipi_clk) / 1000000) / 12; | 284 | tx_clk_esc = (clk_get_rate(cam->mipi_clk) / 1000000) / 12; |
| 296 | 285 | clk_disable_unprepare(cam->mipi_clk); | |
| 297 | /* | 286 | /* |
| 298 | * dphy[2] - CSI2_DPHY6: | 287 | * dphy[2] - CSI2_DPHY6: |
| 299 | * bit 0 ~ bit 7: CK Term Enable | 288 | * bit 0 ~ bit 7: CK Term Enable |
| @@ -325,19 +314,6 @@ static irqreturn_t mmpcam_irq(int irq, void *data) | |||
| 325 | return IRQ_RETVAL(handled); | 314 | return IRQ_RETVAL(handled); |
| 326 | } | 315 | } |
| 327 | 316 | ||
| 328 | static void mcam_deinit_clk(struct mcam_camera *mcam) | ||
| 329 | { | ||
| 330 | unsigned int i; | ||
| 331 | |||
| 332 | for (i = 0; i < NR_MCAM_CLK; i++) { | ||
| 333 | if (!IS_ERR(mcam->clk[i])) { | ||
| 334 | if (mcam->clk[i]) | ||
| 335 | devm_clk_put(mcam->dev, mcam->clk[i]); | ||
| 336 | } | ||
| 337 | mcam->clk[i] = NULL; | ||
| 338 | } | ||
| 339 | } | ||
| 340 | |||
| 341 | static void mcam_init_clk(struct mcam_camera *mcam) | 317 | static void mcam_init_clk(struct mcam_camera *mcam) |
| 342 | { | 318 | { |
| 343 | unsigned int i; | 319 | unsigned int i; |
| @@ -371,7 +347,6 @@ static int mmpcam_probe(struct platform_device *pdev) | |||
| 371 | if (cam == NULL) | 347 | if (cam == NULL) |
| 372 | return -ENOMEM; | 348 | return -ENOMEM; |
| 373 | cam->pdev = pdev; | 349 | cam->pdev = pdev; |
| 374 | cam->mipi_clk = NULL; | ||
| 375 | INIT_LIST_HEAD(&cam->devlist); | 350 | INIT_LIST_HEAD(&cam->devlist); |
| 376 | 351 | ||
| 377 | mcam = &cam->mcam; | 352 | mcam = &cam->mcam; |
| @@ -387,6 +362,11 @@ static int mmpcam_probe(struct platform_device *pdev) | |||
| 387 | mcam->mclk_div = pdata->mclk_div; | 362 | mcam->mclk_div = pdata->mclk_div; |
| 388 | mcam->bus_type = pdata->bus_type; | 363 | mcam->bus_type = pdata->bus_type; |
| 389 | mcam->dphy = pdata->dphy; | 364 | mcam->dphy = pdata->dphy; |
| 365 | if (mcam->bus_type == V4L2_MBUS_CSI2) { | ||
| 366 | cam->mipi_clk = devm_clk_get(mcam->dev, "mipi"); | ||
| 367 | if ((IS_ERR(cam->mipi_clk) && mcam->dphy[2] == 0)) | ||
| 368 | return PTR_ERR(cam->mipi_clk); | ||
| 369 | } | ||
| 390 | mcam->mipi_enabled = false; | 370 | mcam->mipi_enabled = false; |
| 391 | mcam->lane = pdata->lane; | 371 | mcam->lane = pdata->lane; |
| 392 | mcam->chip_id = MCAM_ARMADA610; | 372 | mcam->chip_id = MCAM_ARMADA610; |
| @@ -444,7 +424,7 @@ static int mmpcam_probe(struct platform_device *pdev) | |||
| 444 | */ | 424 | */ |
| 445 | ret = mmpcam_power_up(mcam); | 425 | ret = mmpcam_power_up(mcam); |
| 446 | if (ret) | 426 | if (ret) |
| 447 | goto out_deinit_clk; | 427 | return ret; |
| 448 | ret = mccic_register(mcam); | 428 | ret = mccic_register(mcam); |
| 449 | if (ret) | 429 | if (ret) |
| 450 | goto out_power_down; | 430 | goto out_power_down; |
| @@ -469,8 +449,6 @@ out_unregister: | |||
| 469 | mccic_shutdown(mcam); | 449 | mccic_shutdown(mcam); |
| 470 | out_power_down: | 450 | out_power_down: |
| 471 | mmpcam_power_down(mcam); | 451 | mmpcam_power_down(mcam); |
| 472 | out_deinit_clk: | ||
| 473 | mcam_deinit_clk(mcam); | ||
| 474 | return ret; | 452 | return ret; |
| 475 | } | 453 | } |
| 476 | 454 | ||
| @@ -478,18 +456,10 @@ out_deinit_clk: | |||
| 478 | static int mmpcam_remove(struct mmp_camera *cam) | 456 | static int mmpcam_remove(struct mmp_camera *cam) |
| 479 | { | 457 | { |
| 480 | struct mcam_camera *mcam = &cam->mcam; | 458 | struct mcam_camera *mcam = &cam->mcam; |
| 481 | struct mmp_camera_platform_data *pdata; | ||
| 482 | 459 | ||
| 483 | mmpcam_remove_device(cam); | 460 | mmpcam_remove_device(cam); |
| 484 | mccic_shutdown(mcam); | 461 | mccic_shutdown(mcam); |
| 485 | mmpcam_power_down(mcam); | 462 | mmpcam_power_down(mcam); |
| 486 | pdata = cam->pdev->dev.platform_data; | ||
| 487 | gpio_free(pdata->sensor_reset_gpio); | ||
| 488 | gpio_free(pdata->sensor_power_gpio); | ||
| 489 | mcam_deinit_clk(mcam); | ||
| 490 | iounmap(cam->power_regs); | ||
| 491 | iounmap(mcam->regs); | ||
| 492 | kfree(cam); | ||
| 493 | return 0; | 463 | return 0; |
| 494 | } | 464 | } |
| 495 | 465 | ||
diff --git a/drivers/media/platform/omap3isp/isp.c b/drivers/media/platform/omap3isp/isp.c index 1c3608039663..561bce8ffb1b 100644 --- a/drivers/media/platform/omap3isp/isp.c +++ b/drivers/media/platform/omap3isp/isp.c | |||
| @@ -1673,7 +1673,7 @@ void omap3isp_print_status(struct isp_device *isp) | |||
| 1673 | * ISP clocks get disabled in suspend(). Similarly, the clocks are reenabled in | 1673 | * ISP clocks get disabled in suspend(). Similarly, the clocks are reenabled in |
| 1674 | * resume(), and the the pipelines are restarted in complete(). | 1674 | * resume(), and the the pipelines are restarted in complete(). |
| 1675 | * | 1675 | * |
| 1676 | * TODO: PM dependencies between the ISP and sensors are not modeled explicitly | 1676 | * TODO: PM dependencies between the ISP and sensors are not modelled explicitly |
| 1677 | * yet. | 1677 | * yet. |
| 1678 | */ | 1678 | */ |
| 1679 | static int isp_pm_prepare(struct device *dev) | 1679 | static int isp_pm_prepare(struct device *dev) |
diff --git a/drivers/media/platform/omap3isp/ispvideo.c b/drivers/media/platform/omap3isp/ispvideo.c index a908d006f527..f6304bb074f5 100644 --- a/drivers/media/platform/omap3isp/ispvideo.c +++ b/drivers/media/platform/omap3isp/ispvideo.c | |||
| @@ -339,14 +339,11 @@ __isp_video_get_format(struct isp_video *video, struct v4l2_format *format) | |||
| 339 | if (subdev == NULL) | 339 | if (subdev == NULL) |
| 340 | return -EINVAL; | 340 | return -EINVAL; |
| 341 | 341 | ||
| 342 | mutex_lock(&video->mutex); | ||
| 343 | |||
| 344 | fmt.pad = pad; | 342 | fmt.pad = pad; |
| 345 | fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; | 343 | fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; |
| 346 | ret = v4l2_subdev_call(subdev, pad, get_fmt, NULL, &fmt); | ||
| 347 | if (ret == -ENOIOCTLCMD) | ||
| 348 | ret = -EINVAL; | ||
| 349 | 344 | ||
| 345 | mutex_lock(&video->mutex); | ||
| 346 | ret = v4l2_subdev_call(subdev, pad, get_fmt, NULL, &fmt); | ||
| 350 | mutex_unlock(&video->mutex); | 347 | mutex_unlock(&video->mutex); |
| 351 | 348 | ||
| 352 | if (ret) | 349 | if (ret) |
diff --git a/drivers/media/platform/s5p-mfc/regs-mfc.h b/drivers/media/platform/s5p-mfc/regs-mfc.h index 9319e93599ae..6ccc3f8c122a 100644 --- a/drivers/media/platform/s5p-mfc/regs-mfc.h +++ b/drivers/media/platform/s5p-mfc/regs-mfc.h | |||
| @@ -382,7 +382,7 @@ | |||
| 382 | #define S5P_FIMV_R2H_CMD_EDFU_INIT_RET 16 | 382 | #define S5P_FIMV_R2H_CMD_EDFU_INIT_RET 16 |
| 383 | #define S5P_FIMV_R2H_CMD_ERR_RET 32 | 383 | #define S5P_FIMV_R2H_CMD_ERR_RET 32 |
| 384 | 384 | ||
| 385 | /* Dummy definition for MFCv6 compatibilty */ | 385 | /* Dummy definition for MFCv6 compatibility */ |
| 386 | #define S5P_FIMV_CODEC_H264_MVC_DEC -1 | 386 | #define S5P_FIMV_CODEC_H264_MVC_DEC -1 |
| 387 | #define S5P_FIMV_R2H_CMD_FIELD_DONE_RET -1 | 387 | #define S5P_FIMV_R2H_CMD_FIELD_DONE_RET -1 |
| 388 | #define S5P_FIMV_MFC_RESET -1 | 388 | #define S5P_FIMV_MFC_RESET -1 |
diff --git a/drivers/media/platform/s5p-mfc/s5p_mfc.c b/drivers/media/platform/s5p-mfc/s5p_mfc.c index 5f2c4ad6c2cb..e46067a57853 100644 --- a/drivers/media/platform/s5p-mfc/s5p_mfc.c +++ b/drivers/media/platform/s5p-mfc/s5p_mfc.c | |||
| @@ -239,7 +239,7 @@ static void s5p_mfc_handle_frame_copy_time(struct s5p_mfc_ctx *ctx) | |||
| 239 | frame_type = s5p_mfc_hw_call(dev->mfc_ops, get_dec_frame_type, dev); | 239 | frame_type = s5p_mfc_hw_call(dev->mfc_ops, get_dec_frame_type, dev); |
| 240 | 240 | ||
| 241 | /* Copy timestamp / timecode from decoded src to dst and set | 241 | /* Copy timestamp / timecode from decoded src to dst and set |
| 242 | appropraite flags */ | 242 | appropriate flags */ |
| 243 | src_buf = list_entry(ctx->src_queue.next, struct s5p_mfc_buf, list); | 243 | src_buf = list_entry(ctx->src_queue.next, struct s5p_mfc_buf, list); |
| 244 | list_for_each_entry(dst_buf, &ctx->dst_queue, list) { | 244 | list_for_each_entry(dst_buf, &ctx->dst_queue, list) { |
| 245 | if (vb2_dma_contig_plane_dma_addr(dst_buf->b, 0) == dec_y_addr) { | 245 | if (vb2_dma_contig_plane_dma_addr(dst_buf->b, 0) == dec_y_addr) { |
| @@ -428,7 +428,7 @@ static void s5p_mfc_handle_error(struct s5p_mfc_dev *dev, | |||
| 428 | case MFCINST_FINISHING: | 428 | case MFCINST_FINISHING: |
| 429 | case MFCINST_FINISHED: | 429 | case MFCINST_FINISHED: |
| 430 | case MFCINST_RUNNING: | 430 | case MFCINST_RUNNING: |
| 431 | /* It is higly probable that an error occured | 431 | /* It is highly probable that an error occurred |
| 432 | * while decoding a frame */ | 432 | * while decoding a frame */ |
| 433 | clear_work_bit(ctx); | 433 | clear_work_bit(ctx); |
| 434 | ctx->state = MFCINST_ERROR; | 434 | ctx->state = MFCINST_ERROR; |
| @@ -611,7 +611,7 @@ static irqreturn_t s5p_mfc_irq(int irq, void *priv) | |||
| 611 | mfc_debug(1, "Int reason: %d (err: %08x)\n", reason, err); | 611 | mfc_debug(1, "Int reason: %d (err: %08x)\n", reason, err); |
| 612 | switch (reason) { | 612 | switch (reason) { |
| 613 | case S5P_MFC_R2H_CMD_ERR_RET: | 613 | case S5P_MFC_R2H_CMD_ERR_RET: |
| 614 | /* An error has occured */ | 614 | /* An error has occurred */ |
| 615 | if (ctx->state == MFCINST_RUNNING && | 615 | if (ctx->state == MFCINST_RUNNING && |
| 616 | s5p_mfc_hw_call(dev->mfc_ops, err_dec, err) >= | 616 | s5p_mfc_hw_call(dev->mfc_ops, err_dec, err) >= |
| 617 | dev->warn_start) | 617 | dev->warn_start) |
| @@ -840,7 +840,7 @@ static int s5p_mfc_open(struct file *file) | |||
| 840 | mutex_unlock(&dev->mfc_mutex); | 840 | mutex_unlock(&dev->mfc_mutex); |
| 841 | mfc_debug_leave(); | 841 | mfc_debug_leave(); |
| 842 | return ret; | 842 | return ret; |
| 843 | /* Deinit when failure occured */ | 843 | /* Deinit when failure occurred */ |
| 844 | err_queue_init: | 844 | err_queue_init: |
| 845 | if (dev->num_inst == 1) | 845 | if (dev->num_inst == 1) |
| 846 | s5p_mfc_deinit_hw(dev); | 846 | s5p_mfc_deinit_hw(dev); |
| @@ -881,14 +881,14 @@ static int s5p_mfc_release(struct file *file) | |||
| 881 | /* Mark context as idle */ | 881 | /* Mark context as idle */ |
| 882 | clear_work_bit_irqsave(ctx); | 882 | clear_work_bit_irqsave(ctx); |
| 883 | /* If instance was initialised then | 883 | /* If instance was initialised then |
| 884 | * return instance and free reosurces */ | 884 | * return instance and free resources */ |
| 885 | if (ctx->inst_no != MFC_NO_INSTANCE_SET) { | 885 | if (ctx->inst_no != MFC_NO_INSTANCE_SET) { |
| 886 | mfc_debug(2, "Has to free instance\n"); | 886 | mfc_debug(2, "Has to free instance\n"); |
| 887 | ctx->state = MFCINST_RETURN_INST; | 887 | ctx->state = MFCINST_RETURN_INST; |
| 888 | set_work_bit_irqsave(ctx); | 888 | set_work_bit_irqsave(ctx); |
| 889 | s5p_mfc_clean_ctx_int_flags(ctx); | 889 | s5p_mfc_clean_ctx_int_flags(ctx); |
| 890 | s5p_mfc_hw_call(dev->mfc_ops, try_run, dev); | 890 | s5p_mfc_hw_call(dev->mfc_ops, try_run, dev); |
| 891 | /* Wait until instance is returned or timeout occured */ | 891 | /* Wait until instance is returned or timeout occurred */ |
| 892 | if (s5p_mfc_wait_for_done_ctx | 892 | if (s5p_mfc_wait_for_done_ctx |
| 893 | (ctx, S5P_MFC_R2H_CMD_CLOSE_INSTANCE_RET, 0)) { | 893 | (ctx, S5P_MFC_R2H_CMD_CLOSE_INSTANCE_RET, 0)) { |
| 894 | s5p_mfc_clock_off(); | 894 | s5p_mfc_clock_off(); |
diff --git a/drivers/media/platform/s5p-mfc/s5p_mfc_ctrl.c b/drivers/media/platform/s5p-mfc/s5p_mfc_ctrl.c index 7cab6849fb5b..2475a3c9a0a6 100644 --- a/drivers/media/platform/s5p-mfc/s5p_mfc_ctrl.c +++ b/drivers/media/platform/s5p-mfc/s5p_mfc_ctrl.c | |||
| @@ -69,7 +69,7 @@ int s5p_mfc_alloc_firmware(struct s5p_mfc_dev *dev) | |||
| 69 | 69 | ||
| 70 | } else { | 70 | } else { |
| 71 | /* In this case bank2 can point to the same address as bank1. | 71 | /* In this case bank2 can point to the same address as bank1. |
| 72 | * Firmware will always occupy the beggining of this area so it is | 72 | * Firmware will always occupy the beginning of this area so it is |
| 73 | * impossible having a video frame buffer with zero address. */ | 73 | * impossible having a video frame buffer with zero address. */ |
| 74 | dev->bank2 = dev->bank1; | 74 | dev->bank2 = dev->bank1; |
| 75 | } | 75 | } |
diff --git a/drivers/media/platform/s5p-tv/mixer.h b/drivers/media/platform/s5p-tv/mixer.h index 04e6490a45be..fb2acc53112a 100644 --- a/drivers/media/platform/s5p-tv/mixer.h +++ b/drivers/media/platform/s5p-tv/mixer.h | |||
| @@ -65,7 +65,7 @@ struct mxr_format { | |||
| 65 | int num_subframes; | 65 | int num_subframes; |
| 66 | /** specifies to which subframe belong given plane */ | 66 | /** specifies to which subframe belong given plane */ |
| 67 | int plane2subframe[MXR_MAX_PLANES]; | 67 | int plane2subframe[MXR_MAX_PLANES]; |
| 68 | /** internal code, driver dependant */ | 68 | /** internal code, driver dependent */ |
| 69 | unsigned long cookie; | 69 | unsigned long cookie; |
| 70 | }; | 70 | }; |
| 71 | 71 | ||
diff --git a/drivers/media/platform/s5p-tv/mixer_video.c b/drivers/media/platform/s5p-tv/mixer_video.c index 641b1f071e06..81b97db111d8 100644 --- a/drivers/media/platform/s5p-tv/mixer_video.c +++ b/drivers/media/platform/s5p-tv/mixer_video.c | |||
| @@ -528,7 +528,7 @@ static int mxr_s_dv_timings(struct file *file, void *fh, | |||
| 528 | mutex_lock(&mdev->mutex); | 528 | mutex_lock(&mdev->mutex); |
| 529 | 529 | ||
| 530 | /* timings change cannot be done while there is an entity | 530 | /* timings change cannot be done while there is an entity |
| 531 | * dependant on output configuration | 531 | * dependent on output configuration |
| 532 | */ | 532 | */ |
| 533 | if (mdev->n_output > 0) { | 533 | if (mdev->n_output > 0) { |
| 534 | mutex_unlock(&mdev->mutex); | 534 | mutex_unlock(&mdev->mutex); |
| @@ -585,7 +585,7 @@ static int mxr_s_std(struct file *file, void *fh, v4l2_std_id norm) | |||
| 585 | mutex_lock(&mdev->mutex); | 585 | mutex_lock(&mdev->mutex); |
| 586 | 586 | ||
| 587 | /* standard change cannot be done while there is an entity | 587 | /* standard change cannot be done while there is an entity |
| 588 | * dependant on output configuration | 588 | * dependent on output configuration |
| 589 | */ | 589 | */ |
| 590 | if (mdev->n_output > 0) { | 590 | if (mdev->n_output > 0) { |
| 591 | mutex_unlock(&mdev->mutex); | 591 | mutex_unlock(&mdev->mutex); |
diff --git a/drivers/media/platform/soc_camera/omap1_camera.c b/drivers/media/platform/soc_camera/omap1_camera.c index 6769193c7c7b..74ce8b6b79fa 100644 --- a/drivers/media/platform/soc_camera/omap1_camera.c +++ b/drivers/media/platform/soc_camera/omap1_camera.c | |||
| @@ -1495,7 +1495,7 @@ static int omap1_cam_set_bus_param(struct soc_camera_device *icd) | |||
| 1495 | if (ctrlclock & LCLK_EN) | 1495 | if (ctrlclock & LCLK_EN) |
| 1496 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock); | 1496 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock); |
| 1497 | 1497 | ||
| 1498 | /* select bus endianess */ | 1498 | /* select bus endianness */ |
| 1499 | xlate = soc_camera_xlate_by_fourcc(icd, pixfmt); | 1499 | xlate = soc_camera_xlate_by_fourcc(icd, pixfmt); |
| 1500 | fmt = xlate->host_fmt; | 1500 | fmt = xlate->host_fmt; |
| 1501 | 1501 | ||
diff --git a/drivers/media/platform/vivi.c b/drivers/media/platform/vivi.c index 1d3f11965196..2d4e73b45c5e 100644 --- a/drivers/media/platform/vivi.c +++ b/drivers/media/platform/vivi.c | |||
| @@ -1108,7 +1108,7 @@ static int vidioc_s_input(struct file *file, void *priv, unsigned int i) | |||
| 1108 | return 0; | 1108 | return 0; |
| 1109 | } | 1109 | } |
| 1110 | 1110 | ||
| 1111 | /* timeperframe is arbitrary and continous */ | 1111 | /* timeperframe is arbitrary and continuous */ |
| 1112 | static int vidioc_enum_frameintervals(struct file *file, void *priv, | 1112 | static int vidioc_enum_frameintervals(struct file *file, void *priv, |
| 1113 | struct v4l2_frmivalenum *fival) | 1113 | struct v4l2_frmivalenum *fival) |
| 1114 | { | 1114 | { |
| @@ -1125,7 +1125,7 @@ static int vidioc_enum_frameintervals(struct file *file, void *priv, | |||
| 1125 | 1125 | ||
| 1126 | fival->type = V4L2_FRMIVAL_TYPE_CONTINUOUS; | 1126 | fival->type = V4L2_FRMIVAL_TYPE_CONTINUOUS; |
| 1127 | 1127 | ||
| 1128 | /* fill in stepwise (step=1.0 is requred by V4L2 spec) */ | 1128 | /* fill in stepwise (step=1.0 is required by V4L2 spec) */ |
| 1129 | fival->stepwise.min = tpf_min; | 1129 | fival->stepwise.min = tpf_min; |
| 1130 | fival->stepwise.max = tpf_max; | 1130 | fival->stepwise.max = tpf_max; |
| 1131 | fival->stepwise.step = (struct v4l2_fract) {1, 1}; | 1131 | fival->stepwise.step = (struct v4l2_fract) {1, 1}; |
diff --git a/drivers/media/platform/vsp1/vsp1_drv.c b/drivers/media/platform/vsp1/vsp1_drv.c index 1c9e771aa15c..d16bf0f41e24 100644 --- a/drivers/media/platform/vsp1/vsp1_drv.c +++ b/drivers/media/platform/vsp1/vsp1_drv.c | |||
| @@ -323,7 +323,7 @@ static void vsp1_clocks_disable(struct vsp1_device *vsp1) | |||
| 323 | * Increment the VSP1 reference count and initialize the device if the first | 323 | * Increment the VSP1 reference count and initialize the device if the first |
| 324 | * reference is taken. | 324 | * reference is taken. |
| 325 | * | 325 | * |
| 326 | * Return a pointer to the VSP1 device or NULL if an error occured. | 326 | * Return a pointer to the VSP1 device or NULL if an error occurred. |
| 327 | */ | 327 | */ |
| 328 | struct vsp1_device *vsp1_device_get(struct vsp1_device *vsp1) | 328 | struct vsp1_device *vsp1_device_get(struct vsp1_device *vsp1) |
| 329 | { | 329 | { |
diff --git a/drivers/media/platform/vsp1/vsp1_video.c b/drivers/media/platform/vsp1/vsp1_video.c index 714c53ef6c11..4b0ac07af662 100644 --- a/drivers/media/platform/vsp1/vsp1_video.c +++ b/drivers/media/platform/vsp1/vsp1_video.c | |||
| @@ -1026,8 +1026,10 @@ int vsp1_video_init(struct vsp1_video *video, struct vsp1_entity *rwpf) | |||
| 1026 | 1026 | ||
| 1027 | /* ... and the buffers queue... */ | 1027 | /* ... and the buffers queue... */ |
| 1028 | video->alloc_ctx = vb2_dma_contig_init_ctx(video->vsp1->dev); | 1028 | video->alloc_ctx = vb2_dma_contig_init_ctx(video->vsp1->dev); |
| 1029 | if (IS_ERR(video->alloc_ctx)) | 1029 | if (IS_ERR(video->alloc_ctx)) { |
| 1030 | ret = PTR_ERR(video->alloc_ctx); | ||
| 1030 | goto error; | 1031 | goto error; |
| 1032 | } | ||
| 1031 | 1033 | ||
| 1032 | video->queue.type = video->type; | 1034 | video->queue.type = video->type; |
| 1033 | video->queue.io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF; | 1035 | video->queue.io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF; |
diff --git a/drivers/media/radio/radio-shark.c b/drivers/media/radio/radio-shark.c index 3db8a8cfe1a8..050b3bb96fec 100644 --- a/drivers/media/radio/radio-shark.c +++ b/drivers/media/radio/radio-shark.c | |||
| @@ -271,8 +271,7 @@ static void shark_unregister_leds(struct shark_device *shark) | |||
| 271 | cancel_work_sync(&shark->led_work); | 271 | cancel_work_sync(&shark->led_work); |
| 272 | } | 272 | } |
| 273 | 273 | ||
| 274 | #ifdef CONFIG_PM | 274 | static inline void shark_resume_leds(struct shark_device *shark) |
| 275 | static void shark_resume_leds(struct shark_device *shark) | ||
| 276 | { | 275 | { |
| 277 | if (test_bit(BLUE_IS_PULSE, &shark->brightness_new)) | 276 | if (test_bit(BLUE_IS_PULSE, &shark->brightness_new)) |
| 278 | set_bit(BLUE_PULSE_LED, &shark->brightness_new); | 277 | set_bit(BLUE_PULSE_LED, &shark->brightness_new); |
| @@ -281,7 +280,6 @@ static void shark_resume_leds(struct shark_device *shark) | |||
| 281 | set_bit(RED_LED, &shark->brightness_new); | 280 | set_bit(RED_LED, &shark->brightness_new); |
| 282 | schedule_work(&shark->led_work); | 281 | schedule_work(&shark->led_work); |
| 283 | } | 282 | } |
| 284 | #endif | ||
| 285 | #else | 283 | #else |
| 286 | static int shark_register_leds(struct shark_device *shark, struct device *dev) | 284 | static int shark_register_leds(struct shark_device *shark, struct device *dev) |
| 287 | { | 285 | { |
diff --git a/drivers/media/radio/radio-shark2.c b/drivers/media/radio/radio-shark2.c index d86d90dab8bf..8654e0dc5c95 100644 --- a/drivers/media/radio/radio-shark2.c +++ b/drivers/media/radio/radio-shark2.c | |||
| @@ -237,8 +237,7 @@ static void shark_unregister_leds(struct shark_device *shark) | |||
| 237 | cancel_work_sync(&shark->led_work); | 237 | cancel_work_sync(&shark->led_work); |
| 238 | } | 238 | } |
| 239 | 239 | ||
| 240 | #ifdef CONFIG_PM | 240 | static inline void shark_resume_leds(struct shark_device *shark) |
| 241 | static void shark_resume_leds(struct shark_device *shark) | ||
| 242 | { | 241 | { |
| 243 | int i; | 242 | int i; |
| 244 | 243 | ||
| @@ -247,7 +246,6 @@ static void shark_resume_leds(struct shark_device *shark) | |||
| 247 | 246 | ||
| 248 | schedule_work(&shark->led_work); | 247 | schedule_work(&shark->led_work); |
| 249 | } | 248 | } |
| 250 | #endif | ||
| 251 | #else | 249 | #else |
| 252 | static int shark_register_leds(struct shark_device *shark, struct device *dev) | 250 | static int shark_register_leds(struct shark_device *shark, struct device *dev) |
| 253 | { | 251 | { |
diff --git a/drivers/media/radio/radio-si476x.c b/drivers/media/radio/radio-si476x.c index 9c9084cb99f7..2fd9009f8663 100644 --- a/drivers/media/radio/radio-si476x.c +++ b/drivers/media/radio/radio-si476x.c | |||
| @@ -268,8 +268,8 @@ struct si476x_radio; | |||
| 268 | * | 268 | * |
| 269 | * @tune_freq: Tune chip to a specific frequency | 269 | * @tune_freq: Tune chip to a specific frequency |
| 270 | * @seek_start: Star station seeking | 270 | * @seek_start: Star station seeking |
| 271 | * @rsq_status: Get Recieved Signal Quality(RSQ) status | 271 | * @rsq_status: Get Received Signal Quality(RSQ) status |
| 272 | * @rds_blckcnt: Get recived RDS blocks count | 272 | * @rds_blckcnt: Get received RDS blocks count |
| 273 | * @phase_diversity: Change phase diversity mode of the tuner | 273 | * @phase_diversity: Change phase diversity mode of the tuner |
| 274 | * @phase_div_status: Get phase diversity mode status | 274 | * @phase_div_status: Get phase diversity mode status |
| 275 | * @acf_status: Get the status of Automatically Controlled | 275 | * @acf_status: Get the status of Automatically Controlled |
diff --git a/drivers/media/radio/radio-tea5764.c b/drivers/media/radio/radio-tea5764.c index 036e2f54f4db..3ed1f5669f79 100644 --- a/drivers/media/radio/radio-tea5764.c +++ b/drivers/media/radio/radio-tea5764.c | |||
| @@ -356,7 +356,7 @@ static int vidioc_s_frequency(struct file *file, void *priv, | |||
| 356 | So we keep it as-is. */ | 356 | So we keep it as-is. */ |
| 357 | return -EINVAL; | 357 | return -EINVAL; |
| 358 | } | 358 | } |
| 359 | clamp(freq, FREQ_MIN * FREQ_MUL, FREQ_MAX * FREQ_MUL); | 359 | freq = clamp(freq, FREQ_MIN * FREQ_MUL, FREQ_MAX * FREQ_MUL); |
| 360 | tea5764_power_up(radio); | 360 | tea5764_power_up(radio); |
| 361 | tea5764_tune(radio, (freq * 125) / 2); | 361 | tea5764_tune(radio, (freq * 125) / 2); |
| 362 | return 0; | 362 | return 0; |
diff --git a/drivers/media/radio/tef6862.c b/drivers/media/radio/tef6862.c index 69e3245a58a0..a9319a24c7ef 100644 --- a/drivers/media/radio/tef6862.c +++ b/drivers/media/radio/tef6862.c | |||
| @@ -112,7 +112,7 @@ static int tef6862_s_frequency(struct v4l2_subdev *sd, const struct v4l2_frequen | |||
| 112 | if (f->tuner != 0) | 112 | if (f->tuner != 0) |
| 113 | return -EINVAL; | 113 | return -EINVAL; |
| 114 | 114 | ||
| 115 | clamp(freq, TEF6862_LO_FREQ, TEF6862_HI_FREQ); | 115 | freq = clamp(freq, TEF6862_LO_FREQ, TEF6862_HI_FREQ); |
| 116 | pll = 1964 + ((freq - TEF6862_LO_FREQ) * 20) / FREQ_MUL; | 116 | pll = 1964 + ((freq - TEF6862_LO_FREQ) * 20) / FREQ_MUL; |
| 117 | i2cmsg[0] = (MSA_MODE_PRESET << MSA_MODE_SHIFT) | WM_SUB_PLLM; | 117 | i2cmsg[0] = (MSA_MODE_PRESET << MSA_MODE_SHIFT) | WM_SUB_PLLM; |
| 118 | i2cmsg[1] = (pll >> 8) & 0xff; | 118 | i2cmsg[1] = (pll >> 8) & 0xff; |
diff --git a/drivers/media/rc/imon.c b/drivers/media/rc/imon.c index 72e3fa652481..f329485c6629 100644 --- a/drivers/media/rc/imon.c +++ b/drivers/media/rc/imon.c | |||
| @@ -1370,7 +1370,7 @@ static void imon_pad_to_keys(struct imon_context *ictx, unsigned char *buf) | |||
| 1370 | * 0x68nnnnB7 to 0x6AnnnnB7, the left mouse button generates | 1370 | * 0x68nnnnB7 to 0x6AnnnnB7, the left mouse button generates |
| 1371 | * 0x688301b7 and the right one 0x688481b7. All other keys generate | 1371 | * 0x688301b7 and the right one 0x688481b7. All other keys generate |
| 1372 | * 0x2nnnnnnn. Position coordinate is encoded in buf[1] and buf[2] with | 1372 | * 0x2nnnnnnn. Position coordinate is encoded in buf[1] and buf[2] with |
| 1373 | * reversed endianess. Extract direction from buffer, rotate endianess, | 1373 | * reversed endianness. Extract direction from buffer, rotate endianness, |
| 1374 | * adjust sign and feed the values into stabilize(). The resulting codes | 1374 | * adjust sign and feed the values into stabilize(). The resulting codes |
| 1375 | * will be 0x01008000, 0x01007F00, which match the newer devices. | 1375 | * will be 0x01008000, 0x01007F00, which match the newer devices. |
| 1376 | */ | 1376 | */ |
diff --git a/drivers/media/rc/redrat3.c b/drivers/media/rc/redrat3.c index 094484fac94c..a5d4f883d053 100644 --- a/drivers/media/rc/redrat3.c +++ b/drivers/media/rc/redrat3.c | |||
| @@ -118,7 +118,7 @@ static int debug; | |||
| 118 | #define RR3_IR_IO_LENGTH_FUZZ 0x04 | 118 | #define RR3_IR_IO_LENGTH_FUZZ 0x04 |
| 119 | /* Timeout for end of signal detection */ | 119 | /* Timeout for end of signal detection */ |
| 120 | #define RR3_IR_IO_SIG_TIMEOUT 0x05 | 120 | #define RR3_IR_IO_SIG_TIMEOUT 0x05 |
| 121 | /* Minumum value for pause recognition. */ | 121 | /* Minimum value for pause recognition. */ |
| 122 | #define RR3_IR_IO_MIN_PAUSE 0x06 | 122 | #define RR3_IR_IO_MIN_PAUSE 0x06 |
| 123 | 123 | ||
| 124 | /* Clock freq. of EZ-USB chip */ | 124 | /* Clock freq. of EZ-USB chip */ |
diff --git a/drivers/media/tuners/mt2063.c b/drivers/media/tuners/mt2063.c index 2e1a02e360ff..20cca405bf45 100644 --- a/drivers/media/tuners/mt2063.c +++ b/drivers/media/tuners/mt2063.c | |||
| @@ -1195,7 +1195,7 @@ static u32 mt2063_set_dnc_output_enable(struct mt2063_state *state, | |||
| 1195 | * DNC Output is selected, the other is always off) | 1195 | * DNC Output is selected, the other is always off) |
| 1196 | * | 1196 | * |
| 1197 | * @state: ptr to mt2063_state structure | 1197 | * @state: ptr to mt2063_state structure |
| 1198 | * @Mode: desired reciever delivery system | 1198 | * @Mode: desired receiver delivery system |
| 1199 | * | 1199 | * |
| 1200 | * Note: Register cache must be valid for it to work | 1200 | * Note: Register cache must be valid for it to work |
| 1201 | */ | 1201 | */ |
| @@ -2119,7 +2119,7 @@ static int mt2063_set_analog_params(struct dvb_frontend *fe, | |||
| 2119 | 2119 | ||
| 2120 | /* | 2120 | /* |
| 2121 | * As defined on EN 300 429, the DVB-C roll-off factor is 0.15. | 2121 | * As defined on EN 300 429, the DVB-C roll-off factor is 0.15. |
| 2122 | * So, the amount of the needed bandwith is given by: | 2122 | * So, the amount of the needed bandwidth is given by: |
| 2123 | * Bw = Symbol_rate * (1 + 0.15) | 2123 | * Bw = Symbol_rate * (1 + 0.15) |
| 2124 | * As such, the maximum symbol rate supported by 6 MHz is given by: | 2124 | * As such, the maximum symbol rate supported by 6 MHz is given by: |
| 2125 | * max_symbol_rate = 6 MHz / 1.15 = 5217391 Bauds | 2125 | * max_symbol_rate = 6 MHz / 1.15 = 5217391 Bauds |
diff --git a/drivers/media/tuners/tuner-xc2028-types.h b/drivers/media/tuners/tuner-xc2028-types.h index 74dc46a71f64..7e4798783db7 100644 --- a/drivers/media/tuners/tuner-xc2028-types.h +++ b/drivers/media/tuners/tuner-xc2028-types.h | |||
| @@ -119,7 +119,7 @@ | |||
| 119 | #define V4L2_STD_A2 (V4L2_STD_A2_A | V4L2_STD_A2_B) | 119 | #define V4L2_STD_A2 (V4L2_STD_A2_A | V4L2_STD_A2_B) |
| 120 | #define V4L2_STD_NICAM (V4L2_STD_NICAM_A | V4L2_STD_NICAM_B) | 120 | #define V4L2_STD_NICAM (V4L2_STD_NICAM_A | V4L2_STD_NICAM_B) |
| 121 | 121 | ||
| 122 | /* To preserve backward compatibilty, | 122 | /* To preserve backward compatibility, |
| 123 | (std & V4L2_STD_AUDIO) = 0 means that ALL audio stds are supported | 123 | (std & V4L2_STD_AUDIO) = 0 means that ALL audio stds are supported |
| 124 | */ | 124 | */ |
| 125 | 125 | ||
diff --git a/drivers/media/usb/cx231xx/cx231xx-cards.c b/drivers/media/usb/cx231xx/cx231xx-cards.c index e9d017bea377..528cce958a82 100644 --- a/drivers/media/usb/cx231xx/cx231xx-cards.c +++ b/drivers/media/usb/cx231xx/cx231xx-cards.c | |||
| @@ -1412,8 +1412,8 @@ err_v4l2: | |||
| 1412 | usb_set_intfdata(interface, NULL); | 1412 | usb_set_intfdata(interface, NULL); |
| 1413 | err_if: | 1413 | err_if: |
| 1414 | usb_put_dev(udev); | 1414 | usb_put_dev(udev); |
| 1415 | kfree(dev); | ||
| 1416 | clear_bit(dev->devno, &cx231xx_devused); | 1415 | clear_bit(dev->devno, &cx231xx_devused); |
| 1416 | kfree(dev); | ||
| 1417 | return retval; | 1417 | return retval; |
| 1418 | } | 1418 | } |
| 1419 | 1419 | ||
diff --git a/drivers/media/usb/dvb-usb-v2/af9035.c b/drivers/media/usb/dvb-usb-v2/af9035.c index c8fcd78425bd..8f9b2cea88f0 100644 --- a/drivers/media/usb/dvb-usb-v2/af9035.c +++ b/drivers/media/usb/dvb-usb-v2/af9035.c | |||
| @@ -131,7 +131,7 @@ static int af9035_wr_regs(struct dvb_usb_device *d, u32 reg, u8 *val, int len) | |||
| 131 | { | 131 | { |
| 132 | u8 wbuf[MAX_XFER_SIZE]; | 132 | u8 wbuf[MAX_XFER_SIZE]; |
| 133 | u8 mbox = (reg >> 16) & 0xff; | 133 | u8 mbox = (reg >> 16) & 0xff; |
| 134 | struct usb_req req = { CMD_MEM_WR, mbox, sizeof(wbuf), wbuf, 0, NULL }; | 134 | struct usb_req req = { CMD_MEM_WR, mbox, 6 + len, wbuf, 0, NULL }; |
| 135 | 135 | ||
| 136 | if (6 + len > sizeof(wbuf)) { | 136 | if (6 + len > sizeof(wbuf)) { |
| 137 | dev_warn(&d->udev->dev, "%s: i2c wr: len=%d is too big!\n", | 137 | dev_warn(&d->udev->dev, "%s: i2c wr: len=%d is too big!\n", |
| @@ -238,14 +238,15 @@ static int af9035_i2c_master_xfer(struct i2c_adapter *adap, | |||
| 238 | } else { | 238 | } else { |
| 239 | /* I2C */ | 239 | /* I2C */ |
| 240 | u8 buf[MAX_XFER_SIZE]; | 240 | u8 buf[MAX_XFER_SIZE]; |
| 241 | struct usb_req req = { CMD_I2C_RD, 0, sizeof(buf), | 241 | struct usb_req req = { CMD_I2C_RD, 0, 5 + msg[0].len, |
| 242 | buf, msg[1].len, msg[1].buf }; | 242 | buf, msg[1].len, msg[1].buf }; |
| 243 | 243 | ||
| 244 | if (5 + msg[0].len > sizeof(buf)) { | 244 | if (5 + msg[0].len > sizeof(buf)) { |
| 245 | dev_warn(&d->udev->dev, | 245 | dev_warn(&d->udev->dev, |
| 246 | "%s: i2c xfer: len=%d is too big!\n", | 246 | "%s: i2c xfer: len=%d is too big!\n", |
| 247 | KBUILD_MODNAME, msg[0].len); | 247 | KBUILD_MODNAME, msg[0].len); |
| 248 | return -EOPNOTSUPP; | 248 | ret = -EOPNOTSUPP; |
| 249 | goto unlock; | ||
| 249 | } | 250 | } |
| 250 | req.mbox |= ((msg[0].addr & 0x80) >> 3); | 251 | req.mbox |= ((msg[0].addr & 0x80) >> 3); |
| 251 | buf[0] = msg[1].len; | 252 | buf[0] = msg[1].len; |
| @@ -274,14 +275,15 @@ static int af9035_i2c_master_xfer(struct i2c_adapter *adap, | |||
| 274 | } else { | 275 | } else { |
| 275 | /* I2C */ | 276 | /* I2C */ |
| 276 | u8 buf[MAX_XFER_SIZE]; | 277 | u8 buf[MAX_XFER_SIZE]; |
| 277 | struct usb_req req = { CMD_I2C_WR, 0, sizeof(buf), buf, | 278 | struct usb_req req = { CMD_I2C_WR, 0, 5 + msg[0].len, |
| 278 | 0, NULL }; | 279 | buf, 0, NULL }; |
| 279 | 280 | ||
| 280 | if (5 + msg[0].len > sizeof(buf)) { | 281 | if (5 + msg[0].len > sizeof(buf)) { |
| 281 | dev_warn(&d->udev->dev, | 282 | dev_warn(&d->udev->dev, |
| 282 | "%s: i2c xfer: len=%d is too big!\n", | 283 | "%s: i2c xfer: len=%d is too big!\n", |
| 283 | KBUILD_MODNAME, msg[0].len); | 284 | KBUILD_MODNAME, msg[0].len); |
| 284 | return -EOPNOTSUPP; | 285 | ret = -EOPNOTSUPP; |
| 286 | goto unlock; | ||
| 285 | } | 287 | } |
| 286 | req.mbox |= ((msg[0].addr & 0x80) >> 3); | 288 | req.mbox |= ((msg[0].addr & 0x80) >> 3); |
| 287 | buf[0] = msg[0].len; | 289 | buf[0] = msg[0].len; |
| @@ -319,6 +321,7 @@ static int af9035_i2c_master_xfer(struct i2c_adapter *adap, | |||
| 319 | ret = -EOPNOTSUPP; | 321 | ret = -EOPNOTSUPP; |
| 320 | } | 322 | } |
| 321 | 323 | ||
| 324 | unlock: | ||
| 322 | mutex_unlock(&d->i2c_mutex); | 325 | mutex_unlock(&d->i2c_mutex); |
| 323 | 326 | ||
| 324 | if (ret < 0) | 327 | if (ret < 0) |
| @@ -1534,6 +1537,8 @@ static const struct usb_device_id af9035_id_table[] = { | |||
| 1534 | /* XXX: that same ID [0ccd:0099] is used by af9015 driver too */ | 1537 | /* XXX: that same ID [0ccd:0099] is used by af9015 driver too */ |
| 1535 | { DVB_USB_DEVICE(USB_VID_TERRATEC, 0x0099, | 1538 | { DVB_USB_DEVICE(USB_VID_TERRATEC, 0x0099, |
| 1536 | &af9035_props, "TerraTec Cinergy T Stick Dual RC (rev. 2)", NULL) }, | 1539 | &af9035_props, "TerraTec Cinergy T Stick Dual RC (rev. 2)", NULL) }, |
| 1540 | { DVB_USB_DEVICE(USB_VID_LEADTEK, 0x6a05, | ||
| 1541 | &af9035_props, "Leadtek WinFast DTV Dongle Dual", NULL) }, | ||
| 1537 | { } | 1542 | { } |
| 1538 | }; | 1543 | }; |
| 1539 | MODULE_DEVICE_TABLE(usb, af9035_id_table); | 1544 | MODULE_DEVICE_TABLE(usb, af9035_id_table); |
diff --git a/drivers/media/usb/dvb-usb-v2/mxl111sf.c b/drivers/media/usb/dvb-usb-v2/mxl111sf.c index 2627553f7de1..08240e498451 100644 --- a/drivers/media/usb/dvb-usb-v2/mxl111sf.c +++ b/drivers/media/usb/dvb-usb-v2/mxl111sf.c | |||
| @@ -266,7 +266,7 @@ static int mxl111sf_adap_fe_init(struct dvb_frontend *fe) | |||
| 266 | struct mxl111sf_adap_state *adap_state = &state->adap_state[fe->id]; | 266 | struct mxl111sf_adap_state *adap_state = &state->adap_state[fe->id]; |
| 267 | int err; | 267 | int err; |
| 268 | 268 | ||
| 269 | /* exit if we didnt initialize the driver yet */ | 269 | /* exit if we didn't initialize the driver yet */ |
| 270 | if (!state->chip_id) { | 270 | if (!state->chip_id) { |
| 271 | mxl_debug("driver not yet initialized, exit."); | 271 | mxl_debug("driver not yet initialized, exit."); |
| 272 | goto fail; | 272 | goto fail; |
| @@ -322,7 +322,7 @@ static int mxl111sf_adap_fe_sleep(struct dvb_frontend *fe) | |||
| 322 | struct mxl111sf_adap_state *adap_state = &state->adap_state[fe->id]; | 322 | struct mxl111sf_adap_state *adap_state = &state->adap_state[fe->id]; |
| 323 | int err; | 323 | int err; |
| 324 | 324 | ||
| 325 | /* exit if we didnt initialize the driver yet */ | 325 | /* exit if we didn't initialize the driver yet */ |
| 326 | if (!state->chip_id) { | 326 | if (!state->chip_id) { |
| 327 | mxl_debug("driver not yet initialized, exit."); | 327 | mxl_debug("driver not yet initialized, exit."); |
| 328 | goto fail; | 328 | goto fail; |
diff --git a/drivers/media/usb/dvb-usb/technisat-usb2.c b/drivers/media/usb/dvb-usb/technisat-usb2.c index 40832a1aef6c..98d24aefb640 100644 --- a/drivers/media/usb/dvb-usb/technisat-usb2.c +++ b/drivers/media/usb/dvb-usb/technisat-usb2.c | |||
| @@ -102,7 +102,7 @@ static int technisat_usb2_i2c_access(struct usb_device *udev, | |||
| 102 | if (rxlen > 62) { | 102 | if (rxlen > 62) { |
| 103 | err("i2c RX buffer can't exceed 62 bytes (dev 0x%02x)", | 103 | err("i2c RX buffer can't exceed 62 bytes (dev 0x%02x)", |
| 104 | device_addr); | 104 | device_addr); |
| 105 | txlen = 62; | 105 | rxlen = 62; |
| 106 | } | 106 | } |
| 107 | 107 | ||
| 108 | b[0] = I2C_SPEED_100KHZ_BIT; | 108 | b[0] = I2C_SPEED_100KHZ_BIT; |
diff --git a/drivers/media/usb/em28xx/em28xx-video.c b/drivers/media/usb/em28xx/em28xx-video.c index fc5d60efd4ab..dd19c9ff76e0 100644 --- a/drivers/media/usb/em28xx/em28xx-video.c +++ b/drivers/media/usb/em28xx/em28xx-video.c | |||
| @@ -1664,8 +1664,8 @@ static int em28xx_v4l2_close(struct file *filp) | |||
| 1664 | 1664 | ||
| 1665 | em28xx_videodbg("users=%d\n", dev->users); | 1665 | em28xx_videodbg("users=%d\n", dev->users); |
| 1666 | 1666 | ||
| 1667 | mutex_lock(&dev->lock); | ||
| 1668 | vb2_fop_release(filp); | 1667 | vb2_fop_release(filp); |
| 1668 | mutex_lock(&dev->lock); | ||
| 1669 | 1669 | ||
| 1670 | if (dev->users == 1) { | 1670 | if (dev->users == 1) { |
| 1671 | /* the device is already disconnect, | 1671 | /* the device is already disconnect, |
diff --git a/drivers/media/usb/gspca/gl860/gl860.c b/drivers/media/usb/gspca/gl860/gl860.c index cb1e64ca59c9..cea8d7f51c3c 100644 --- a/drivers/media/usb/gspca/gl860/gl860.c +++ b/drivers/media/usb/gspca/gl860/gl860.c | |||
| @@ -438,7 +438,7 @@ static void sd_pkt_scan(struct gspca_dev *gspca_dev, | |||
| 438 | s32 nToSkip = | 438 | s32 nToSkip = |
| 439 | sd->swapRB * (gspca_dev->cam.cam_mode[mode].bytesperline + 1); | 439 | sd->swapRB * (gspca_dev->cam.cam_mode[mode].bytesperline + 1); |
| 440 | 440 | ||
| 441 | /* Test only against 0202h, so endianess does not matter */ | 441 | /* Test only against 0202h, so endianness does not matter */ |
| 442 | switch (*(s16 *) data) { | 442 | switch (*(s16 *) data) { |
| 443 | case 0x0202: /* End of frame, start a new one */ | 443 | case 0x0202: /* End of frame, start a new one */ |
| 444 | gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0); | 444 | gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0); |
diff --git a/drivers/media/usb/gspca/pac207.c b/drivers/media/usb/gspca/pac207.c index cd79c180f67b..07529e5a0c56 100644 --- a/drivers/media/usb/gspca/pac207.c +++ b/drivers/media/usb/gspca/pac207.c | |||
| @@ -416,7 +416,7 @@ static void sd_pkt_scan(struct gspca_dev *gspca_dev, | |||
| 416 | #if IS_ENABLED(CONFIG_INPUT) | 416 | #if IS_ENABLED(CONFIG_INPUT) |
| 417 | static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, | 417 | static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, |
| 418 | u8 *data, /* interrupt packet data */ | 418 | u8 *data, /* interrupt packet data */ |
| 419 | int len) /* interrput packet length */ | 419 | int len) /* interrupt packet length */ |
| 420 | { | 420 | { |
| 421 | int ret = -EINVAL; | 421 | int ret = -EINVAL; |
| 422 | 422 | ||
diff --git a/drivers/media/usb/gspca/pac7302.c b/drivers/media/usb/gspca/pac7302.c index a91509643563..2fd1c5e31a0f 100644 --- a/drivers/media/usb/gspca/pac7302.c +++ b/drivers/media/usb/gspca/pac7302.c | |||
| @@ -874,7 +874,7 @@ static int sd_dbg_s_register(struct gspca_dev *gspca_dev, | |||
| 874 | #if IS_ENABLED(CONFIG_INPUT) | 874 | #if IS_ENABLED(CONFIG_INPUT) |
| 875 | static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, | 875 | static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, |
| 876 | u8 *data, /* interrupt packet data */ | 876 | u8 *data, /* interrupt packet data */ |
| 877 | int len) /* interrput packet length */ | 877 | int len) /* interrupt packet length */ |
| 878 | { | 878 | { |
| 879 | int ret = -EINVAL; | 879 | int ret = -EINVAL; |
| 880 | u8 data0, data1; | 880 | u8 data0, data1; |
diff --git a/drivers/media/usb/gspca/stk1135.c b/drivers/media/usb/gspca/stk1135.c index 1fc80af2a189..48234c9a8b6c 100644 --- a/drivers/media/usb/gspca/stk1135.c +++ b/drivers/media/usb/gspca/stk1135.c | |||
| @@ -361,6 +361,9 @@ static void stk1135_configure_clock(struct gspca_dev *gspca_dev) | |||
| 361 | 361 | ||
| 362 | /* set serial interface clock divider (30MHz/0x1f*16+2) = 60240 kHz) */ | 362 | /* set serial interface clock divider (30MHz/0x1f*16+2) = 60240 kHz) */ |
| 363 | reg_w(gspca_dev, STK1135_REG_SICTL + 2, 0x1f); | 363 | reg_w(gspca_dev, STK1135_REG_SICTL + 2, 0x1f); |
| 364 | |||
| 365 | /* wait a while for sensor to catch up */ | ||
| 366 | udelay(1000); | ||
| 364 | } | 367 | } |
| 365 | 368 | ||
| 366 | static void stk1135_camera_disable(struct gspca_dev *gspca_dev) | 369 | static void stk1135_camera_disable(struct gspca_dev *gspca_dev) |
diff --git a/drivers/media/usb/gspca/stv0680.c b/drivers/media/usb/gspca/stv0680.c index 9c0827631b9c..7f94ec74282e 100644 --- a/drivers/media/usb/gspca/stv0680.c +++ b/drivers/media/usb/gspca/stv0680.c | |||
| @@ -139,7 +139,7 @@ static int sd_config(struct gspca_dev *gspca_dev, | |||
| 139 | struct sd *sd = (struct sd *) gspca_dev; | 139 | struct sd *sd = (struct sd *) gspca_dev; |
| 140 | struct cam *cam = &gspca_dev->cam; | 140 | struct cam *cam = &gspca_dev->cam; |
| 141 | 141 | ||
| 142 | /* Give the camera some time to settle, otherwise initalization will | 142 | /* Give the camera some time to settle, otherwise initialization will |
| 143 | fail on hotplug, and yes it really needs a full second. */ | 143 | fail on hotplug, and yes it really needs a full second. */ |
| 144 | msleep(1000); | 144 | msleep(1000); |
| 145 | 145 | ||
diff --git a/drivers/media/usb/gspca/sunplus.c b/drivers/media/usb/gspca/sunplus.c index a517d185febe..46c9f2229a18 100644 --- a/drivers/media/usb/gspca/sunplus.c +++ b/drivers/media/usb/gspca/sunplus.c | |||
| @@ -1027,6 +1027,7 @@ static const struct usb_device_id device_table[] = { | |||
| 1027 | {USB_DEVICE(0x055f, 0xc650), BS(SPCA533, 0)}, | 1027 | {USB_DEVICE(0x055f, 0xc650), BS(SPCA533, 0)}, |
| 1028 | {USB_DEVICE(0x05da, 0x1018), BS(SPCA504B, 0)}, | 1028 | {USB_DEVICE(0x05da, 0x1018), BS(SPCA504B, 0)}, |
| 1029 | {USB_DEVICE(0x06d6, 0x0031), BS(SPCA533, 0)}, | 1029 | {USB_DEVICE(0x06d6, 0x0031), BS(SPCA533, 0)}, |
| 1030 | {USB_DEVICE(0x06d6, 0x0041), BS(SPCA504B, 0)}, | ||
| 1030 | {USB_DEVICE(0x0733, 0x1311), BS(SPCA533, 0)}, | 1031 | {USB_DEVICE(0x0733, 0x1311), BS(SPCA533, 0)}, |
| 1031 | {USB_DEVICE(0x0733, 0x1314), BS(SPCA533, 0)}, | 1032 | {USB_DEVICE(0x0733, 0x1314), BS(SPCA533, 0)}, |
| 1032 | {USB_DEVICE(0x0733, 0x2211), BS(SPCA533, 0)}, | 1033 | {USB_DEVICE(0x0733, 0x2211), BS(SPCA533, 0)}, |
diff --git a/drivers/media/usb/gspca/zc3xx.c b/drivers/media/usb/gspca/zc3xx.c index 7b95d8e88a20..d3e1b6d8bf49 100644 --- a/drivers/media/usb/gspca/zc3xx.c +++ b/drivers/media/usb/gspca/zc3xx.c | |||
| @@ -6905,7 +6905,7 @@ static int sd_get_jcomp(struct gspca_dev *gspca_dev, | |||
| 6905 | #if IS_ENABLED(CONFIG_INPUT) | 6905 | #if IS_ENABLED(CONFIG_INPUT) |
| 6906 | static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, | 6906 | static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, |
| 6907 | u8 *data, /* interrupt packet data */ | 6907 | u8 *data, /* interrupt packet data */ |
| 6908 | int len) /* interrput packet length */ | 6908 | int len) /* interrupt packet length */ |
| 6909 | { | 6909 | { |
| 6910 | if (len == 8 && data[4] == 1) { | 6910 | if (len == 8 && data[4] == 1) { |
| 6911 | input_report_key(gspca_dev->input_dev, KEY_CAMERA, 1); | 6911 | input_report_key(gspca_dev->input_dev, KEY_CAMERA, 1); |
diff --git a/drivers/media/usb/pwc/pwc-if.c b/drivers/media/usb/pwc/pwc-if.c index 77bbf7889659..78c9bc8e7f56 100644 --- a/drivers/media/usb/pwc/pwc-if.c +++ b/drivers/media/usb/pwc/pwc-if.c | |||
| @@ -1039,7 +1039,7 @@ static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id | |||
| 1039 | /* Set the leds off */ | 1039 | /* Set the leds off */ |
| 1040 | pwc_set_leds(pdev, 0, 0); | 1040 | pwc_set_leds(pdev, 0, 0); |
| 1041 | 1041 | ||
| 1042 | /* Setup intial videomode */ | 1042 | /* Setup initial videomode */ |
| 1043 | rc = pwc_set_video_mode(pdev, MAX_WIDTH, MAX_HEIGHT, | 1043 | rc = pwc_set_video_mode(pdev, MAX_WIDTH, MAX_HEIGHT, |
| 1044 | V4L2_PIX_FMT_YUV420, 30, &compression, 1); | 1044 | V4L2_PIX_FMT_YUV420, 30, &compression, 1); |
| 1045 | if (rc) | 1045 | if (rc) |
diff --git a/drivers/media/usb/usbtv/usbtv.c b/drivers/media/usb/usbtv/usbtv.c index 8a505a90d318..6222a4ab1e00 100644 --- a/drivers/media/usb/usbtv/usbtv.c +++ b/drivers/media/usb/usbtv/usbtv.c | |||
| @@ -50,13 +50,8 @@ | |||
| 50 | #define USBTV_ISOC_TRANSFERS 16 | 50 | #define USBTV_ISOC_TRANSFERS 16 |
| 51 | #define USBTV_ISOC_PACKETS 8 | 51 | #define USBTV_ISOC_PACKETS 8 |
| 52 | 52 | ||
| 53 | #define USBTV_WIDTH 720 | ||
| 54 | #define USBTV_HEIGHT 480 | ||
| 55 | |||
| 56 | #define USBTV_CHUNK_SIZE 256 | 53 | #define USBTV_CHUNK_SIZE 256 |
| 57 | #define USBTV_CHUNK 240 | 54 | #define USBTV_CHUNK 240 |
| 58 | #define USBTV_CHUNKS (USBTV_WIDTH * USBTV_HEIGHT \ | ||
| 59 | / 4 / USBTV_CHUNK) | ||
| 60 | 55 | ||
| 61 | /* Chunk header. */ | 56 | /* Chunk header. */ |
| 62 | #define USBTV_MAGIC_OK(chunk) ((be32_to_cpu(chunk[0]) & 0xff000000) \ | 57 | #define USBTV_MAGIC_OK(chunk) ((be32_to_cpu(chunk[0]) & 0xff000000) \ |
| @@ -65,6 +60,27 @@ | |||
| 65 | #define USBTV_ODD(chunk) ((be32_to_cpu(chunk[0]) & 0x0000f000) >> 15) | 60 | #define USBTV_ODD(chunk) ((be32_to_cpu(chunk[0]) & 0x0000f000) >> 15) |
| 66 | #define USBTV_CHUNK_NO(chunk) (be32_to_cpu(chunk[0]) & 0x00000fff) | 61 | #define USBTV_CHUNK_NO(chunk) (be32_to_cpu(chunk[0]) & 0x00000fff) |
| 67 | 62 | ||
| 63 | #define USBTV_TV_STD (V4L2_STD_525_60 | V4L2_STD_PAL) | ||
| 64 | |||
| 65 | /* parameters for supported TV norms */ | ||
| 66 | struct usbtv_norm_params { | ||
| 67 | v4l2_std_id norm; | ||
| 68 | int cap_width, cap_height; | ||
| 69 | }; | ||
| 70 | |||
| 71 | static struct usbtv_norm_params norm_params[] = { | ||
| 72 | { | ||
| 73 | .norm = V4L2_STD_525_60, | ||
| 74 | .cap_width = 720, | ||
| 75 | .cap_height = 480, | ||
| 76 | }, | ||
| 77 | { | ||
| 78 | .norm = V4L2_STD_PAL, | ||
| 79 | .cap_width = 720, | ||
| 80 | .cap_height = 576, | ||
| 81 | } | ||
| 82 | }; | ||
| 83 | |||
| 68 | /* A single videobuf2 frame buffer. */ | 84 | /* A single videobuf2 frame buffer. */ |
| 69 | struct usbtv_buf { | 85 | struct usbtv_buf { |
| 70 | struct vb2_buffer vb; | 86 | struct vb2_buffer vb; |
| @@ -94,11 +110,38 @@ struct usbtv { | |||
| 94 | USBTV_COMPOSITE_INPUT, | 110 | USBTV_COMPOSITE_INPUT, |
| 95 | USBTV_SVIDEO_INPUT, | 111 | USBTV_SVIDEO_INPUT, |
| 96 | } input; | 112 | } input; |
| 113 | v4l2_std_id norm; | ||
| 114 | int width, height; | ||
| 115 | int n_chunks; | ||
| 97 | int iso_size; | 116 | int iso_size; |
| 98 | unsigned int sequence; | 117 | unsigned int sequence; |
| 99 | struct urb *isoc_urbs[USBTV_ISOC_TRANSFERS]; | 118 | struct urb *isoc_urbs[USBTV_ISOC_TRANSFERS]; |
| 100 | }; | 119 | }; |
| 101 | 120 | ||
| 121 | static int usbtv_configure_for_norm(struct usbtv *usbtv, v4l2_std_id norm) | ||
| 122 | { | ||
| 123 | int i, ret = 0; | ||
| 124 | struct usbtv_norm_params *params = NULL; | ||
| 125 | |||
| 126 | for (i = 0; i < ARRAY_SIZE(norm_params); i++) { | ||
| 127 | if (norm_params[i].norm & norm) { | ||
| 128 | params = &norm_params[i]; | ||
| 129 | break; | ||
| 130 | } | ||
| 131 | } | ||
| 132 | |||
| 133 | if (params) { | ||
| 134 | usbtv->width = params->cap_width; | ||
| 135 | usbtv->height = params->cap_height; | ||
| 136 | usbtv->n_chunks = usbtv->width * usbtv->height | ||
| 137 | / 4 / USBTV_CHUNK; | ||
| 138 | usbtv->norm = params->norm; | ||
| 139 | } else | ||
| 140 | ret = -EINVAL; | ||
| 141 | |||
| 142 | return ret; | ||
| 143 | } | ||
| 144 | |||
| 102 | static int usbtv_set_regs(struct usbtv *usbtv, const u16 regs[][2], int size) | 145 | static int usbtv_set_regs(struct usbtv *usbtv, const u16 regs[][2], int size) |
| 103 | { | 146 | { |
| 104 | int ret; | 147 | int ret; |
| @@ -158,6 +201,57 @@ static int usbtv_select_input(struct usbtv *usbtv, int input) | |||
| 158 | return ret; | 201 | return ret; |
| 159 | } | 202 | } |
| 160 | 203 | ||
| 204 | static int usbtv_select_norm(struct usbtv *usbtv, v4l2_std_id norm) | ||
| 205 | { | ||
| 206 | int ret; | ||
| 207 | static const u16 pal[][2] = { | ||
| 208 | { USBTV_BASE + 0x001a, 0x0068 }, | ||
| 209 | { USBTV_BASE + 0x010e, 0x0072 }, | ||
| 210 | { USBTV_BASE + 0x010f, 0x00a2 }, | ||
| 211 | { USBTV_BASE + 0x0112, 0x00b0 }, | ||
| 212 | { USBTV_BASE + 0x0117, 0x0001 }, | ||
| 213 | { USBTV_BASE + 0x0118, 0x002c }, | ||
| 214 | { USBTV_BASE + 0x012d, 0x0010 }, | ||
| 215 | { USBTV_BASE + 0x012f, 0x0020 }, | ||
| 216 | { USBTV_BASE + 0x024f, 0x0002 }, | ||
| 217 | { USBTV_BASE + 0x0254, 0x0059 }, | ||
| 218 | { USBTV_BASE + 0x025a, 0x0016 }, | ||
| 219 | { USBTV_BASE + 0x025b, 0x0035 }, | ||
| 220 | { USBTV_BASE + 0x0263, 0x0017 }, | ||
| 221 | { USBTV_BASE + 0x0266, 0x0016 }, | ||
| 222 | { USBTV_BASE + 0x0267, 0x0036 } | ||
| 223 | }; | ||
| 224 | |||
| 225 | static const u16 ntsc[][2] = { | ||
| 226 | { USBTV_BASE + 0x001a, 0x0079 }, | ||
| 227 | { USBTV_BASE + 0x010e, 0x0068 }, | ||
| 228 | { USBTV_BASE + 0x010f, 0x009c }, | ||
| 229 | { USBTV_BASE + 0x0112, 0x00f0 }, | ||
| 230 | { USBTV_BASE + 0x0117, 0x0000 }, | ||
| 231 | { USBTV_BASE + 0x0118, 0x00fc }, | ||
| 232 | { USBTV_BASE + 0x012d, 0x0004 }, | ||
| 233 | { USBTV_BASE + 0x012f, 0x0008 }, | ||
| 234 | { USBTV_BASE + 0x024f, 0x0001 }, | ||
| 235 | { USBTV_BASE + 0x0254, 0x005f }, | ||
| 236 | { USBTV_BASE + 0x025a, 0x0012 }, | ||
| 237 | { USBTV_BASE + 0x025b, 0x0001 }, | ||
| 238 | { USBTV_BASE + 0x0263, 0x001c }, | ||
| 239 | { USBTV_BASE + 0x0266, 0x0011 }, | ||
| 240 | { USBTV_BASE + 0x0267, 0x0005 } | ||
| 241 | }; | ||
| 242 | |||
| 243 | ret = usbtv_configure_for_norm(usbtv, norm); | ||
| 244 | |||
| 245 | if (!ret) { | ||
| 246 | if (norm & V4L2_STD_525_60) | ||
| 247 | ret = usbtv_set_regs(usbtv, ntsc, ARRAY_SIZE(ntsc)); | ||
| 248 | else if (norm & V4L2_STD_PAL) | ||
| 249 | ret = usbtv_set_regs(usbtv, pal, ARRAY_SIZE(pal)); | ||
| 250 | } | ||
| 251 | |||
| 252 | return ret; | ||
| 253 | } | ||
| 254 | |||
| 161 | static int usbtv_setup_capture(struct usbtv *usbtv) | 255 | static int usbtv_setup_capture(struct usbtv *usbtv) |
| 162 | { | 256 | { |
| 163 | int ret; | 257 | int ret; |
| @@ -225,26 +319,11 @@ static int usbtv_setup_capture(struct usbtv *usbtv) | |||
| 225 | 319 | ||
| 226 | { USBTV_BASE + 0x0284, 0x0088 }, | 320 | { USBTV_BASE + 0x0284, 0x0088 }, |
| 227 | { USBTV_BASE + 0x0003, 0x0004 }, | 321 | { USBTV_BASE + 0x0003, 0x0004 }, |
| 228 | { USBTV_BASE + 0x001a, 0x0079 }, | ||
| 229 | { USBTV_BASE + 0x0100, 0x00d3 }, | 322 | { USBTV_BASE + 0x0100, 0x00d3 }, |
| 230 | { USBTV_BASE + 0x010e, 0x0068 }, | ||
| 231 | { USBTV_BASE + 0x010f, 0x009c }, | ||
| 232 | { USBTV_BASE + 0x0112, 0x00f0 }, | ||
| 233 | { USBTV_BASE + 0x0115, 0x0015 }, | 323 | { USBTV_BASE + 0x0115, 0x0015 }, |
| 234 | { USBTV_BASE + 0x0117, 0x0000 }, | ||
| 235 | { USBTV_BASE + 0x0118, 0x00fc }, | ||
| 236 | { USBTV_BASE + 0x012d, 0x0004 }, | ||
| 237 | { USBTV_BASE + 0x012f, 0x0008 }, | ||
| 238 | { USBTV_BASE + 0x0220, 0x002e }, | 324 | { USBTV_BASE + 0x0220, 0x002e }, |
| 239 | { USBTV_BASE + 0x0225, 0x0008 }, | 325 | { USBTV_BASE + 0x0225, 0x0008 }, |
| 240 | { USBTV_BASE + 0x024e, 0x0002 }, | 326 | { USBTV_BASE + 0x024e, 0x0002 }, |
| 241 | { USBTV_BASE + 0x024f, 0x0001 }, | ||
| 242 | { USBTV_BASE + 0x0254, 0x005f }, | ||
| 243 | { USBTV_BASE + 0x025a, 0x0012 }, | ||
| 244 | { USBTV_BASE + 0x025b, 0x0001 }, | ||
| 245 | { USBTV_BASE + 0x0263, 0x001c }, | ||
| 246 | { USBTV_BASE + 0x0266, 0x0011 }, | ||
| 247 | { USBTV_BASE + 0x0267, 0x0005 }, | ||
| 248 | { USBTV_BASE + 0x024e, 0x0002 }, | 327 | { USBTV_BASE + 0x024e, 0x0002 }, |
| 249 | { USBTV_BASE + 0x024f, 0x0002 }, | 328 | { USBTV_BASE + 0x024f, 0x0002 }, |
| 250 | }; | 329 | }; |
| @@ -253,6 +332,10 @@ static int usbtv_setup_capture(struct usbtv *usbtv) | |||
| 253 | if (ret) | 332 | if (ret) |
| 254 | return ret; | 333 | return ret; |
| 255 | 334 | ||
| 335 | ret = usbtv_select_norm(usbtv, usbtv->norm); | ||
| 336 | if (ret) | ||
| 337 | return ret; | ||
| 338 | |||
| 256 | ret = usbtv_select_input(usbtv, usbtv->input); | 339 | ret = usbtv_select_input(usbtv, usbtv->input); |
| 257 | if (ret) | 340 | if (ret) |
| 258 | return ret; | 341 | return ret; |
| @@ -296,7 +379,7 @@ static void usbtv_image_chunk(struct usbtv *usbtv, u32 *chunk) | |||
| 296 | frame_id = USBTV_FRAME_ID(chunk); | 379 | frame_id = USBTV_FRAME_ID(chunk); |
| 297 | odd = USBTV_ODD(chunk); | 380 | odd = USBTV_ODD(chunk); |
| 298 | chunk_no = USBTV_CHUNK_NO(chunk); | 381 | chunk_no = USBTV_CHUNK_NO(chunk); |
| 299 | if (chunk_no >= USBTV_CHUNKS) | 382 | if (chunk_no >= usbtv->n_chunks) |
| 300 | return; | 383 | return; |
| 301 | 384 | ||
| 302 | /* Beginning of a frame. */ | 385 | /* Beginning of a frame. */ |
| @@ -324,10 +407,10 @@ static void usbtv_image_chunk(struct usbtv *usbtv, u32 *chunk) | |||
| 324 | usbtv->chunks_done++; | 407 | usbtv->chunks_done++; |
| 325 | 408 | ||
| 326 | /* Last chunk in a frame, signalling an end */ | 409 | /* Last chunk in a frame, signalling an end */ |
| 327 | if (odd && chunk_no == USBTV_CHUNKS-1) { | 410 | if (odd && chunk_no == usbtv->n_chunks-1) { |
| 328 | int size = vb2_plane_size(&buf->vb, 0); | 411 | int size = vb2_plane_size(&buf->vb, 0); |
| 329 | enum vb2_buffer_state state = usbtv->chunks_done == | 412 | enum vb2_buffer_state state = usbtv->chunks_done == |
| 330 | USBTV_CHUNKS ? | 413 | usbtv->n_chunks ? |
| 331 | VB2_BUF_STATE_DONE : | 414 | VB2_BUF_STATE_DONE : |
| 332 | VB2_BUF_STATE_ERROR; | 415 | VB2_BUF_STATE_ERROR; |
| 333 | 416 | ||
| @@ -500,6 +583,8 @@ static int usbtv_querycap(struct file *file, void *priv, | |||
| 500 | static int usbtv_enum_input(struct file *file, void *priv, | 583 | static int usbtv_enum_input(struct file *file, void *priv, |
| 501 | struct v4l2_input *i) | 584 | struct v4l2_input *i) |
| 502 | { | 585 | { |
| 586 | struct usbtv *dev = video_drvdata(file); | ||
| 587 | |||
| 503 | switch (i->index) { | 588 | switch (i->index) { |
| 504 | case USBTV_COMPOSITE_INPUT: | 589 | case USBTV_COMPOSITE_INPUT: |
| 505 | strlcpy(i->name, "Composite", sizeof(i->name)); | 590 | strlcpy(i->name, "Composite", sizeof(i->name)); |
| @@ -512,7 +597,7 @@ static int usbtv_enum_input(struct file *file, void *priv, | |||
| 512 | } | 597 | } |
| 513 | 598 | ||
| 514 | i->type = V4L2_INPUT_TYPE_CAMERA; | 599 | i->type = V4L2_INPUT_TYPE_CAMERA; |
| 515 | i->std = V4L2_STD_525_60; | 600 | i->std = dev->vdev.tvnorms; |
| 516 | return 0; | 601 | return 0; |
| 517 | } | 602 | } |
| 518 | 603 | ||
| @@ -531,23 +616,37 @@ static int usbtv_enum_fmt_vid_cap(struct file *file, void *priv, | |||
| 531 | static int usbtv_fmt_vid_cap(struct file *file, void *priv, | 616 | static int usbtv_fmt_vid_cap(struct file *file, void *priv, |
| 532 | struct v4l2_format *f) | 617 | struct v4l2_format *f) |
| 533 | { | 618 | { |
| 534 | f->fmt.pix.width = USBTV_WIDTH; | 619 | struct usbtv *usbtv = video_drvdata(file); |
| 535 | f->fmt.pix.height = USBTV_HEIGHT; | 620 | |
| 621 | f->fmt.pix.width = usbtv->width; | ||
| 622 | f->fmt.pix.height = usbtv->height; | ||
| 536 | f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV; | 623 | f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV; |
| 537 | f->fmt.pix.field = V4L2_FIELD_INTERLACED; | 624 | f->fmt.pix.field = V4L2_FIELD_INTERLACED; |
| 538 | f->fmt.pix.bytesperline = USBTV_WIDTH * 2; | 625 | f->fmt.pix.bytesperline = usbtv->width * 2; |
| 539 | f->fmt.pix.sizeimage = (f->fmt.pix.bytesperline * f->fmt.pix.height); | 626 | f->fmt.pix.sizeimage = (f->fmt.pix.bytesperline * f->fmt.pix.height); |
| 540 | f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; | 627 | f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; |
| 541 | f->fmt.pix.priv = 0; | 628 | |
| 542 | return 0; | 629 | return 0; |
| 543 | } | 630 | } |
| 544 | 631 | ||
| 545 | static int usbtv_g_std(struct file *file, void *priv, v4l2_std_id *norm) | 632 | static int usbtv_g_std(struct file *file, void *priv, v4l2_std_id *norm) |
| 546 | { | 633 | { |
| 547 | *norm = V4L2_STD_525_60; | 634 | struct usbtv *usbtv = video_drvdata(file); |
| 635 | *norm = usbtv->norm; | ||
| 548 | return 0; | 636 | return 0; |
| 549 | } | 637 | } |
| 550 | 638 | ||
| 639 | static int usbtv_s_std(struct file *file, void *priv, v4l2_std_id norm) | ||
| 640 | { | ||
| 641 | int ret = -EINVAL; | ||
| 642 | struct usbtv *usbtv = video_drvdata(file); | ||
| 643 | |||
| 644 | if ((norm & V4L2_STD_525_60) || (norm & V4L2_STD_PAL)) | ||
| 645 | ret = usbtv_select_norm(usbtv, norm); | ||
| 646 | |||
| 647 | return ret; | ||
| 648 | } | ||
| 649 | |||
| 551 | static int usbtv_g_input(struct file *file, void *priv, unsigned int *i) | 650 | static int usbtv_g_input(struct file *file, void *priv, unsigned int *i) |
| 552 | { | 651 | { |
| 553 | struct usbtv *usbtv = video_drvdata(file); | 652 | struct usbtv *usbtv = video_drvdata(file); |
| @@ -561,13 +660,6 @@ static int usbtv_s_input(struct file *file, void *priv, unsigned int i) | |||
| 561 | return usbtv_select_input(usbtv, i); | 660 | return usbtv_select_input(usbtv, i); |
| 562 | } | 661 | } |
| 563 | 662 | ||
| 564 | static int usbtv_s_std(struct file *file, void *priv, v4l2_std_id norm) | ||
| 565 | { | ||
| 566 | if (norm & V4L2_STD_525_60) | ||
| 567 | return 0; | ||
| 568 | return -EINVAL; | ||
| 569 | } | ||
| 570 | |||
| 571 | struct v4l2_ioctl_ops usbtv_ioctl_ops = { | 663 | struct v4l2_ioctl_ops usbtv_ioctl_ops = { |
| 572 | .vidioc_querycap = usbtv_querycap, | 664 | .vidioc_querycap = usbtv_querycap, |
| 573 | .vidioc_enum_input = usbtv_enum_input, | 665 | .vidioc_enum_input = usbtv_enum_input, |
| @@ -604,10 +696,12 @@ static int usbtv_queue_setup(struct vb2_queue *vq, | |||
| 604 | const struct v4l2_format *v4l_fmt, unsigned int *nbuffers, | 696 | const struct v4l2_format *v4l_fmt, unsigned int *nbuffers, |
| 605 | unsigned int *nplanes, unsigned int sizes[], void *alloc_ctxs[]) | 697 | unsigned int *nplanes, unsigned int sizes[], void *alloc_ctxs[]) |
| 606 | { | 698 | { |
| 699 | struct usbtv *usbtv = vb2_get_drv_priv(vq); | ||
| 700 | |||
| 607 | if (*nbuffers < 2) | 701 | if (*nbuffers < 2) |
| 608 | *nbuffers = 2; | 702 | *nbuffers = 2; |
| 609 | *nplanes = 1; | 703 | *nplanes = 1; |
| 610 | sizes[0] = USBTV_WIDTH * USBTV_HEIGHT / 2 * sizeof(u32); | 704 | sizes[0] = USBTV_CHUNK * usbtv->n_chunks * 2 * sizeof(u32); |
| 611 | 705 | ||
| 612 | return 0; | 706 | return 0; |
| 613 | } | 707 | } |
| @@ -690,7 +784,11 @@ static int usbtv_probe(struct usb_interface *intf, | |||
| 690 | return -ENOMEM; | 784 | return -ENOMEM; |
| 691 | usbtv->dev = dev; | 785 | usbtv->dev = dev; |
| 692 | usbtv->udev = usb_get_dev(interface_to_usbdev(intf)); | 786 | usbtv->udev = usb_get_dev(interface_to_usbdev(intf)); |
| 787 | |||
| 693 | usbtv->iso_size = size; | 788 | usbtv->iso_size = size; |
| 789 | |||
| 790 | (void)usbtv_configure_for_norm(usbtv, V4L2_STD_525_60); | ||
| 791 | |||
| 694 | spin_lock_init(&usbtv->buflock); | 792 | spin_lock_init(&usbtv->buflock); |
| 695 | mutex_init(&usbtv->v4l2_lock); | 793 | mutex_init(&usbtv->v4l2_lock); |
| 696 | mutex_init(&usbtv->vb2q_lock); | 794 | mutex_init(&usbtv->vb2q_lock); |
| @@ -727,7 +825,7 @@ static int usbtv_probe(struct usb_interface *intf, | |||
| 727 | usbtv->vdev.release = video_device_release_empty; | 825 | usbtv->vdev.release = video_device_release_empty; |
| 728 | usbtv->vdev.fops = &usbtv_fops; | 826 | usbtv->vdev.fops = &usbtv_fops; |
| 729 | usbtv->vdev.ioctl_ops = &usbtv_ioctl_ops; | 827 | usbtv->vdev.ioctl_ops = &usbtv_ioctl_ops; |
| 730 | usbtv->vdev.tvnorms = V4L2_STD_525_60; | 828 | usbtv->vdev.tvnorms = USBTV_TV_STD; |
| 731 | usbtv->vdev.queue = &usbtv->vb2q; | 829 | usbtv->vdev.queue = &usbtv->vb2q; |
| 732 | usbtv->vdev.lock = &usbtv->v4l2_lock; | 830 | usbtv->vdev.lock = &usbtv->v4l2_lock; |
| 733 | set_bit(V4L2_FL_USE_FH_PRIO, &usbtv->vdev.flags); | 831 | set_bit(V4L2_FL_USE_FH_PRIO, &usbtv->vdev.flags); |
diff --git a/drivers/media/usb/uvc/uvc_video.c b/drivers/media/usb/uvc/uvc_video.c index 899cb6d1c4a4..898c208889cd 100644 --- a/drivers/media/usb/uvc/uvc_video.c +++ b/drivers/media/usb/uvc/uvc_video.c | |||
| @@ -556,7 +556,7 @@ static u16 uvc_video_clock_host_sof(const struct uvc_clock_sample *sample) | |||
| 556 | * | 556 | * |
| 557 | * SOF = ((SOF2 - SOF1) * PTS + SOF1 * STC2 - SOF2 * STC1) / (STC2 - STC1) (1) | 557 | * SOF = ((SOF2 - SOF1) * PTS + SOF1 * STC2 - SOF2 * STC1) / (STC2 - STC1) (1) |
| 558 | * | 558 | * |
| 559 | * to avoid loosing precision in the division. Similarly, the host timestamp is | 559 | * to avoid losing precision in the division. Similarly, the host timestamp is |
| 560 | * computed with | 560 | * computed with |
| 561 | * | 561 | * |
| 562 | * TS = ((TS2 - TS1) * PTS + TS1 * SOF2 - TS2 * SOF1) / (SOF2 - SOF1) (2) | 562 | * TS = ((TS2 - TS1) * PTS + TS1 * SOF2 - TS2 * SOF1) / (SOF2 - SOF1) (2) |
diff --git a/drivers/media/v4l2-core/v4l2-ctrls.c b/drivers/media/v4l2-core/v4l2-ctrls.c index 60dcc0f3b32e..fb46790d0eca 100644 --- a/drivers/media/v4l2-core/v4l2-ctrls.c +++ b/drivers/media/v4l2-core/v4l2-ctrls.c | |||
| @@ -420,7 +420,7 @@ const char * const *v4l2_ctrl_get_menu(u32 id) | |||
| 420 | "Advanced Simple", | 420 | "Advanced Simple", |
| 421 | "Core", | 421 | "Core", |
| 422 | "Simple Scalable", | 422 | "Simple Scalable", |
| 423 | "Advanced Coding Efficency", | 423 | "Advanced Coding Efficiency", |
| 424 | NULL, | 424 | NULL, |
| 425 | }; | 425 | }; |
| 426 | 426 | ||
diff --git a/drivers/media/v4l2-core/videobuf2-core.c b/drivers/media/v4l2-core/videobuf2-core.c index b19b306c8f7f..0edc165f418d 100644 --- a/drivers/media/v4l2-core/videobuf2-core.c +++ b/drivers/media/v4l2-core/videobuf2-core.c | |||
| @@ -145,6 +145,25 @@ static void __vb2_buf_dmabuf_put(struct vb2_buffer *vb) | |||
| 145 | } | 145 | } |
| 146 | 146 | ||
| 147 | /** | 147 | /** |
| 148 | * __setup_lengths() - setup initial lengths for every plane in | ||
| 149 | * every buffer on the queue | ||
| 150 | */ | ||
| 151 | static void __setup_lengths(struct vb2_queue *q, unsigned int n) | ||
| 152 | { | ||
| 153 | unsigned int buffer, plane; | ||
| 154 | struct vb2_buffer *vb; | ||
| 155 | |||
| 156 | for (buffer = q->num_buffers; buffer < q->num_buffers + n; ++buffer) { | ||
| 157 | vb = q->bufs[buffer]; | ||
| 158 | if (!vb) | ||
| 159 | continue; | ||
| 160 | |||
| 161 | for (plane = 0; plane < vb->num_planes; ++plane) | ||
| 162 | vb->v4l2_planes[plane].length = q->plane_sizes[plane]; | ||
| 163 | } | ||
| 164 | } | ||
| 165 | |||
| 166 | /** | ||
| 148 | * __setup_offsets() - setup unique offsets ("cookies") for every plane in | 167 | * __setup_offsets() - setup unique offsets ("cookies") for every plane in |
| 149 | * every buffer on the queue | 168 | * every buffer on the queue |
| 150 | */ | 169 | */ |
| @@ -169,7 +188,6 @@ static void __setup_offsets(struct vb2_queue *q, unsigned int n) | |||
| 169 | continue; | 188 | continue; |
| 170 | 189 | ||
| 171 | for (plane = 0; plane < vb->num_planes; ++plane) { | 190 | for (plane = 0; plane < vb->num_planes; ++plane) { |
| 172 | vb->v4l2_planes[plane].length = q->plane_sizes[plane]; | ||
| 173 | vb->v4l2_planes[plane].m.mem_offset = off; | 191 | vb->v4l2_planes[plane].m.mem_offset = off; |
| 174 | 192 | ||
| 175 | dprintk(3, "Buffer %d, plane %d offset 0x%08lx\n", | 193 | dprintk(3, "Buffer %d, plane %d offset 0x%08lx\n", |
| @@ -241,6 +259,7 @@ static int __vb2_queue_alloc(struct vb2_queue *q, enum v4l2_memory memory, | |||
| 241 | q->bufs[q->num_buffers + buffer] = vb; | 259 | q->bufs[q->num_buffers + buffer] = vb; |
| 242 | } | 260 | } |
| 243 | 261 | ||
| 262 | __setup_lengths(q, buffer); | ||
| 244 | if (memory == V4L2_MEMORY_MMAP) | 263 | if (memory == V4L2_MEMORY_MMAP) |
| 245 | __setup_offsets(q, buffer); | 264 | __setup_offsets(q, buffer); |
| 246 | 265 | ||
| @@ -1824,8 +1843,8 @@ int vb2_expbuf(struct vb2_queue *q, struct v4l2_exportbuffer *eb) | |||
| 1824 | return -EINVAL; | 1843 | return -EINVAL; |
| 1825 | } | 1844 | } |
| 1826 | 1845 | ||
| 1827 | if (eb->flags & ~O_CLOEXEC) { | 1846 | if (eb->flags & ~(O_CLOEXEC | O_ACCMODE)) { |
| 1828 | dprintk(1, "Queue does support only O_CLOEXEC flag\n"); | 1847 | dprintk(1, "Queue does support only O_CLOEXEC and access mode flags\n"); |
| 1829 | return -EINVAL; | 1848 | return -EINVAL; |
| 1830 | } | 1849 | } |
| 1831 | 1850 | ||
| @@ -1848,14 +1867,14 @@ int vb2_expbuf(struct vb2_queue *q, struct v4l2_exportbuffer *eb) | |||
| 1848 | 1867 | ||
| 1849 | vb_plane = &vb->planes[eb->plane]; | 1868 | vb_plane = &vb->planes[eb->plane]; |
| 1850 | 1869 | ||
| 1851 | dbuf = call_memop(q, get_dmabuf, vb_plane->mem_priv); | 1870 | dbuf = call_memop(q, get_dmabuf, vb_plane->mem_priv, eb->flags & O_ACCMODE); |
| 1852 | if (IS_ERR_OR_NULL(dbuf)) { | 1871 | if (IS_ERR_OR_NULL(dbuf)) { |
| 1853 | dprintk(1, "Failed to export buffer %d, plane %d\n", | 1872 | dprintk(1, "Failed to export buffer %d, plane %d\n", |
| 1854 | eb->index, eb->plane); | 1873 | eb->index, eb->plane); |
| 1855 | return -EINVAL; | 1874 | return -EINVAL; |
| 1856 | } | 1875 | } |
| 1857 | 1876 | ||
| 1858 | ret = dma_buf_fd(dbuf, eb->flags); | 1877 | ret = dma_buf_fd(dbuf, eb->flags & ~O_ACCMODE); |
| 1859 | if (ret < 0) { | 1878 | if (ret < 0) { |
| 1860 | dprintk(3, "buffer %d, plane %d failed to export (%d)\n", | 1879 | dprintk(3, "buffer %d, plane %d failed to export (%d)\n", |
| 1861 | eb->index, eb->plane, ret); | 1880 | eb->index, eb->plane, ret); |
diff --git a/drivers/media/v4l2-core/videobuf2-dma-contig.c b/drivers/media/v4l2-core/videobuf2-dma-contig.c index 646f08f4f504..33d3871d1e13 100644 --- a/drivers/media/v4l2-core/videobuf2-dma-contig.c +++ b/drivers/media/v4l2-core/videobuf2-dma-contig.c | |||
| @@ -393,7 +393,7 @@ static struct sg_table *vb2_dc_get_base_sgt(struct vb2_dc_buf *buf) | |||
| 393 | return sgt; | 393 | return sgt; |
| 394 | } | 394 | } |
| 395 | 395 | ||
| 396 | static struct dma_buf *vb2_dc_get_dmabuf(void *buf_priv) | 396 | static struct dma_buf *vb2_dc_get_dmabuf(void *buf_priv, unsigned long flags) |
| 397 | { | 397 | { |
| 398 | struct vb2_dc_buf *buf = buf_priv; | 398 | struct vb2_dc_buf *buf = buf_priv; |
| 399 | struct dma_buf *dbuf; | 399 | struct dma_buf *dbuf; |
| @@ -404,7 +404,7 @@ static struct dma_buf *vb2_dc_get_dmabuf(void *buf_priv) | |||
| 404 | if (WARN_ON(!buf->sgt_base)) | 404 | if (WARN_ON(!buf->sgt_base)) |
| 405 | return NULL; | 405 | return NULL; |
| 406 | 406 | ||
| 407 | dbuf = dma_buf_export(buf, &vb2_dc_dmabuf_ops, buf->size, 0); | 407 | dbuf = dma_buf_export(buf, &vb2_dc_dmabuf_ops, buf->size, flags); |
| 408 | if (IS_ERR(dbuf)) | 408 | if (IS_ERR(dbuf)) |
| 409 | return NULL; | 409 | return NULL; |
| 410 | 410 | ||
diff --git a/drivers/media/v4l2-core/videobuf2-dma-sg.c b/drivers/media/v4l2-core/videobuf2-dma-sg.c index 2f860543912c..0d3a8ffe47a3 100644 --- a/drivers/media/v4l2-core/videobuf2-dma-sg.c +++ b/drivers/media/v4l2-core/videobuf2-dma-sg.c | |||
| @@ -178,7 +178,7 @@ static void *vb2_dma_sg_get_userptr(void *alloc_ctx, unsigned long vaddr, | |||
| 178 | buf->pages = kzalloc(buf->num_pages * sizeof(struct page *), | 178 | buf->pages = kzalloc(buf->num_pages * sizeof(struct page *), |
| 179 | GFP_KERNEL); | 179 | GFP_KERNEL); |
| 180 | if (!buf->pages) | 180 | if (!buf->pages) |
| 181 | return NULL; | 181 | goto userptr_fail_alloc_pages; |
| 182 | 182 | ||
| 183 | num_pages_from_user = get_user_pages(current, current->mm, | 183 | num_pages_from_user = get_user_pages(current, current->mm, |
| 184 | vaddr & PAGE_MASK, | 184 | vaddr & PAGE_MASK, |
| @@ -204,6 +204,7 @@ userptr_fail_get_user_pages: | |||
| 204 | while (--num_pages_from_user >= 0) | 204 | while (--num_pages_from_user >= 0) |
| 205 | put_page(buf->pages[num_pages_from_user]); | 205 | put_page(buf->pages[num_pages_from_user]); |
| 206 | kfree(buf->pages); | 206 | kfree(buf->pages); |
| 207 | userptr_fail_alloc_pages: | ||
| 207 | kfree(buf); | 208 | kfree(buf); |
| 208 | return NULL; | 209 | return NULL; |
| 209 | } | 210 | } |
diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig index 62a60caa5d1f..dd671582c9a1 100644 --- a/drivers/mfd/Kconfig +++ b/drivers/mfd/Kconfig | |||
| @@ -32,7 +32,7 @@ config MFD_AS3722 | |||
| 32 | select MFD_CORE | 32 | select MFD_CORE |
| 33 | select REGMAP_I2C | 33 | select REGMAP_I2C |
| 34 | select REGMAP_IRQ | 34 | select REGMAP_IRQ |
| 35 | depends on I2C && OF | 35 | depends on I2C=y && OF |
| 36 | help | 36 | help |
| 37 | The ams AS3722 is a compact system PMU suitable for mobile phones, | 37 | The ams AS3722 is a compact system PMU suitable for mobile phones, |
| 38 | tablets etc. It has 4 DC/DC step-down regulators, 3 DC/DC step-down | 38 | tablets etc. It has 4 DC/DC step-down regulators, 3 DC/DC step-down |
diff --git a/drivers/mfd/lpc_ich.c b/drivers/mfd/lpc_ich.c index da1c6566d93d..37edf9e989b0 100644 --- a/drivers/mfd/lpc_ich.c +++ b/drivers/mfd/lpc_ich.c | |||
| @@ -506,7 +506,7 @@ static struct lpc_ich_info lpc_chipset_info[] = { | |||
| 506 | .iTCO_version = 2, | 506 | .iTCO_version = 2, |
| 507 | }, | 507 | }, |
| 508 | [LPC_WPT_LP] = { | 508 | [LPC_WPT_LP] = { |
| 509 | .name = "Lynx Point_LP", | 509 | .name = "Wildcat Point_LP", |
| 510 | .iTCO_version = 2, | 510 | .iTCO_version = 2, |
| 511 | }, | 511 | }, |
| 512 | }; | 512 | }; |
diff --git a/drivers/mfd/sec-core.c b/drivers/mfd/sec-core.c index 34c18fb8c089..54cc25546592 100644 --- a/drivers/mfd/sec-core.c +++ b/drivers/mfd/sec-core.c | |||
| @@ -81,31 +81,31 @@ static struct of_device_id sec_dt_match[] = { | |||
| 81 | 81 | ||
| 82 | int sec_reg_read(struct sec_pmic_dev *sec_pmic, u8 reg, void *dest) | 82 | int sec_reg_read(struct sec_pmic_dev *sec_pmic, u8 reg, void *dest) |
| 83 | { | 83 | { |
| 84 | return regmap_read(sec_pmic->regmap, reg, dest); | 84 | return regmap_read(sec_pmic->regmap_pmic, reg, dest); |
| 85 | } | 85 | } |
| 86 | EXPORT_SYMBOL_GPL(sec_reg_read); | 86 | EXPORT_SYMBOL_GPL(sec_reg_read); |
| 87 | 87 | ||
| 88 | int sec_bulk_read(struct sec_pmic_dev *sec_pmic, u8 reg, int count, u8 *buf) | 88 | int sec_bulk_read(struct sec_pmic_dev *sec_pmic, u8 reg, int count, u8 *buf) |
| 89 | { | 89 | { |
| 90 | return regmap_bulk_read(sec_pmic->regmap, reg, buf, count); | 90 | return regmap_bulk_read(sec_pmic->regmap_pmic, reg, buf, count); |
| 91 | } | 91 | } |
| 92 | EXPORT_SYMBOL_GPL(sec_bulk_read); | 92 | EXPORT_SYMBOL_GPL(sec_bulk_read); |
| 93 | 93 | ||
| 94 | int sec_reg_write(struct sec_pmic_dev *sec_pmic, u8 reg, u8 value) | 94 | int sec_reg_write(struct sec_pmic_dev *sec_pmic, u8 reg, u8 value) |
| 95 | { | 95 | { |
| 96 | return regmap_write(sec_pmic->regmap, reg, value); | 96 | return regmap_write(sec_pmic->regmap_pmic, reg, value); |
| 97 | } | 97 | } |
| 98 | EXPORT_SYMBOL_GPL(sec_reg_write); | 98 | EXPORT_SYMBOL_GPL(sec_reg_write); |
| 99 | 99 | ||
| 100 | int sec_bulk_write(struct sec_pmic_dev *sec_pmic, u8 reg, int count, u8 *buf) | 100 | int sec_bulk_write(struct sec_pmic_dev *sec_pmic, u8 reg, int count, u8 *buf) |
| 101 | { | 101 | { |
| 102 | return regmap_raw_write(sec_pmic->regmap, reg, buf, count); | 102 | return regmap_raw_write(sec_pmic->regmap_pmic, reg, buf, count); |
| 103 | } | 103 | } |
| 104 | EXPORT_SYMBOL_GPL(sec_bulk_write); | 104 | EXPORT_SYMBOL_GPL(sec_bulk_write); |
| 105 | 105 | ||
| 106 | int sec_reg_update(struct sec_pmic_dev *sec_pmic, u8 reg, u8 val, u8 mask) | 106 | int sec_reg_update(struct sec_pmic_dev *sec_pmic, u8 reg, u8 val, u8 mask) |
| 107 | { | 107 | { |
| 108 | return regmap_update_bits(sec_pmic->regmap, reg, mask, val); | 108 | return regmap_update_bits(sec_pmic->regmap_pmic, reg, mask, val); |
| 109 | } | 109 | } |
| 110 | EXPORT_SYMBOL_GPL(sec_reg_update); | 110 | EXPORT_SYMBOL_GPL(sec_reg_update); |
| 111 | 111 | ||
| @@ -166,6 +166,11 @@ static struct regmap_config s5m8767_regmap_config = { | |||
| 166 | .cache_type = REGCACHE_FLAT, | 166 | .cache_type = REGCACHE_FLAT, |
| 167 | }; | 167 | }; |
| 168 | 168 | ||
| 169 | static const struct regmap_config sec_rtc_regmap_config = { | ||
| 170 | .reg_bits = 8, | ||
| 171 | .val_bits = 8, | ||
| 172 | }; | ||
| 173 | |||
| 169 | #ifdef CONFIG_OF | 174 | #ifdef CONFIG_OF |
| 170 | /* | 175 | /* |
| 171 | * Only the common platform data elements for s5m8767 are parsed here from the | 176 | * Only the common platform data elements for s5m8767 are parsed here from the |
| @@ -266,9 +271,9 @@ static int sec_pmic_probe(struct i2c_client *i2c, | |||
| 266 | break; | 271 | break; |
| 267 | } | 272 | } |
| 268 | 273 | ||
| 269 | sec_pmic->regmap = devm_regmap_init_i2c(i2c, regmap); | 274 | sec_pmic->regmap_pmic = devm_regmap_init_i2c(i2c, regmap); |
| 270 | if (IS_ERR(sec_pmic->regmap)) { | 275 | if (IS_ERR(sec_pmic->regmap_pmic)) { |
| 271 | ret = PTR_ERR(sec_pmic->regmap); | 276 | ret = PTR_ERR(sec_pmic->regmap_pmic); |
| 272 | dev_err(&i2c->dev, "Failed to allocate register map: %d\n", | 277 | dev_err(&i2c->dev, "Failed to allocate register map: %d\n", |
| 273 | ret); | 278 | ret); |
| 274 | return ret; | 279 | return ret; |
| @@ -277,6 +282,15 @@ static int sec_pmic_probe(struct i2c_client *i2c, | |||
| 277 | sec_pmic->rtc = i2c_new_dummy(i2c->adapter, RTC_I2C_ADDR); | 282 | sec_pmic->rtc = i2c_new_dummy(i2c->adapter, RTC_I2C_ADDR); |
| 278 | i2c_set_clientdata(sec_pmic->rtc, sec_pmic); | 283 | i2c_set_clientdata(sec_pmic->rtc, sec_pmic); |
| 279 | 284 | ||
| 285 | sec_pmic->regmap_rtc = devm_regmap_init_i2c(sec_pmic->rtc, | ||
| 286 | &sec_rtc_regmap_config); | ||
| 287 | if (IS_ERR(sec_pmic->regmap_rtc)) { | ||
| 288 | ret = PTR_ERR(sec_pmic->regmap_rtc); | ||
| 289 | dev_err(&i2c->dev, "Failed to allocate RTC register map: %d\n", | ||
| 290 | ret); | ||
| 291 | return ret; | ||
| 292 | } | ||
| 293 | |||
| 280 | if (pdata && pdata->cfg_pmic_irq) | 294 | if (pdata && pdata->cfg_pmic_irq) |
| 281 | pdata->cfg_pmic_irq(); | 295 | pdata->cfg_pmic_irq(); |
| 282 | 296 | ||
diff --git a/drivers/mfd/sec-irq.c b/drivers/mfd/sec-irq.c index 0dd84e99081e..b441b1be27cb 100644 --- a/drivers/mfd/sec-irq.c +++ b/drivers/mfd/sec-irq.c | |||
| @@ -280,19 +280,19 @@ int sec_irq_init(struct sec_pmic_dev *sec_pmic) | |||
| 280 | 280 | ||
| 281 | switch (type) { | 281 | switch (type) { |
| 282 | case S5M8763X: | 282 | case S5M8763X: |
| 283 | ret = regmap_add_irq_chip(sec_pmic->regmap, sec_pmic->irq, | 283 | ret = regmap_add_irq_chip(sec_pmic->regmap_pmic, sec_pmic->irq, |
| 284 | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, | 284 | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, |
| 285 | sec_pmic->irq_base, &s5m8763_irq_chip, | 285 | sec_pmic->irq_base, &s5m8763_irq_chip, |
| 286 | &sec_pmic->irq_data); | 286 | &sec_pmic->irq_data); |
| 287 | break; | 287 | break; |
| 288 | case S5M8767X: | 288 | case S5M8767X: |
| 289 | ret = regmap_add_irq_chip(sec_pmic->regmap, sec_pmic->irq, | 289 | ret = regmap_add_irq_chip(sec_pmic->regmap_pmic, sec_pmic->irq, |
| 290 | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, | 290 | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, |
| 291 | sec_pmic->irq_base, &s5m8767_irq_chip, | 291 | sec_pmic->irq_base, &s5m8767_irq_chip, |
| 292 | &sec_pmic->irq_data); | 292 | &sec_pmic->irq_data); |
| 293 | break; | 293 | break; |
| 294 | case S2MPS11X: | 294 | case S2MPS11X: |
| 295 | ret = regmap_add_irq_chip(sec_pmic->regmap, sec_pmic->irq, | 295 | ret = regmap_add_irq_chip(sec_pmic->regmap_pmic, sec_pmic->irq, |
| 296 | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, | 296 | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, |
| 297 | sec_pmic->irq_base, &s2mps11_irq_chip, | 297 | sec_pmic->irq_base, &s2mps11_irq_chip, |
| 298 | &sec_pmic->irq_data); | 298 | &sec_pmic->irq_data); |
diff --git a/drivers/mfd/ti-ssp.c b/drivers/mfd/ti-ssp.c index 71e3e0c5bf73..a5424579679c 100644 --- a/drivers/mfd/ti-ssp.c +++ b/drivers/mfd/ti-ssp.c | |||
| @@ -32,6 +32,7 @@ | |||
| 32 | #include <linux/platform_device.h> | 32 | #include <linux/platform_device.h> |
| 33 | #include <linux/delay.h> | 33 | #include <linux/delay.h> |
| 34 | #include <linux/io.h> | 34 | #include <linux/io.h> |
| 35 | #include <linux/sched.h> | ||
| 35 | #include <linux/mfd/core.h> | 36 | #include <linux/mfd/core.h> |
| 36 | #include <linux/mfd/ti_ssp.h> | 37 | #include <linux/mfd/ti_ssp.h> |
| 37 | 38 | ||
| @@ -409,7 +410,6 @@ static int ti_ssp_probe(struct platform_device *pdev) | |||
| 409 | cells[id].id = id; | 410 | cells[id].id = id; |
| 410 | cells[id].name = data->dev_name; | 411 | cells[id].name = data->dev_name; |
| 411 | cells[id].platform_data = data->pdata; | 412 | cells[id].platform_data = data->pdata; |
| 412 | cells[id].data_size = data->pdata_size; | ||
| 413 | } | 413 | } |
| 414 | 414 | ||
| 415 | error = mfd_add_devices(dev, 0, cells, 2, NULL, 0, NULL); | 415 | error = mfd_add_devices(dev, 0, cells, 2, NULL, 0, NULL); |
diff --git a/drivers/misc/enclosure.c b/drivers/misc/enclosure.c index 0e8df41aaf14..2cf2bbc0b927 100644 --- a/drivers/misc/enclosure.c +++ b/drivers/misc/enclosure.c | |||
| @@ -198,6 +198,13 @@ static void enclosure_remove_links(struct enclosure_component *cdev) | |||
| 198 | { | 198 | { |
| 199 | char name[ENCLOSURE_NAME_SIZE]; | 199 | char name[ENCLOSURE_NAME_SIZE]; |
| 200 | 200 | ||
| 201 | /* | ||
| 202 | * In odd circumstances, like multipath devices, something else may | ||
| 203 | * already have removed the links, so check for this condition first. | ||
| 204 | */ | ||
| 205 | if (!cdev->dev->kobj.sd) | ||
| 206 | return; | ||
| 207 | |||
| 201 | enclosure_link_name(cdev, name); | 208 | enclosure_link_name(cdev, name); |
| 202 | sysfs_remove_link(&cdev->dev->kobj, name); | 209 | sysfs_remove_link(&cdev->dev->kobj, name); |
| 203 | sysfs_remove_link(&cdev->cdev.kobj, "device"); | 210 | sysfs_remove_link(&cdev->cdev.kobj, "device"); |
diff --git a/drivers/misc/mei/hw-me-regs.h b/drivers/misc/mei/hw-me-regs.h index 6c0fde55270d..66f411a6e8ea 100644 --- a/drivers/misc/mei/hw-me-regs.h +++ b/drivers/misc/mei/hw-me-regs.h | |||
| @@ -109,9 +109,12 @@ | |||
| 109 | #define MEI_DEV_ID_PPT_2 0x1CBA /* Panther Point */ | 109 | #define MEI_DEV_ID_PPT_2 0x1CBA /* Panther Point */ |
| 110 | #define MEI_DEV_ID_PPT_3 0x1DBA /* Panther Point */ | 110 | #define MEI_DEV_ID_PPT_3 0x1DBA /* Panther Point */ |
| 111 | 111 | ||
| 112 | #define MEI_DEV_ID_LPT 0x8C3A /* Lynx Point */ | 112 | #define MEI_DEV_ID_LPT_H 0x8C3A /* Lynx Point H */ |
| 113 | #define MEI_DEV_ID_LPT_W 0x8D3A /* Lynx Point - Wellsburg */ | 113 | #define MEI_DEV_ID_LPT_W 0x8D3A /* Lynx Point - Wellsburg */ |
| 114 | #define MEI_DEV_ID_LPT_LP 0x9C3A /* Lynx Point LP */ | 114 | #define MEI_DEV_ID_LPT_LP 0x9C3A /* Lynx Point LP */ |
| 115 | #define MEI_DEV_ID_LPT_HR 0x8CBA /* Lynx Point H Refresh */ | ||
| 116 | |||
| 117 | #define MEI_DEV_ID_WPT_LP 0x9CBA /* Wildcat Point LP */ | ||
| 115 | /* | 118 | /* |
| 116 | * MEI HW Section | 119 | * MEI HW Section |
| 117 | */ | 120 | */ |
diff --git a/drivers/misc/mei/pci-me.c b/drivers/misc/mei/pci-me.c index 3bfae3843d95..7dfaa328e519 100644 --- a/drivers/misc/mei/pci-me.c +++ b/drivers/misc/mei/pci-me.c | |||
| @@ -76,9 +76,11 @@ static DEFINE_PCI_DEVICE_TABLE(mei_me_pci_tbl) = { | |||
| 76 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_PPT_1)}, | 76 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_PPT_1)}, |
| 77 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_PPT_2)}, | 77 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_PPT_2)}, |
| 78 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_PPT_3)}, | 78 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_PPT_3)}, |
| 79 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_LPT)}, | 79 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_LPT_H)}, |
| 80 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_LPT_W)}, | 80 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_LPT_W)}, |
| 81 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_LPT_LP)}, | 81 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_LPT_LP)}, |
| 82 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_LPT_HR)}, | ||
| 83 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, MEI_DEV_ID_WPT_LP)}, | ||
| 82 | 84 | ||
| 83 | /* required last entry */ | 85 | /* required last entry */ |
| 84 | {0, } | 86 | {0, } |
diff --git a/drivers/misc/mic/card/mic_virtio.c b/drivers/misc/mic/card/mic_virtio.c index 8aa42e738acc..653799b96bfa 100644 --- a/drivers/misc/mic/card/mic_virtio.c +++ b/drivers/misc/mic/card/mic_virtio.c | |||
| @@ -154,14 +154,14 @@ static void mic_reset_inform_host(struct virtio_device *vdev) | |||
| 154 | { | 154 | { |
| 155 | struct mic_vdev *mvdev = to_micvdev(vdev); | 155 | struct mic_vdev *mvdev = to_micvdev(vdev); |
| 156 | struct mic_device_ctrl __iomem *dc = mvdev->dc; | 156 | struct mic_device_ctrl __iomem *dc = mvdev->dc; |
| 157 | int retry = 100, i; | 157 | int retry; |
| 158 | 158 | ||
| 159 | iowrite8(0, &dc->host_ack); | 159 | iowrite8(0, &dc->host_ack); |
| 160 | iowrite8(1, &dc->vdev_reset); | 160 | iowrite8(1, &dc->vdev_reset); |
| 161 | mic_send_intr(mvdev->mdev, mvdev->c2h_vdev_db); | 161 | mic_send_intr(mvdev->mdev, mvdev->c2h_vdev_db); |
| 162 | 162 | ||
| 163 | /* Wait till host completes all card accesses and acks the reset */ | 163 | /* Wait till host completes all card accesses and acks the reset */ |
| 164 | for (i = retry; i--;) { | 164 | for (retry = 100; retry--;) { |
| 165 | if (ioread8(&dc->host_ack)) | 165 | if (ioread8(&dc->host_ack)) |
| 166 | break; | 166 | break; |
| 167 | msleep(100); | 167 | msleep(100); |
| @@ -187,11 +187,12 @@ static void mic_reset(struct virtio_device *vdev) | |||
| 187 | /* | 187 | /* |
| 188 | * The virtio_ring code calls this API when it wants to notify the Host. | 188 | * The virtio_ring code calls this API when it wants to notify the Host. |
| 189 | */ | 189 | */ |
| 190 | static void mic_notify(struct virtqueue *vq) | 190 | static bool mic_notify(struct virtqueue *vq) |
| 191 | { | 191 | { |
| 192 | struct mic_vdev *mvdev = vq->priv; | 192 | struct mic_vdev *mvdev = vq->priv; |
| 193 | 193 | ||
| 194 | mic_send_intr(mvdev->mdev, mvdev->c2h_vdev_db); | 194 | mic_send_intr(mvdev->mdev, mvdev->c2h_vdev_db); |
| 195 | return true; | ||
| 195 | } | 196 | } |
| 196 | 197 | ||
| 197 | static void mic_del_vq(struct virtqueue *vq, int n) | 198 | static void mic_del_vq(struct virtqueue *vq, int n) |
| @@ -247,17 +248,17 @@ static struct virtqueue *mic_find_vq(struct virtio_device *vdev, | |||
| 247 | /* First assign the vring's allocated in host memory */ | 248 | /* First assign the vring's allocated in host memory */ |
| 248 | vqconfig = mic_vq_config(mvdev->desc) + index; | 249 | vqconfig = mic_vq_config(mvdev->desc) + index; |
| 249 | memcpy_fromio(&config, vqconfig, sizeof(config)); | 250 | memcpy_fromio(&config, vqconfig, sizeof(config)); |
| 250 | _vr_size = vring_size(config.num, MIC_VIRTIO_RING_ALIGN); | 251 | _vr_size = vring_size(le16_to_cpu(config.num), MIC_VIRTIO_RING_ALIGN); |
| 251 | vr_size = PAGE_ALIGN(_vr_size + sizeof(struct _mic_vring_info)); | 252 | vr_size = PAGE_ALIGN(_vr_size + sizeof(struct _mic_vring_info)); |
| 252 | va = mic_card_map(mvdev->mdev, config.address, vr_size); | 253 | va = mic_card_map(mvdev->mdev, le64_to_cpu(config.address), vr_size); |
| 253 | if (!va) | 254 | if (!va) |
| 254 | return ERR_PTR(-ENOMEM); | 255 | return ERR_PTR(-ENOMEM); |
| 255 | mvdev->vr[index] = va; | 256 | mvdev->vr[index] = va; |
| 256 | memset_io(va, 0x0, _vr_size); | 257 | memset_io(va, 0x0, _vr_size); |
| 257 | vq = vring_new_virtqueue(index, | 258 | vq = vring_new_virtqueue(index, le16_to_cpu(config.num), |
| 258 | config.num, MIC_VIRTIO_RING_ALIGN, vdev, | 259 | MIC_VIRTIO_RING_ALIGN, vdev, false, |
| 259 | false, | 260 | (void __force *)va, mic_notify, callback, |
| 260 | va, mic_notify, callback, name); | 261 | name); |
| 261 | if (!vq) { | 262 | if (!vq) { |
| 262 | err = -ENOMEM; | 263 | err = -ENOMEM; |
| 263 | goto unmap; | 264 | goto unmap; |
| @@ -272,7 +273,8 @@ static struct virtqueue *mic_find_vq(struct virtio_device *vdev, | |||
| 272 | 273 | ||
| 273 | /* Allocate and reassign used ring now */ | 274 | /* Allocate and reassign used ring now */ |
| 274 | mvdev->used_size[index] = PAGE_ALIGN(sizeof(__u16) * 3 + | 275 | mvdev->used_size[index] = PAGE_ALIGN(sizeof(__u16) * 3 + |
| 275 | sizeof(struct vring_used_elem) * config.num); | 276 | sizeof(struct vring_used_elem) * |
| 277 | le16_to_cpu(config.num)); | ||
| 276 | used = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, | 278 | used = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, |
| 277 | get_order(mvdev->used_size[index])); | 279 | get_order(mvdev->used_size[index])); |
| 278 | if (!used) { | 280 | if (!used) { |
| @@ -309,7 +311,7 @@ static int mic_find_vqs(struct virtio_device *vdev, unsigned nvqs, | |||
| 309 | { | 311 | { |
| 310 | struct mic_vdev *mvdev = to_micvdev(vdev); | 312 | struct mic_vdev *mvdev = to_micvdev(vdev); |
| 311 | struct mic_device_ctrl __iomem *dc = mvdev->dc; | 313 | struct mic_device_ctrl __iomem *dc = mvdev->dc; |
| 312 | int i, err, retry = 100; | 314 | int i, err, retry; |
| 313 | 315 | ||
| 314 | /* We must have this many virtqueues. */ | 316 | /* We must have this many virtqueues. */ |
| 315 | if (nvqs > ioread8(&mvdev->desc->num_vq)) | 317 | if (nvqs > ioread8(&mvdev->desc->num_vq)) |
| @@ -331,7 +333,7 @@ static int mic_find_vqs(struct virtio_device *vdev, unsigned nvqs, | |||
| 331 | * rings have been re-assigned. | 333 | * rings have been re-assigned. |
| 332 | */ | 334 | */ |
| 333 | mic_send_intr(mvdev->mdev, mvdev->c2h_vdev_db); | 335 | mic_send_intr(mvdev->mdev, mvdev->c2h_vdev_db); |
| 334 | for (i = retry; i--;) { | 336 | for (retry = 100; retry--;) { |
| 335 | if (!ioread8(&dc->used_address_updated)) | 337 | if (!ioread8(&dc->used_address_updated)) |
| 336 | break; | 338 | break; |
| 337 | msleep(100); | 339 | msleep(100); |
| @@ -519,8 +521,8 @@ static void mic_scan_devices(struct mic_driver *mdrv, bool remove) | |||
| 519 | struct device *dev; | 521 | struct device *dev; |
| 520 | int ret; | 522 | int ret; |
| 521 | 523 | ||
| 522 | for (i = mic_aligned_size(struct mic_bootparam); | 524 | for (i = sizeof(struct mic_bootparam); i < MIC_DP_SIZE; |
| 523 | i < MIC_DP_SIZE; i += mic_total_desc_size(d)) { | 525 | i += mic_total_desc_size(d)) { |
| 524 | d = mdrv->dp + i; | 526 | d = mdrv->dp + i; |
| 525 | dc = (void __iomem *)d + mic_aligned_desc_size(d); | 527 | dc = (void __iomem *)d + mic_aligned_desc_size(d); |
| 526 | /* | 528 | /* |
| @@ -539,7 +541,8 @@ static void mic_scan_devices(struct mic_driver *mdrv, bool remove) | |||
| 539 | continue; | 541 | continue; |
| 540 | 542 | ||
| 541 | /* device already exists */ | 543 | /* device already exists */ |
| 542 | dev = device_find_child(mdrv->dev, d, mic_match_desc); | 544 | dev = device_find_child(mdrv->dev, (void __force *)d, |
| 545 | mic_match_desc); | ||
| 543 | if (dev) { | 546 | if (dev) { |
| 544 | if (remove) | 547 | if (remove) |
| 545 | iowrite8(MIC_VIRTIO_PARAM_DEV_REMOVE, | 548 | iowrite8(MIC_VIRTIO_PARAM_DEV_REMOVE, |
diff --git a/drivers/misc/mic/card/mic_virtio.h b/drivers/misc/mic/card/mic_virtio.h index 2c5c22c93ba8..d0407ba53bb7 100644 --- a/drivers/misc/mic/card/mic_virtio.h +++ b/drivers/misc/mic/card/mic_virtio.h | |||
| @@ -42,8 +42,8 @@ | |||
| 42 | 42 | ||
| 43 | static inline unsigned mic_desc_size(struct mic_device_desc __iomem *desc) | 43 | static inline unsigned mic_desc_size(struct mic_device_desc __iomem *desc) |
| 44 | { | 44 | { |
| 45 | return mic_aligned_size(*desc) | 45 | return sizeof(*desc) |
| 46 | + ioread8(&desc->num_vq) * mic_aligned_size(struct mic_vqconfig) | 46 | + ioread8(&desc->num_vq) * sizeof(struct mic_vqconfig) |
| 47 | + ioread8(&desc->feature_len) * 2 | 47 | + ioread8(&desc->feature_len) * 2 |
| 48 | + ioread8(&desc->config_len); | 48 | + ioread8(&desc->config_len); |
| 49 | } | 49 | } |
| @@ -67,8 +67,7 @@ mic_vq_configspace(struct mic_device_desc __iomem *desc) | |||
| 67 | } | 67 | } |
| 68 | static inline unsigned mic_total_desc_size(struct mic_device_desc __iomem *desc) | 68 | static inline unsigned mic_total_desc_size(struct mic_device_desc __iomem *desc) |
| 69 | { | 69 | { |
| 70 | return mic_aligned_desc_size(desc) + | 70 | return mic_aligned_desc_size(desc) + sizeof(struct mic_device_ctrl); |
| 71 | mic_aligned_size(struct mic_device_ctrl); | ||
| 72 | } | 71 | } |
| 73 | 72 | ||
| 74 | int mic_devices_init(struct mic_driver *mdrv); | 73 | int mic_devices_init(struct mic_driver *mdrv); |
diff --git a/drivers/misc/mic/host/mic_boot.c b/drivers/misc/mic/host/mic_boot.c index 7558d9186438..b75c6b5cc20f 100644 --- a/drivers/misc/mic/host/mic_boot.c +++ b/drivers/misc/mic/host/mic_boot.c | |||
| @@ -62,7 +62,7 @@ void mic_bootparam_init(struct mic_device *mdev) | |||
| 62 | { | 62 | { |
| 63 | struct mic_bootparam *bootparam = mdev->dp; | 63 | struct mic_bootparam *bootparam = mdev->dp; |
| 64 | 64 | ||
| 65 | bootparam->magic = MIC_MAGIC; | 65 | bootparam->magic = cpu_to_le32(MIC_MAGIC); |
| 66 | bootparam->c2h_shutdown_db = mdev->shutdown_db; | 66 | bootparam->c2h_shutdown_db = mdev->shutdown_db; |
| 67 | bootparam->h2c_shutdown_db = -1; | 67 | bootparam->h2c_shutdown_db = -1; |
| 68 | bootparam->h2c_config_db = -1; | 68 | bootparam->h2c_config_db = -1; |
diff --git a/drivers/misc/mic/host/mic_virtio.c b/drivers/misc/mic/host/mic_virtio.c index 8d3c21cd1d9c..752ff873f891 100644 --- a/drivers/misc/mic/host/mic_virtio.c +++ b/drivers/misc/mic/host/mic_virtio.c | |||
| @@ -41,7 +41,7 @@ static int mic_virtio_copy_to_user(struct mic_vdev *mvdev, | |||
| 41 | * We are copying from IO below an should ideally use something | 41 | * We are copying from IO below an should ideally use something |
| 42 | * like copy_to_user_fromio(..) if it existed. | 42 | * like copy_to_user_fromio(..) if it existed. |
| 43 | */ | 43 | */ |
| 44 | if (copy_to_user(ubuf, dbuf, len)) { | 44 | if (copy_to_user(ubuf, (void __force *)dbuf, len)) { |
| 45 | err = -EFAULT; | 45 | err = -EFAULT; |
| 46 | dev_err(mic_dev(mvdev), "%s %d err %d\n", | 46 | dev_err(mic_dev(mvdev), "%s %d err %d\n", |
| 47 | __func__, __LINE__, err); | 47 | __func__, __LINE__, err); |
| @@ -66,7 +66,7 @@ static int mic_virtio_copy_from_user(struct mic_vdev *mvdev, | |||
| 66 | * We are copying to IO below and should ideally use something | 66 | * We are copying to IO below and should ideally use something |
| 67 | * like copy_from_user_toio(..) if it existed. | 67 | * like copy_from_user_toio(..) if it existed. |
| 68 | */ | 68 | */ |
| 69 | if (copy_from_user(dbuf, ubuf, len)) { | 69 | if (copy_from_user((void __force *)dbuf, ubuf, len)) { |
| 70 | err = -EFAULT; | 70 | err = -EFAULT; |
| 71 | dev_err(mic_dev(mvdev), "%s %d err %d\n", | 71 | dev_err(mic_dev(mvdev), "%s %d err %d\n", |
| 72 | __func__, __LINE__, err); | 72 | __func__, __LINE__, err); |
| @@ -293,7 +293,7 @@ static void mic_virtio_init_post(struct mic_vdev *mvdev) | |||
| 293 | continue; | 293 | continue; |
| 294 | } | 294 | } |
| 295 | mvdev->mvr[i].vrh.vring.used = | 295 | mvdev->mvr[i].vrh.vring.used = |
| 296 | mvdev->mdev->aper.va + | 296 | (void __force *)mvdev->mdev->aper.va + |
| 297 | le64_to_cpu(vqconfig[i].used_address); | 297 | le64_to_cpu(vqconfig[i].used_address); |
| 298 | } | 298 | } |
| 299 | 299 | ||
| @@ -378,7 +378,7 @@ int mic_virtio_config_change(struct mic_vdev *mvdev, | |||
| 378 | void __user *argp) | 378 | void __user *argp) |
| 379 | { | 379 | { |
| 380 | DECLARE_WAIT_QUEUE_HEAD_ONSTACK(wake); | 380 | DECLARE_WAIT_QUEUE_HEAD_ONSTACK(wake); |
| 381 | int ret = 0, retry = 100, i; | 381 | int ret = 0, retry, i; |
| 382 | struct mic_bootparam *bootparam = mvdev->mdev->dp; | 382 | struct mic_bootparam *bootparam = mvdev->mdev->dp; |
| 383 | s8 db = bootparam->h2c_config_db; | 383 | s8 db = bootparam->h2c_config_db; |
| 384 | 384 | ||
| @@ -401,7 +401,7 @@ int mic_virtio_config_change(struct mic_vdev *mvdev, | |||
| 401 | mvdev->dc->config_change = MIC_VIRTIO_PARAM_CONFIG_CHANGED; | 401 | mvdev->dc->config_change = MIC_VIRTIO_PARAM_CONFIG_CHANGED; |
| 402 | mvdev->mdev->ops->send_intr(mvdev->mdev, db); | 402 | mvdev->mdev->ops->send_intr(mvdev->mdev, db); |
| 403 | 403 | ||
| 404 | for (i = retry; i--;) { | 404 | for (retry = 100; retry--;) { |
| 405 | ret = wait_event_timeout(wake, | 405 | ret = wait_event_timeout(wake, |
| 406 | mvdev->dc->guest_ack, msecs_to_jiffies(100)); | 406 | mvdev->dc->guest_ack, msecs_to_jiffies(100)); |
| 407 | if (ret) | 407 | if (ret) |
| @@ -467,7 +467,7 @@ static int mic_copy_dp_entry(struct mic_vdev *mvdev, | |||
| 467 | } | 467 | } |
| 468 | 468 | ||
| 469 | /* Find the first free device page entry */ | 469 | /* Find the first free device page entry */ |
| 470 | for (i = mic_aligned_size(struct mic_bootparam); | 470 | for (i = sizeof(struct mic_bootparam); |
| 471 | i < MIC_DP_SIZE - mic_total_desc_size(dd_config); | 471 | i < MIC_DP_SIZE - mic_total_desc_size(dd_config); |
| 472 | i += mic_total_desc_size(devp)) { | 472 | i += mic_total_desc_size(devp)) { |
| 473 | devp = mdev->dp + i; | 473 | devp = mdev->dp + i; |
| @@ -525,6 +525,7 @@ int mic_virtio_add_device(struct mic_vdev *mvdev, | |||
| 525 | char irqname[10]; | 525 | char irqname[10]; |
| 526 | struct mic_bootparam *bootparam = mdev->dp; | 526 | struct mic_bootparam *bootparam = mdev->dp; |
| 527 | u16 num; | 527 | u16 num; |
| 528 | dma_addr_t vr_addr; | ||
| 528 | 529 | ||
| 529 | mutex_lock(&mdev->mic_mutex); | 530 | mutex_lock(&mdev->mic_mutex); |
| 530 | 531 | ||
| @@ -559,17 +560,16 @@ int mic_virtio_add_device(struct mic_vdev *mvdev, | |||
| 559 | } | 560 | } |
| 560 | vr->len = vr_size; | 561 | vr->len = vr_size; |
| 561 | vr->info = vr->va + vring_size(num, MIC_VIRTIO_RING_ALIGN); | 562 | vr->info = vr->va + vring_size(num, MIC_VIRTIO_RING_ALIGN); |
| 562 | vr->info->magic = MIC_MAGIC + mvdev->virtio_id + i; | 563 | vr->info->magic = cpu_to_le32(MIC_MAGIC + mvdev->virtio_id + i); |
| 563 | vqconfig[i].address = mic_map_single(mdev, | 564 | vr_addr = mic_map_single(mdev, vr->va, vr_size); |
| 564 | vr->va, vr_size); | 565 | if (mic_map_error(vr_addr)) { |
| 565 | if (mic_map_error(vqconfig[i].address)) { | ||
| 566 | free_pages((unsigned long)vr->va, get_order(vr_size)); | 566 | free_pages((unsigned long)vr->va, get_order(vr_size)); |
| 567 | ret = -ENOMEM; | 567 | ret = -ENOMEM; |
| 568 | dev_err(mic_dev(mvdev), "%s %d err %d\n", | 568 | dev_err(mic_dev(mvdev), "%s %d err %d\n", |
| 569 | __func__, __LINE__, ret); | 569 | __func__, __LINE__, ret); |
| 570 | goto err; | 570 | goto err; |
| 571 | } | 571 | } |
| 572 | vqconfig[i].address = cpu_to_le64(vqconfig[i].address); | 572 | vqconfig[i].address = cpu_to_le64(vr_addr); |
| 573 | 573 | ||
| 574 | vring_init(&vr->vr, num, vr->va, MIC_VIRTIO_RING_ALIGN); | 574 | vring_init(&vr->vr, num, vr->va, MIC_VIRTIO_RING_ALIGN); |
| 575 | ret = vringh_init_kern(&mvr->vrh, | 575 | ret = vringh_init_kern(&mvr->vrh, |
| @@ -639,7 +639,7 @@ void mic_virtio_del_device(struct mic_vdev *mvdev) | |||
| 639 | struct mic_vdev *tmp_mvdev; | 639 | struct mic_vdev *tmp_mvdev; |
| 640 | struct mic_device *mdev = mvdev->mdev; | 640 | struct mic_device *mdev = mvdev->mdev; |
| 641 | DECLARE_WAIT_QUEUE_HEAD_ONSTACK(wake); | 641 | DECLARE_WAIT_QUEUE_HEAD_ONSTACK(wake); |
| 642 | int i, ret, retry = 100; | 642 | int i, ret, retry; |
| 643 | struct mic_vqconfig *vqconfig; | 643 | struct mic_vqconfig *vqconfig; |
| 644 | struct mic_bootparam *bootparam = mdev->dp; | 644 | struct mic_bootparam *bootparam = mdev->dp; |
| 645 | s8 db; | 645 | s8 db; |
| @@ -652,16 +652,16 @@ void mic_virtio_del_device(struct mic_vdev *mvdev) | |||
| 652 | "Requesting hot remove id %d\n", mvdev->virtio_id); | 652 | "Requesting hot remove id %d\n", mvdev->virtio_id); |
| 653 | mvdev->dc->config_change = MIC_VIRTIO_PARAM_DEV_REMOVE; | 653 | mvdev->dc->config_change = MIC_VIRTIO_PARAM_DEV_REMOVE; |
| 654 | mdev->ops->send_intr(mdev, db); | 654 | mdev->ops->send_intr(mdev, db); |
| 655 | for (i = retry; i--;) { | 655 | for (retry = 100; retry--;) { |
| 656 | ret = wait_event_timeout(wake, | 656 | ret = wait_event_timeout(wake, |
| 657 | mvdev->dc->guest_ack, msecs_to_jiffies(100)); | 657 | mvdev->dc->guest_ack, msecs_to_jiffies(100)); |
| 658 | if (ret) | 658 | if (ret) |
| 659 | break; | 659 | break; |
| 660 | } | 660 | } |
| 661 | dev_dbg(mdev->sdev->parent, | 661 | dev_dbg(mdev->sdev->parent, |
| 662 | "Device id %d config_change %d guest_ack %d\n", | 662 | "Device id %d config_change %d guest_ack %d retry %d\n", |
| 663 | mvdev->virtio_id, mvdev->dc->config_change, | 663 | mvdev->virtio_id, mvdev->dc->config_change, |
| 664 | mvdev->dc->guest_ack); | 664 | mvdev->dc->guest_ack, retry); |
| 665 | mvdev->dc->config_change = 0; | 665 | mvdev->dc->config_change = 0; |
| 666 | mvdev->dc->guest_ack = 0; | 666 | mvdev->dc->guest_ack = 0; |
| 667 | skip_hot_remove: | 667 | skip_hot_remove: |
diff --git a/drivers/misc/mic/host/mic_x100.c b/drivers/misc/mic/host/mic_x100.c index 6fccb13493a5..5562fdd3ef4e 100644 --- a/drivers/misc/mic/host/mic_x100.c +++ b/drivers/misc/mic/host/mic_x100.c | |||
| @@ -400,8 +400,8 @@ mic_x100_load_ramdisk(struct mic_device *mdev) | |||
| 400 | * so copy over the ramdisk @ 128M. | 400 | * so copy over the ramdisk @ 128M. |
| 401 | */ | 401 | */ |
| 402 | memcpy_toio(mdev->aper.va + (mdev->bootaddr << 1), fw->data, fw->size); | 402 | memcpy_toio(mdev->aper.va + (mdev->bootaddr << 1), fw->data, fw->size); |
| 403 | iowrite32(cpu_to_le32(mdev->bootaddr << 1), &bp->hdr.ramdisk_image); | 403 | iowrite32(mdev->bootaddr << 1, &bp->hdr.ramdisk_image); |
| 404 | iowrite32(cpu_to_le32(fw->size), &bp->hdr.ramdisk_size); | 404 | iowrite32(fw->size, &bp->hdr.ramdisk_size); |
| 405 | release_firmware(fw); | 405 | release_firmware(fw); |
| 406 | error: | 406 | error: |
| 407 | return rc; | 407 | return rc; |
diff --git a/drivers/mmc/host/omap.c b/drivers/mmc/host/omap.c index 0b10a9030f4e..98b6b6ef7e5c 100644 --- a/drivers/mmc/host/omap.c +++ b/drivers/mmc/host/omap.c | |||
| @@ -22,6 +22,7 @@ | |||
| 22 | #include <linux/delay.h> | 22 | #include <linux/delay.h> |
| 23 | #include <linux/spinlock.h> | 23 | #include <linux/spinlock.h> |
| 24 | #include <linux/timer.h> | 24 | #include <linux/timer.h> |
| 25 | #include <linux/of.h> | ||
| 25 | #include <linux/omap-dma.h> | 26 | #include <linux/omap-dma.h> |
| 26 | #include <linux/mmc/host.h> | 27 | #include <linux/mmc/host.h> |
| 27 | #include <linux/mmc/card.h> | 28 | #include <linux/mmc/card.h> |
| @@ -90,17 +91,6 @@ | |||
| 90 | #define OMAP_MMC_CMDTYPE_AC 2 | 91 | #define OMAP_MMC_CMDTYPE_AC 2 |
| 91 | #define OMAP_MMC_CMDTYPE_ADTC 3 | 92 | #define OMAP_MMC_CMDTYPE_ADTC 3 |
| 92 | 93 | ||
| 93 | #define OMAP_DMA_MMC_TX 21 | ||
| 94 | #define OMAP_DMA_MMC_RX 22 | ||
| 95 | #define OMAP_DMA_MMC2_TX 54 | ||
| 96 | #define OMAP_DMA_MMC2_RX 55 | ||
| 97 | |||
| 98 | #define OMAP24XX_DMA_MMC2_TX 47 | ||
| 99 | #define OMAP24XX_DMA_MMC2_RX 48 | ||
| 100 | #define OMAP24XX_DMA_MMC1_TX 61 | ||
| 101 | #define OMAP24XX_DMA_MMC1_RX 62 | ||
| 102 | |||
| 103 | |||
| 104 | #define DRIVER_NAME "mmci-omap" | 94 | #define DRIVER_NAME "mmci-omap" |
| 105 | 95 | ||
| 106 | /* Specifies how often in millisecs to poll for card status changes | 96 | /* Specifies how often in millisecs to poll for card status changes |
| @@ -1330,7 +1320,7 @@ static int mmc_omap_probe(struct platform_device *pdev) | |||
| 1330 | struct mmc_omap_host *host = NULL; | 1320 | struct mmc_omap_host *host = NULL; |
| 1331 | struct resource *res; | 1321 | struct resource *res; |
| 1332 | dma_cap_mask_t mask; | 1322 | dma_cap_mask_t mask; |
| 1333 | unsigned sig; | 1323 | unsigned sig = 0; |
| 1334 | int i, ret = 0; | 1324 | int i, ret = 0; |
| 1335 | int irq; | 1325 | int irq; |
| 1336 | 1326 | ||
| @@ -1340,7 +1330,7 @@ static int mmc_omap_probe(struct platform_device *pdev) | |||
| 1340 | } | 1330 | } |
| 1341 | if (pdata->nr_slots == 0) { | 1331 | if (pdata->nr_slots == 0) { |
| 1342 | dev_err(&pdev->dev, "no slots\n"); | 1332 | dev_err(&pdev->dev, "no slots\n"); |
| 1343 | return -ENXIO; | 1333 | return -EPROBE_DEFER; |
| 1344 | } | 1334 | } |
| 1345 | 1335 | ||
| 1346 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 1336 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| @@ -1407,19 +1397,20 @@ static int mmc_omap_probe(struct platform_device *pdev) | |||
| 1407 | host->dma_tx_burst = -1; | 1397 | host->dma_tx_burst = -1; |
| 1408 | host->dma_rx_burst = -1; | 1398 | host->dma_rx_burst = -1; |
| 1409 | 1399 | ||
| 1410 | if (mmc_omap2()) | 1400 | res = platform_get_resource_byname(pdev, IORESOURCE_DMA, "tx"); |
| 1411 | sig = host->id == 0 ? OMAP24XX_DMA_MMC1_TX : OMAP24XX_DMA_MMC2_TX; | 1401 | if (res) |
| 1412 | else | 1402 | sig = res->start; |
| 1413 | sig = host->id == 0 ? OMAP_DMA_MMC_TX : OMAP_DMA_MMC2_TX; | 1403 | host->dma_tx = dma_request_slave_channel_compat(mask, |
| 1414 | host->dma_tx = dma_request_channel(mask, omap_dma_filter_fn, &sig); | 1404 | omap_dma_filter_fn, &sig, &pdev->dev, "tx"); |
| 1415 | if (!host->dma_tx) | 1405 | if (!host->dma_tx) |
| 1416 | dev_warn(host->dev, "unable to obtain TX DMA engine channel %u\n", | 1406 | dev_warn(host->dev, "unable to obtain TX DMA engine channel %u\n", |
| 1417 | sig); | 1407 | sig); |
| 1418 | if (mmc_omap2()) | 1408 | |
| 1419 | sig = host->id == 0 ? OMAP24XX_DMA_MMC1_RX : OMAP24XX_DMA_MMC2_RX; | 1409 | res = platform_get_resource_byname(pdev, IORESOURCE_DMA, "rx"); |
| 1420 | else | 1410 | if (res) |
| 1421 | sig = host->id == 0 ? OMAP_DMA_MMC_RX : OMAP_DMA_MMC2_RX; | 1411 | sig = res->start; |
| 1422 | host->dma_rx = dma_request_channel(mask, omap_dma_filter_fn, &sig); | 1412 | host->dma_rx = dma_request_slave_channel_compat(mask, |
| 1413 | omap_dma_filter_fn, &sig, &pdev->dev, "rx"); | ||
| 1423 | if (!host->dma_rx) | 1414 | if (!host->dma_rx) |
| 1424 | dev_warn(host->dev, "unable to obtain RX DMA engine channel %u\n", | 1415 | dev_warn(host->dev, "unable to obtain RX DMA engine channel %u\n", |
| 1425 | sig); | 1416 | sig); |
| @@ -1512,12 +1503,20 @@ static int mmc_omap_remove(struct platform_device *pdev) | |||
| 1512 | return 0; | 1503 | return 0; |
| 1513 | } | 1504 | } |
| 1514 | 1505 | ||
| 1506 | #if IS_BUILTIN(CONFIG_OF) | ||
| 1507 | static const struct of_device_id mmc_omap_match[] = { | ||
| 1508 | { .compatible = "ti,omap2420-mmc", }, | ||
| 1509 | { }, | ||
| 1510 | }; | ||
| 1511 | #endif | ||
| 1512 | |||
| 1515 | static struct platform_driver mmc_omap_driver = { | 1513 | static struct platform_driver mmc_omap_driver = { |
| 1516 | .probe = mmc_omap_probe, | 1514 | .probe = mmc_omap_probe, |
| 1517 | .remove = mmc_omap_remove, | 1515 | .remove = mmc_omap_remove, |
| 1518 | .driver = { | 1516 | .driver = { |
| 1519 | .name = DRIVER_NAME, | 1517 | .name = DRIVER_NAME, |
| 1520 | .owner = THIS_MODULE, | 1518 | .owner = THIS_MODULE, |
| 1519 | .of_match_table = of_match_ptr(mmc_omap_match), | ||
| 1521 | }, | 1520 | }, |
| 1522 | }; | 1521 | }; |
| 1523 | 1522 | ||
diff --git a/drivers/mtd/nand/pxa3xx_nand.c b/drivers/mtd/nand/pxa3xx_nand.c index 4cabdc9fda90..4b3aaa898a8b 100644 --- a/drivers/mtd/nand/pxa3xx_nand.c +++ b/drivers/mtd/nand/pxa3xx_nand.c | |||
| @@ -962,7 +962,7 @@ static int pxa3xx_nand_init_buff(struct pxa3xx_nand_info *info) | |||
| 962 | static void pxa3xx_nand_free_buff(struct pxa3xx_nand_info *info) | 962 | static void pxa3xx_nand_free_buff(struct pxa3xx_nand_info *info) |
| 963 | { | 963 | { |
| 964 | struct platform_device *pdev = info->pdev; | 964 | struct platform_device *pdev = info->pdev; |
| 965 | if (use_dma) { | 965 | if (info->use_dma) { |
| 966 | pxa_free_dma(info->data_dma_ch); | 966 | pxa_free_dma(info->data_dma_ch); |
| 967 | dma_free_coherent(&pdev->dev, info->buf_size, | 967 | dma_free_coherent(&pdev->dev, info->buf_size, |
| 968 | info->data_buff, info->data_buff_phys); | 968 | info->data_buff, info->data_buff_phys); |
| @@ -1259,10 +1259,6 @@ static struct of_device_id pxa3xx_nand_dt_ids[] = { | |||
| 1259 | .compatible = "marvell,pxa3xx-nand", | 1259 | .compatible = "marvell,pxa3xx-nand", |
| 1260 | .data = (void *)PXA3XX_NAND_VARIANT_PXA, | 1260 | .data = (void *)PXA3XX_NAND_VARIANT_PXA, |
| 1261 | }, | 1261 | }, |
| 1262 | { | ||
| 1263 | .compatible = "marvell,armada370-nand", | ||
| 1264 | .data = (void *)PXA3XX_NAND_VARIANT_ARMADA370, | ||
| 1265 | }, | ||
| 1266 | {} | 1262 | {} |
| 1267 | }; | 1263 | }; |
| 1268 | MODULE_DEVICE_TABLE(of, pxa3xx_nand_dt_ids); | 1264 | MODULE_DEVICE_TABLE(of, pxa3xx_nand_dt_ids); |
diff --git a/drivers/net/bonding/bond_main.c b/drivers/net/bonding/bond_main.c index 4dd5ee2a34cc..398e299ee1bd 100644 --- a/drivers/net/bonding/bond_main.c +++ b/drivers/net/bonding/bond_main.c | |||
| @@ -4110,7 +4110,7 @@ static int bond_check_params(struct bond_params *params) | |||
| 4110 | if (!miimon) { | 4110 | if (!miimon) { |
| 4111 | pr_warning("Warning: miimon must be specified, otherwise bonding will not detect link failure, speed and duplex which are essential for 802.3ad operation\n"); | 4111 | pr_warning("Warning: miimon must be specified, otherwise bonding will not detect link failure, speed and duplex which are essential for 802.3ad operation\n"); |
| 4112 | pr_warning("Forcing miimon to 100msec\n"); | 4112 | pr_warning("Forcing miimon to 100msec\n"); |
| 4113 | miimon = 100; | 4113 | miimon = BOND_DEFAULT_MIIMON; |
| 4114 | } | 4114 | } |
| 4115 | } | 4115 | } |
| 4116 | 4116 | ||
| @@ -4147,7 +4147,7 @@ static int bond_check_params(struct bond_params *params) | |||
| 4147 | if (!miimon) { | 4147 | if (!miimon) { |
| 4148 | pr_warning("Warning: miimon must be specified, otherwise bonding will not detect link failure and link speed which are essential for TLB/ALB load balancing\n"); | 4148 | pr_warning("Warning: miimon must be specified, otherwise bonding will not detect link failure and link speed which are essential for TLB/ALB load balancing\n"); |
| 4149 | pr_warning("Forcing miimon to 100msec\n"); | 4149 | pr_warning("Forcing miimon to 100msec\n"); |
| 4150 | miimon = 100; | 4150 | miimon = BOND_DEFAULT_MIIMON; |
| 4151 | } | 4151 | } |
| 4152 | } | 4152 | } |
| 4153 | 4153 | ||
| @@ -4199,9 +4199,9 @@ static int bond_check_params(struct bond_params *params) | |||
| 4199 | (arp_ip_count < BOND_MAX_ARP_TARGETS) && arp_ip_target[i]; i++) { | 4199 | (arp_ip_count < BOND_MAX_ARP_TARGETS) && arp_ip_target[i]; i++) { |
| 4200 | /* not complete check, but should be good enough to | 4200 | /* not complete check, but should be good enough to |
| 4201 | catch mistakes */ | 4201 | catch mistakes */ |
| 4202 | __be32 ip = in_aton(arp_ip_target[i]); | 4202 | __be32 ip; |
| 4203 | if (!isdigit(arp_ip_target[i][0]) || ip == 0 || | 4203 | if (!in4_pton(arp_ip_target[i], -1, (u8 *)&ip, -1, NULL) || |
| 4204 | ip == htonl(INADDR_BROADCAST)) { | 4204 | IS_IP_TARGET_UNUSABLE_ADDRESS(ip)) { |
| 4205 | pr_warning("Warning: bad arp_ip_target module parameter (%s), ARP monitoring will not be performed\n", | 4205 | pr_warning("Warning: bad arp_ip_target module parameter (%s), ARP monitoring will not be performed\n", |
| 4206 | arp_ip_target[i]); | 4206 | arp_ip_target[i]); |
| 4207 | arp_interval = 0; | 4207 | arp_interval = 0; |
diff --git a/drivers/net/bonding/bond_options.c b/drivers/net/bonding/bond_options.c index 9a5223c7b4d1..ea6f640782b7 100644 --- a/drivers/net/bonding/bond_options.c +++ b/drivers/net/bonding/bond_options.c | |||
| @@ -45,10 +45,15 @@ int bond_option_mode_set(struct bonding *bond, int mode) | |||
| 45 | return -EPERM; | 45 | return -EPERM; |
| 46 | } | 46 | } |
| 47 | 47 | ||
| 48 | if (BOND_MODE_IS_LB(mode) && bond->params.arp_interval) { | 48 | if (BOND_NO_USES_ARP(mode) && bond->params.arp_interval) { |
| 49 | pr_err("%s: %s mode is incompatible with arp monitoring.\n", | 49 | pr_info("%s: %s mode is incompatible with arp monitoring, start mii monitoring\n", |
| 50 | bond->dev->name, bond_mode_tbl[mode].modename); | 50 | bond->dev->name, bond_mode_tbl[mode].modename); |
| 51 | return -EINVAL; | 51 | /* disable arp monitoring */ |
| 52 | bond->params.arp_interval = 0; | ||
| 53 | /* set miimon to default value */ | ||
| 54 | bond->params.miimon = BOND_DEFAULT_MIIMON; | ||
| 55 | pr_info("%s: Setting MII monitoring interval to %d.\n", | ||
| 56 | bond->dev->name, bond->params.miimon); | ||
| 52 | } | 57 | } |
| 53 | 58 | ||
| 54 | /* don't cache arp_validate between modes */ | 59 | /* don't cache arp_validate between modes */ |
diff --git a/drivers/net/bonding/bond_sysfs.c b/drivers/net/bonding/bond_sysfs.c index 0ec2a7e8c8a9..0ae580bbc5db 100644 --- a/drivers/net/bonding/bond_sysfs.c +++ b/drivers/net/bonding/bond_sysfs.c | |||
| @@ -523,9 +523,7 @@ static ssize_t bonding_store_arp_interval(struct device *d, | |||
| 523 | ret = -EINVAL; | 523 | ret = -EINVAL; |
| 524 | goto out; | 524 | goto out; |
| 525 | } | 525 | } |
| 526 | if (bond->params.mode == BOND_MODE_ALB || | 526 | if (BOND_NO_USES_ARP(bond->params.mode)) { |
| 527 | bond->params.mode == BOND_MODE_TLB || | ||
| 528 | bond->params.mode == BOND_MODE_8023AD) { | ||
| 529 | pr_info("%s: ARP monitoring cannot be used with ALB/TLB/802.3ad. Only MII monitoring is supported on %s.\n", | 527 | pr_info("%s: ARP monitoring cannot be used with ALB/TLB/802.3ad. Only MII monitoring is supported on %s.\n", |
| 530 | bond->dev->name, bond->dev->name); | 528 | bond->dev->name, bond->dev->name); |
| 531 | ret = -EINVAL; | 529 | ret = -EINVAL; |
| @@ -1637,12 +1635,12 @@ static ssize_t bonding_show_packets_per_slave(struct device *d, | |||
| 1637 | char *buf) | 1635 | char *buf) |
| 1638 | { | 1636 | { |
| 1639 | struct bonding *bond = to_bond(d); | 1637 | struct bonding *bond = to_bond(d); |
| 1640 | int packets_per_slave = bond->params.packets_per_slave; | 1638 | unsigned int packets_per_slave = bond->params.packets_per_slave; |
| 1641 | 1639 | ||
| 1642 | if (packets_per_slave > 1) | 1640 | if (packets_per_slave > 1) |
| 1643 | packets_per_slave = reciprocal_value(packets_per_slave); | 1641 | packets_per_slave = reciprocal_value(packets_per_slave); |
| 1644 | 1642 | ||
| 1645 | return sprintf(buf, "%d\n", packets_per_slave); | 1643 | return sprintf(buf, "%u\n", packets_per_slave); |
| 1646 | } | 1644 | } |
| 1647 | 1645 | ||
| 1648 | static ssize_t bonding_store_packets_per_slave(struct device *d, | 1646 | static ssize_t bonding_store_packets_per_slave(struct device *d, |
diff --git a/drivers/net/bonding/bonding.h b/drivers/net/bonding/bonding.h index ca31286aa028..a9f4f9f4d8ce 100644 --- a/drivers/net/bonding/bonding.h +++ b/drivers/net/bonding/bonding.h | |||
| @@ -35,6 +35,8 @@ | |||
| 35 | 35 | ||
| 36 | #define BOND_MAX_ARP_TARGETS 16 | 36 | #define BOND_MAX_ARP_TARGETS 16 |
| 37 | 37 | ||
| 38 | #define BOND_DEFAULT_MIIMON 100 | ||
| 39 | |||
| 38 | #define IS_UP(dev) \ | 40 | #define IS_UP(dev) \ |
| 39 | ((((dev)->flags & IFF_UP) == IFF_UP) && \ | 41 | ((((dev)->flags & IFF_UP) == IFF_UP) && \ |
| 40 | netif_running(dev) && \ | 42 | netif_running(dev) && \ |
| @@ -55,6 +57,11 @@ | |||
| 55 | ((mode) == BOND_MODE_TLB) || \ | 57 | ((mode) == BOND_MODE_TLB) || \ |
| 56 | ((mode) == BOND_MODE_ALB)) | 58 | ((mode) == BOND_MODE_ALB)) |
| 57 | 59 | ||
| 60 | #define BOND_NO_USES_ARP(mode) \ | ||
| 61 | (((mode) == BOND_MODE_8023AD) || \ | ||
| 62 | ((mode) == BOND_MODE_TLB) || \ | ||
| 63 | ((mode) == BOND_MODE_ALB)) | ||
| 64 | |||
| 58 | #define TX_QUEUE_OVERRIDE(mode) \ | 65 | #define TX_QUEUE_OVERRIDE(mode) \ |
| 59 | (((mode) == BOND_MODE_ACTIVEBACKUP) || \ | 66 | (((mode) == BOND_MODE_ACTIVEBACKUP) || \ |
| 60 | ((mode) == BOND_MODE_ROUNDROBIN)) | 67 | ((mode) == BOND_MODE_ROUNDROBIN)) |
diff --git a/drivers/net/can/c_can/c_can.c b/drivers/net/can/c_can/c_can.c index e3fc07cf2f62..77061eebb034 100644 --- a/drivers/net/can/c_can/c_can.c +++ b/drivers/net/can/c_can/c_can.c | |||
| @@ -712,22 +712,31 @@ static int c_can_set_mode(struct net_device *dev, enum can_mode mode) | |||
| 712 | return 0; | 712 | return 0; |
| 713 | } | 713 | } |
| 714 | 714 | ||
| 715 | static int c_can_get_berr_counter(const struct net_device *dev, | 715 | static int __c_can_get_berr_counter(const struct net_device *dev, |
| 716 | struct can_berr_counter *bec) | 716 | struct can_berr_counter *bec) |
| 717 | { | 717 | { |
| 718 | unsigned int reg_err_counter; | 718 | unsigned int reg_err_counter; |
| 719 | struct c_can_priv *priv = netdev_priv(dev); | 719 | struct c_can_priv *priv = netdev_priv(dev); |
| 720 | 720 | ||
| 721 | c_can_pm_runtime_get_sync(priv); | ||
| 722 | |||
| 723 | reg_err_counter = priv->read_reg(priv, C_CAN_ERR_CNT_REG); | 721 | reg_err_counter = priv->read_reg(priv, C_CAN_ERR_CNT_REG); |
| 724 | bec->rxerr = (reg_err_counter & ERR_CNT_REC_MASK) >> | 722 | bec->rxerr = (reg_err_counter & ERR_CNT_REC_MASK) >> |
| 725 | ERR_CNT_REC_SHIFT; | 723 | ERR_CNT_REC_SHIFT; |
| 726 | bec->txerr = reg_err_counter & ERR_CNT_TEC_MASK; | 724 | bec->txerr = reg_err_counter & ERR_CNT_TEC_MASK; |
| 727 | 725 | ||
| 726 | return 0; | ||
| 727 | } | ||
| 728 | |||
| 729 | static int c_can_get_berr_counter(const struct net_device *dev, | ||
| 730 | struct can_berr_counter *bec) | ||
| 731 | { | ||
| 732 | struct c_can_priv *priv = netdev_priv(dev); | ||
| 733 | int err; | ||
| 734 | |||
| 735 | c_can_pm_runtime_get_sync(priv); | ||
| 736 | err = __c_can_get_berr_counter(dev, bec); | ||
| 728 | c_can_pm_runtime_put_sync(priv); | 737 | c_can_pm_runtime_put_sync(priv); |
| 729 | 738 | ||
| 730 | return 0; | 739 | return err; |
| 731 | } | 740 | } |
| 732 | 741 | ||
| 733 | /* | 742 | /* |
| @@ -754,6 +763,7 @@ static void c_can_do_tx(struct net_device *dev) | |||
| 754 | if (!(val & (1 << (msg_obj_no - 1)))) { | 763 | if (!(val & (1 << (msg_obj_no - 1)))) { |
| 755 | can_get_echo_skb(dev, | 764 | can_get_echo_skb(dev, |
| 756 | msg_obj_no - C_CAN_MSG_OBJ_TX_FIRST); | 765 | msg_obj_no - C_CAN_MSG_OBJ_TX_FIRST); |
| 766 | c_can_object_get(dev, 0, msg_obj_no, IF_COMM_ALL); | ||
| 757 | stats->tx_bytes += priv->read_reg(priv, | 767 | stats->tx_bytes += priv->read_reg(priv, |
| 758 | C_CAN_IFACE(MSGCTRL_REG, 0)) | 768 | C_CAN_IFACE(MSGCTRL_REG, 0)) |
| 759 | & IF_MCONT_DLC_MASK; | 769 | & IF_MCONT_DLC_MASK; |
| @@ -872,7 +882,7 @@ static int c_can_handle_state_change(struct net_device *dev, | |||
| 872 | if (unlikely(!skb)) | 882 | if (unlikely(!skb)) |
| 873 | return 0; | 883 | return 0; |
| 874 | 884 | ||
| 875 | c_can_get_berr_counter(dev, &bec); | 885 | __c_can_get_berr_counter(dev, &bec); |
| 876 | reg_err_counter = priv->read_reg(priv, C_CAN_ERR_CNT_REG); | 886 | reg_err_counter = priv->read_reg(priv, C_CAN_ERR_CNT_REG); |
| 877 | rx_err_passive = (reg_err_counter & ERR_CNT_RP_MASK) >> | 887 | rx_err_passive = (reg_err_counter & ERR_CNT_RP_MASK) >> |
| 878 | ERR_CNT_RP_SHIFT; | 888 | ERR_CNT_RP_SHIFT; |
diff --git a/drivers/net/can/flexcan.c b/drivers/net/can/flexcan.c index ae08cf129ebb..aaed97bee471 100644 --- a/drivers/net/can/flexcan.c +++ b/drivers/net/can/flexcan.c | |||
| @@ -1020,13 +1020,13 @@ static int flexcan_probe(struct platform_device *pdev) | |||
| 1020 | dev_err(&pdev->dev, "no ipg clock defined\n"); | 1020 | dev_err(&pdev->dev, "no ipg clock defined\n"); |
| 1021 | return PTR_ERR(clk_ipg); | 1021 | return PTR_ERR(clk_ipg); |
| 1022 | } | 1022 | } |
| 1023 | clock_freq = clk_get_rate(clk_ipg); | ||
| 1024 | 1023 | ||
| 1025 | clk_per = devm_clk_get(&pdev->dev, "per"); | 1024 | clk_per = devm_clk_get(&pdev->dev, "per"); |
| 1026 | if (IS_ERR(clk_per)) { | 1025 | if (IS_ERR(clk_per)) { |
| 1027 | dev_err(&pdev->dev, "no per clock defined\n"); | 1026 | dev_err(&pdev->dev, "no per clock defined\n"); |
| 1028 | return PTR_ERR(clk_per); | 1027 | return PTR_ERR(clk_per); |
| 1029 | } | 1028 | } |
| 1029 | clock_freq = clk_get_rate(clk_per); | ||
| 1030 | } | 1030 | } |
| 1031 | 1031 | ||
| 1032 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 1032 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
diff --git a/drivers/net/can/sja1000/sja1000.c b/drivers/net/can/sja1000/sja1000.c index 7164a999f50f..f17c3018b7c7 100644 --- a/drivers/net/can/sja1000/sja1000.c +++ b/drivers/net/can/sja1000/sja1000.c | |||
| @@ -494,20 +494,20 @@ irqreturn_t sja1000_interrupt(int irq, void *dev_id) | |||
| 494 | uint8_t isrc, status; | 494 | uint8_t isrc, status; |
| 495 | int n = 0; | 495 | int n = 0; |
| 496 | 496 | ||
| 497 | /* Shared interrupts and IRQ off? */ | ||
| 498 | if (priv->read_reg(priv, SJA1000_IER) == IRQ_OFF) | ||
| 499 | return IRQ_NONE; | ||
| 500 | |||
| 501 | if (priv->pre_irq) | 497 | if (priv->pre_irq) |
| 502 | priv->pre_irq(priv); | 498 | priv->pre_irq(priv); |
| 503 | 499 | ||
| 500 | /* Shared interrupts and IRQ off? */ | ||
| 501 | if (priv->read_reg(priv, SJA1000_IER) == IRQ_OFF) | ||
| 502 | goto out; | ||
| 503 | |||
| 504 | while ((isrc = priv->read_reg(priv, SJA1000_IR)) && | 504 | while ((isrc = priv->read_reg(priv, SJA1000_IR)) && |
| 505 | (n < SJA1000_MAX_IRQ)) { | 505 | (n < SJA1000_MAX_IRQ)) { |
| 506 | n++; | 506 | |
| 507 | status = priv->read_reg(priv, SJA1000_SR); | 507 | status = priv->read_reg(priv, SJA1000_SR); |
| 508 | /* check for absent controller due to hw unplug */ | 508 | /* check for absent controller due to hw unplug */ |
| 509 | if (status == 0xFF && sja1000_is_absent(priv)) | 509 | if (status == 0xFF && sja1000_is_absent(priv)) |
| 510 | return IRQ_NONE; | 510 | goto out; |
| 511 | 511 | ||
| 512 | if (isrc & IRQ_WUI) | 512 | if (isrc & IRQ_WUI) |
| 513 | netdev_warn(dev, "wakeup interrupt\n"); | 513 | netdev_warn(dev, "wakeup interrupt\n"); |
| @@ -535,7 +535,7 @@ irqreturn_t sja1000_interrupt(int irq, void *dev_id) | |||
| 535 | status = priv->read_reg(priv, SJA1000_SR); | 535 | status = priv->read_reg(priv, SJA1000_SR); |
| 536 | /* check for absent controller */ | 536 | /* check for absent controller */ |
| 537 | if (status == 0xFF && sja1000_is_absent(priv)) | 537 | if (status == 0xFF && sja1000_is_absent(priv)) |
| 538 | return IRQ_NONE; | 538 | goto out; |
| 539 | } | 539 | } |
| 540 | } | 540 | } |
| 541 | if (isrc & (IRQ_DOI | IRQ_EI | IRQ_BEI | IRQ_EPI | IRQ_ALI)) { | 541 | if (isrc & (IRQ_DOI | IRQ_EI | IRQ_BEI | IRQ_EPI | IRQ_ALI)) { |
| @@ -543,8 +543,9 @@ irqreturn_t sja1000_interrupt(int irq, void *dev_id) | |||
| 543 | if (sja1000_err(dev, isrc, status)) | 543 | if (sja1000_err(dev, isrc, status)) |
| 544 | break; | 544 | break; |
| 545 | } | 545 | } |
| 546 | n++; | ||
| 546 | } | 547 | } |
| 547 | 548 | out: | |
| 548 | if (priv->post_irq) | 549 | if (priv->post_irq) |
| 549 | priv->post_irq(priv); | 550 | priv->post_irq(priv); |
| 550 | 551 | ||
diff --git a/drivers/net/ethernet/allwinner/sun4i-emac.c b/drivers/net/ethernet/allwinner/sun4i-emac.c index 50b853a79d77..46dfb1378c17 100644 --- a/drivers/net/ethernet/allwinner/sun4i-emac.c +++ b/drivers/net/ethernet/allwinner/sun4i-emac.c | |||
| @@ -717,8 +717,7 @@ static int emac_open(struct net_device *dev) | |||
| 717 | if (netif_msg_ifup(db)) | 717 | if (netif_msg_ifup(db)) |
| 718 | dev_dbg(db->dev, "enabling %s\n", dev->name); | 718 | dev_dbg(db->dev, "enabling %s\n", dev->name); |
| 719 | 719 | ||
| 720 | if (devm_request_irq(db->dev, dev->irq, &emac_interrupt, | 720 | if (request_irq(dev->irq, &emac_interrupt, 0, dev->name, dev)) |
| 721 | 0, dev->name, dev)) | ||
| 722 | return -EAGAIN; | 721 | return -EAGAIN; |
| 723 | 722 | ||
| 724 | /* Initialize EMAC board */ | 723 | /* Initialize EMAC board */ |
| @@ -774,6 +773,8 @@ static int emac_stop(struct net_device *ndev) | |||
| 774 | 773 | ||
| 775 | emac_shutdown(ndev); | 774 | emac_shutdown(ndev); |
| 776 | 775 | ||
| 776 | free_irq(ndev->irq, ndev); | ||
| 777 | |||
| 777 | return 0; | 778 | return 0; |
| 778 | } | 779 | } |
| 779 | 780 | ||
diff --git a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_sriov.c b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_sriov.c index 0216d592d0ce..2e46c28fc601 100644 --- a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_sriov.c +++ b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_sriov.c | |||
| @@ -3114,6 +3114,11 @@ int bnx2x_sriov_configure(struct pci_dev *dev, int num_vfs_param) | |||
| 3114 | { | 3114 | { |
| 3115 | struct bnx2x *bp = netdev_priv(pci_get_drvdata(dev)); | 3115 | struct bnx2x *bp = netdev_priv(pci_get_drvdata(dev)); |
| 3116 | 3116 | ||
| 3117 | if (!IS_SRIOV(bp)) { | ||
| 3118 | BNX2X_ERR("failed to configure SR-IOV since vfdb was not allocated. Check dmesg for errors in probe stage\n"); | ||
| 3119 | return -EINVAL; | ||
| 3120 | } | ||
| 3121 | |||
| 3117 | DP(BNX2X_MSG_IOV, "bnx2x_sriov_configure called with %d, BNX2X_NR_VIRTFN(bp) was %d\n", | 3122 | DP(BNX2X_MSG_IOV, "bnx2x_sriov_configure called with %d, BNX2X_NR_VIRTFN(bp) was %d\n", |
| 3118 | num_vfs_param, BNX2X_NR_VIRTFN(bp)); | 3123 | num_vfs_param, BNX2X_NR_VIRTFN(bp)); |
| 3119 | 3124 | ||
diff --git a/drivers/net/ethernet/broadcom/tg3.c b/drivers/net/ethernet/broadcom/tg3.c index a9e068423ba0..f3dd93b4aeaa 100644 --- a/drivers/net/ethernet/broadcom/tg3.c +++ b/drivers/net/ethernet/broadcom/tg3.c | |||
| @@ -8932,6 +8932,9 @@ static int tg3_chip_reset(struct tg3 *tp) | |||
| 8932 | void (*write_op)(struct tg3 *, u32, u32); | 8932 | void (*write_op)(struct tg3 *, u32, u32); |
| 8933 | int i, err; | 8933 | int i, err; |
| 8934 | 8934 | ||
| 8935 | if (!pci_device_is_present(tp->pdev)) | ||
| 8936 | return -ENODEV; | ||
| 8937 | |||
| 8935 | tg3_nvram_lock(tp); | 8938 | tg3_nvram_lock(tp); |
| 8936 | 8939 | ||
| 8937 | tg3_ape_lock(tp, TG3_APE_LOCK_GRC); | 8940 | tg3_ape_lock(tp, TG3_APE_LOCK_GRC); |
| @@ -10629,10 +10632,8 @@ static void tg3_sd_scan_scratchpad(struct tg3 *tp, struct tg3_ocir *ocir) | |||
| 10629 | static ssize_t tg3_show_temp(struct device *dev, | 10632 | static ssize_t tg3_show_temp(struct device *dev, |
| 10630 | struct device_attribute *devattr, char *buf) | 10633 | struct device_attribute *devattr, char *buf) |
| 10631 | { | 10634 | { |
| 10632 | struct pci_dev *pdev = to_pci_dev(dev); | ||
| 10633 | struct net_device *netdev = pci_get_drvdata(pdev); | ||
| 10634 | struct tg3 *tp = netdev_priv(netdev); | ||
| 10635 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); | 10635 | struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); |
| 10636 | struct tg3 *tp = dev_get_drvdata(dev); | ||
| 10636 | u32 temperature; | 10637 | u32 temperature; |
| 10637 | 10638 | ||
| 10638 | spin_lock_bh(&tp->lock); | 10639 | spin_lock_bh(&tp->lock); |
| @@ -10650,29 +10651,25 @@ static SENSOR_DEVICE_ATTR(temp1_crit, S_IRUGO, tg3_show_temp, NULL, | |||
| 10650 | static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO, tg3_show_temp, NULL, | 10651 | static SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO, tg3_show_temp, NULL, |
| 10651 | TG3_TEMP_MAX_OFFSET); | 10652 | TG3_TEMP_MAX_OFFSET); |
| 10652 | 10653 | ||
| 10653 | static struct attribute *tg3_attributes[] = { | 10654 | static struct attribute *tg3_attrs[] = { |
| 10654 | &sensor_dev_attr_temp1_input.dev_attr.attr, | 10655 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
| 10655 | &sensor_dev_attr_temp1_crit.dev_attr.attr, | 10656 | &sensor_dev_attr_temp1_crit.dev_attr.attr, |
| 10656 | &sensor_dev_attr_temp1_max.dev_attr.attr, | 10657 | &sensor_dev_attr_temp1_max.dev_attr.attr, |
| 10657 | NULL | 10658 | NULL |
| 10658 | }; | 10659 | }; |
| 10659 | 10660 | ATTRIBUTE_GROUPS(tg3); | |
| 10660 | static const struct attribute_group tg3_group = { | ||
| 10661 | .attrs = tg3_attributes, | ||
| 10662 | }; | ||
| 10663 | 10661 | ||
| 10664 | static void tg3_hwmon_close(struct tg3 *tp) | 10662 | static void tg3_hwmon_close(struct tg3 *tp) |
| 10665 | { | 10663 | { |
| 10666 | if (tp->hwmon_dev) { | 10664 | if (tp->hwmon_dev) { |
| 10667 | hwmon_device_unregister(tp->hwmon_dev); | 10665 | hwmon_device_unregister(tp->hwmon_dev); |
| 10668 | tp->hwmon_dev = NULL; | 10666 | tp->hwmon_dev = NULL; |
| 10669 | sysfs_remove_group(&tp->pdev->dev.kobj, &tg3_group); | ||
| 10670 | } | 10667 | } |
| 10671 | } | 10668 | } |
| 10672 | 10669 | ||
| 10673 | static void tg3_hwmon_open(struct tg3 *tp) | 10670 | static void tg3_hwmon_open(struct tg3 *tp) |
| 10674 | { | 10671 | { |
| 10675 | int i, err; | 10672 | int i; |
| 10676 | u32 size = 0; | 10673 | u32 size = 0; |
| 10677 | struct pci_dev *pdev = tp->pdev; | 10674 | struct pci_dev *pdev = tp->pdev; |
| 10678 | struct tg3_ocir ocirs[TG3_SD_NUM_RECS]; | 10675 | struct tg3_ocir ocirs[TG3_SD_NUM_RECS]; |
| @@ -10690,18 +10687,11 @@ static void tg3_hwmon_open(struct tg3 *tp) | |||
| 10690 | if (!size) | 10687 | if (!size) |
| 10691 | return; | 10688 | return; |
| 10692 | 10689 | ||
| 10693 | /* Register hwmon sysfs hooks */ | 10690 | tp->hwmon_dev = hwmon_device_register_with_groups(&pdev->dev, "tg3", |
| 10694 | err = sysfs_create_group(&pdev->dev.kobj, &tg3_group); | 10691 | tp, tg3_groups); |
| 10695 | if (err) { | ||
| 10696 | dev_err(&pdev->dev, "Cannot create sysfs group, aborting\n"); | ||
| 10697 | return; | ||
| 10698 | } | ||
| 10699 | |||
| 10700 | tp->hwmon_dev = hwmon_device_register(&pdev->dev); | ||
| 10701 | if (IS_ERR(tp->hwmon_dev)) { | 10692 | if (IS_ERR(tp->hwmon_dev)) { |
| 10702 | tp->hwmon_dev = NULL; | 10693 | tp->hwmon_dev = NULL; |
| 10703 | dev_err(&pdev->dev, "Cannot register hwmon device, aborting\n"); | 10694 | dev_err(&pdev->dev, "Cannot register hwmon device, aborting\n"); |
| 10704 | sysfs_remove_group(&pdev->dev.kobj, &tg3_group); | ||
| 10705 | } | 10695 | } |
| 10706 | } | 10696 | } |
| 10707 | 10697 | ||
| @@ -11594,10 +11584,11 @@ static int tg3_close(struct net_device *dev) | |||
| 11594 | memset(&tp->net_stats_prev, 0, sizeof(tp->net_stats_prev)); | 11584 | memset(&tp->net_stats_prev, 0, sizeof(tp->net_stats_prev)); |
| 11595 | memset(&tp->estats_prev, 0, sizeof(tp->estats_prev)); | 11585 | memset(&tp->estats_prev, 0, sizeof(tp->estats_prev)); |
| 11596 | 11586 | ||
| 11597 | tg3_power_down_prepare(tp); | 11587 | if (pci_device_is_present(tp->pdev)) { |
| 11598 | 11588 | tg3_power_down_prepare(tp); | |
| 11599 | tg3_carrier_off(tp); | ||
| 11600 | 11589 | ||
| 11590 | tg3_carrier_off(tp); | ||
| 11591 | } | ||
| 11601 | return 0; | 11592 | return 0; |
| 11602 | } | 11593 | } |
| 11603 | 11594 | ||
| @@ -16512,6 +16503,9 @@ static int tg3_get_invariants(struct tg3 *tp, const struct pci_device_id *ent) | |||
| 16512 | /* Clear this out for sanity. */ | 16503 | /* Clear this out for sanity. */ |
| 16513 | tw32(TG3PCI_MEM_WIN_BASE_ADDR, 0); | 16504 | tw32(TG3PCI_MEM_WIN_BASE_ADDR, 0); |
| 16514 | 16505 | ||
| 16506 | /* Clear TG3PCI_REG_BASE_ADDR to prevent hangs. */ | ||
| 16507 | tw32(TG3PCI_REG_BASE_ADDR, 0); | ||
| 16508 | |||
| 16515 | pci_read_config_dword(tp->pdev, TG3PCI_PCISTATE, | 16509 | pci_read_config_dword(tp->pdev, TG3PCI_PCISTATE, |
| 16516 | &pci_state_reg); | 16510 | &pci_state_reg); |
| 16517 | if ((pci_state_reg & PCISTATE_CONV_PCI_MODE) == 0 && | 16511 | if ((pci_state_reg & PCISTATE_CONV_PCI_MODE) == 0 && |
| @@ -17739,10 +17733,12 @@ static int tg3_suspend(struct device *device) | |||
| 17739 | struct pci_dev *pdev = to_pci_dev(device); | 17733 | struct pci_dev *pdev = to_pci_dev(device); |
| 17740 | struct net_device *dev = pci_get_drvdata(pdev); | 17734 | struct net_device *dev = pci_get_drvdata(pdev); |
| 17741 | struct tg3 *tp = netdev_priv(dev); | 17735 | struct tg3 *tp = netdev_priv(dev); |
| 17742 | int err; | 17736 | int err = 0; |
| 17737 | |||
| 17738 | rtnl_lock(); | ||
| 17743 | 17739 | ||
| 17744 | if (!netif_running(dev)) | 17740 | if (!netif_running(dev)) |
| 17745 | return 0; | 17741 | goto unlock; |
| 17746 | 17742 | ||
| 17747 | tg3_reset_task_cancel(tp); | 17743 | tg3_reset_task_cancel(tp); |
| 17748 | tg3_phy_stop(tp); | 17744 | tg3_phy_stop(tp); |
| @@ -17784,6 +17780,8 @@ out: | |||
| 17784 | tg3_phy_start(tp); | 17780 | tg3_phy_start(tp); |
| 17785 | } | 17781 | } |
| 17786 | 17782 | ||
| 17783 | unlock: | ||
| 17784 | rtnl_unlock(); | ||
| 17787 | return err; | 17785 | return err; |
| 17788 | } | 17786 | } |
| 17789 | 17787 | ||
| @@ -17792,10 +17790,12 @@ static int tg3_resume(struct device *device) | |||
| 17792 | struct pci_dev *pdev = to_pci_dev(device); | 17790 | struct pci_dev *pdev = to_pci_dev(device); |
| 17793 | struct net_device *dev = pci_get_drvdata(pdev); | 17791 | struct net_device *dev = pci_get_drvdata(pdev); |
| 17794 | struct tg3 *tp = netdev_priv(dev); | 17792 | struct tg3 *tp = netdev_priv(dev); |
| 17795 | int err; | 17793 | int err = 0; |
| 17794 | |||
| 17795 | rtnl_lock(); | ||
| 17796 | 17796 | ||
| 17797 | if (!netif_running(dev)) | 17797 | if (!netif_running(dev)) |
| 17798 | return 0; | 17798 | goto unlock; |
| 17799 | 17799 | ||
| 17800 | netif_device_attach(dev); | 17800 | netif_device_attach(dev); |
| 17801 | 17801 | ||
| @@ -17819,6 +17819,8 @@ out: | |||
| 17819 | if (!err) | 17819 | if (!err) |
| 17820 | tg3_phy_start(tp); | 17820 | tg3_phy_start(tp); |
| 17821 | 17821 | ||
| 17822 | unlock: | ||
| 17823 | rtnl_unlock(); | ||
| 17822 | return err; | 17824 | return err; |
| 17823 | } | 17825 | } |
| 17824 | #endif /* CONFIG_PM_SLEEP */ | 17826 | #endif /* CONFIG_PM_SLEEP */ |
diff --git a/drivers/net/ethernet/chelsio/cxgb4/cxgb4.h b/drivers/net/ethernet/chelsio/cxgb4/cxgb4.h index ecd2fb3ef695..6c9308850453 100644 --- a/drivers/net/ethernet/chelsio/cxgb4/cxgb4.h +++ b/drivers/net/ethernet/chelsio/cxgb4/cxgb4.h | |||
| @@ -49,13 +49,15 @@ | |||
| 49 | #include <asm/io.h> | 49 | #include <asm/io.h> |
| 50 | #include "cxgb4_uld.h" | 50 | #include "cxgb4_uld.h" |
| 51 | 51 | ||
| 52 | #define FW_VERSION_MAJOR 1 | 52 | #define T4FW_VERSION_MAJOR 0x01 |
| 53 | #define FW_VERSION_MINOR 4 | 53 | #define T4FW_VERSION_MINOR 0x06 |
| 54 | #define FW_VERSION_MICRO 0 | 54 | #define T4FW_VERSION_MICRO 0x18 |
| 55 | #define T4FW_VERSION_BUILD 0x00 | ||
| 55 | 56 | ||
| 56 | #define FW_VERSION_MAJOR_T5 0 | 57 | #define T5FW_VERSION_MAJOR 0x01 |
| 57 | #define FW_VERSION_MINOR_T5 0 | 58 | #define T5FW_VERSION_MINOR 0x08 |
| 58 | #define FW_VERSION_MICRO_T5 0 | 59 | #define T5FW_VERSION_MICRO 0x1C |
| 60 | #define T5FW_VERSION_BUILD 0x00 | ||
| 59 | 61 | ||
| 60 | #define CH_WARN(adap, fmt, ...) dev_warn(adap->pdev_dev, fmt, ## __VA_ARGS__) | 62 | #define CH_WARN(adap, fmt, ...) dev_warn(adap->pdev_dev, fmt, ## __VA_ARGS__) |
| 61 | 63 | ||
| @@ -240,6 +242,26 @@ struct pci_params { | |||
| 240 | unsigned char width; | 242 | unsigned char width; |
| 241 | }; | 243 | }; |
| 242 | 244 | ||
| 245 | #define CHELSIO_CHIP_CODE(version, revision) (((version) << 4) | (revision)) | ||
| 246 | #define CHELSIO_CHIP_FPGA 0x100 | ||
| 247 | #define CHELSIO_CHIP_VERSION(code) (((code) >> 4) & 0xf) | ||
| 248 | #define CHELSIO_CHIP_RELEASE(code) ((code) & 0xf) | ||
| 249 | |||
| 250 | #define CHELSIO_T4 0x4 | ||
| 251 | #define CHELSIO_T5 0x5 | ||
| 252 | |||
| 253 | enum chip_type { | ||
| 254 | T4_A1 = CHELSIO_CHIP_CODE(CHELSIO_T4, 1), | ||
| 255 | T4_A2 = CHELSIO_CHIP_CODE(CHELSIO_T4, 2), | ||
| 256 | T4_FIRST_REV = T4_A1, | ||
| 257 | T4_LAST_REV = T4_A2, | ||
| 258 | |||
| 259 | T5_A0 = CHELSIO_CHIP_CODE(CHELSIO_T5, 0), | ||
| 260 | T5_A1 = CHELSIO_CHIP_CODE(CHELSIO_T5, 1), | ||
| 261 | T5_FIRST_REV = T5_A0, | ||
| 262 | T5_LAST_REV = T5_A1, | ||
| 263 | }; | ||
| 264 | |||
| 243 | struct adapter_params { | 265 | struct adapter_params { |
| 244 | struct tp_params tp; | 266 | struct tp_params tp; |
| 245 | struct vpd_params vpd; | 267 | struct vpd_params vpd; |
| @@ -259,7 +281,7 @@ struct adapter_params { | |||
| 259 | 281 | ||
| 260 | unsigned char nports; /* # of ethernet ports */ | 282 | unsigned char nports; /* # of ethernet ports */ |
| 261 | unsigned char portvec; | 283 | unsigned char portvec; |
| 262 | unsigned char rev; /* chip revision */ | 284 | enum chip_type chip; /* chip code */ |
| 263 | unsigned char offload; | 285 | unsigned char offload; |
| 264 | 286 | ||
| 265 | unsigned char bypass; | 287 | unsigned char bypass; |
| @@ -267,6 +289,23 @@ struct adapter_params { | |||
| 267 | unsigned int ofldq_wr_cred; | 289 | unsigned int ofldq_wr_cred; |
| 268 | }; | 290 | }; |
| 269 | 291 | ||
| 292 | #include "t4fw_api.h" | ||
| 293 | |||
| 294 | #define FW_VERSION(chip) ( \ | ||
| 295 | FW_HDR_FW_VER_MAJOR_GET(chip##FW_VERSION_MAJOR) | \ | ||
| 296 | FW_HDR_FW_VER_MINOR_GET(chip##FW_VERSION_MINOR) | \ | ||
| 297 | FW_HDR_FW_VER_MICRO_GET(chip##FW_VERSION_MICRO) | \ | ||
| 298 | FW_HDR_FW_VER_BUILD_GET(chip##FW_VERSION_BUILD)) | ||
| 299 | #define FW_INTFVER(chip, intf) (FW_HDR_INTFVER_##intf) | ||
| 300 | |||
| 301 | struct fw_info { | ||
| 302 | u8 chip; | ||
| 303 | char *fs_name; | ||
| 304 | char *fw_mod_name; | ||
| 305 | struct fw_hdr fw_hdr; | ||
| 306 | }; | ||
| 307 | |||
| 308 | |||
| 270 | struct trace_params { | 309 | struct trace_params { |
| 271 | u32 data[TRACE_LEN / 4]; | 310 | u32 data[TRACE_LEN / 4]; |
| 272 | u32 mask[TRACE_LEN / 4]; | 311 | u32 mask[TRACE_LEN / 4]; |
| @@ -512,25 +551,6 @@ struct sge { | |||
| 512 | 551 | ||
| 513 | struct l2t_data; | 552 | struct l2t_data; |
| 514 | 553 | ||
| 515 | #define CHELSIO_CHIP_CODE(version, revision) (((version) << 4) | (revision)) | ||
| 516 | #define CHELSIO_CHIP_VERSION(code) ((code) >> 4) | ||
| 517 | #define CHELSIO_CHIP_RELEASE(code) ((code) & 0xf) | ||
| 518 | |||
| 519 | #define CHELSIO_T4 0x4 | ||
| 520 | #define CHELSIO_T5 0x5 | ||
| 521 | |||
| 522 | enum chip_type { | ||
| 523 | T4_A1 = CHELSIO_CHIP_CODE(CHELSIO_T4, 0), | ||
| 524 | T4_A2 = CHELSIO_CHIP_CODE(CHELSIO_T4, 1), | ||
| 525 | T4_A3 = CHELSIO_CHIP_CODE(CHELSIO_T4, 2), | ||
| 526 | T4_FIRST_REV = T4_A1, | ||
| 527 | T4_LAST_REV = T4_A3, | ||
| 528 | |||
| 529 | T5_A1 = CHELSIO_CHIP_CODE(CHELSIO_T5, 0), | ||
| 530 | T5_FIRST_REV = T5_A1, | ||
| 531 | T5_LAST_REV = T5_A1, | ||
| 532 | }; | ||
| 533 | |||
| 534 | #ifdef CONFIG_PCI_IOV | 554 | #ifdef CONFIG_PCI_IOV |
| 535 | 555 | ||
| 536 | /* T4 supports SRIOV on PF0-3 and T5 on PF0-7. However, the Serial | 556 | /* T4 supports SRIOV on PF0-3 and T5 on PF0-7. However, the Serial |
| @@ -715,12 +735,12 @@ enum { | |||
| 715 | 735 | ||
| 716 | static inline int is_t5(enum chip_type chip) | 736 | static inline int is_t5(enum chip_type chip) |
| 717 | { | 737 | { |
| 718 | return (chip >= T5_FIRST_REV && chip <= T5_LAST_REV); | 738 | return CHELSIO_CHIP_VERSION(chip) == CHELSIO_T5; |
| 719 | } | 739 | } |
| 720 | 740 | ||
| 721 | static inline int is_t4(enum chip_type chip) | 741 | static inline int is_t4(enum chip_type chip) |
| 722 | { | 742 | { |
| 723 | return (chip >= T4_FIRST_REV && chip <= T4_LAST_REV); | 743 | return CHELSIO_CHIP_VERSION(chip) == CHELSIO_T4; |
| 724 | } | 744 | } |
| 725 | 745 | ||
| 726 | static inline u32 t4_read_reg(struct adapter *adap, u32 reg_addr) | 746 | static inline u32 t4_read_reg(struct adapter *adap, u32 reg_addr) |
| @@ -900,7 +920,11 @@ int get_vpd_params(struct adapter *adapter, struct vpd_params *p); | |||
| 900 | int t4_load_fw(struct adapter *adapter, const u8 *fw_data, unsigned int size); | 920 | int t4_load_fw(struct adapter *adapter, const u8 *fw_data, unsigned int size); |
| 901 | unsigned int t4_flash_cfg_addr(struct adapter *adapter); | 921 | unsigned int t4_flash_cfg_addr(struct adapter *adapter); |
| 902 | int t4_load_cfg(struct adapter *adapter, const u8 *cfg_data, unsigned int size); | 922 | int t4_load_cfg(struct adapter *adapter, const u8 *cfg_data, unsigned int size); |
| 903 | int t4_check_fw_version(struct adapter *adapter); | 923 | int t4_get_fw_version(struct adapter *adapter, u32 *vers); |
| 924 | int t4_get_tp_version(struct adapter *adapter, u32 *vers); | ||
| 925 | int t4_prep_fw(struct adapter *adap, struct fw_info *fw_info, | ||
| 926 | const u8 *fw_data, unsigned int fw_size, | ||
| 927 | struct fw_hdr *card_fw, enum dev_state state, int *reset); | ||
| 904 | int t4_prep_adapter(struct adapter *adapter); | 928 | int t4_prep_adapter(struct adapter *adapter); |
| 905 | int t4_port_init(struct adapter *adap, int mbox, int pf, int vf); | 929 | int t4_port_init(struct adapter *adap, int mbox, int pf, int vf); |
| 906 | void t4_fatal_err(struct adapter *adapter); | 930 | void t4_fatal_err(struct adapter *adapter); |
diff --git a/drivers/net/ethernet/chelsio/cxgb4/cxgb4_main.c b/drivers/net/ethernet/chelsio/cxgb4/cxgb4_main.c index 8b929eeecd2d..d6b12e035a7d 100644 --- a/drivers/net/ethernet/chelsio/cxgb4/cxgb4_main.c +++ b/drivers/net/ethernet/chelsio/cxgb4/cxgb4_main.c | |||
| @@ -276,9 +276,9 @@ static DEFINE_PCI_DEVICE_TABLE(cxgb4_pci_tbl) = { | |||
| 276 | { 0, } | 276 | { 0, } |
| 277 | }; | 277 | }; |
| 278 | 278 | ||
| 279 | #define FW_FNAME "cxgb4/t4fw.bin" | 279 | #define FW4_FNAME "cxgb4/t4fw.bin" |
| 280 | #define FW5_FNAME "cxgb4/t5fw.bin" | 280 | #define FW5_FNAME "cxgb4/t5fw.bin" |
| 281 | #define FW_CFNAME "cxgb4/t4-config.txt" | 281 | #define FW4_CFNAME "cxgb4/t4-config.txt" |
| 282 | #define FW5_CFNAME "cxgb4/t5-config.txt" | 282 | #define FW5_CFNAME "cxgb4/t5-config.txt" |
| 283 | 283 | ||
| 284 | MODULE_DESCRIPTION(DRV_DESC); | 284 | MODULE_DESCRIPTION(DRV_DESC); |
| @@ -286,7 +286,7 @@ MODULE_AUTHOR("Chelsio Communications"); | |||
| 286 | MODULE_LICENSE("Dual BSD/GPL"); | 286 | MODULE_LICENSE("Dual BSD/GPL"); |
| 287 | MODULE_VERSION(DRV_VERSION); | 287 | MODULE_VERSION(DRV_VERSION); |
| 288 | MODULE_DEVICE_TABLE(pci, cxgb4_pci_tbl); | 288 | MODULE_DEVICE_TABLE(pci, cxgb4_pci_tbl); |
| 289 | MODULE_FIRMWARE(FW_FNAME); | 289 | MODULE_FIRMWARE(FW4_FNAME); |
| 290 | MODULE_FIRMWARE(FW5_FNAME); | 290 | MODULE_FIRMWARE(FW5_FNAME); |
| 291 | 291 | ||
| 292 | /* | 292 | /* |
| @@ -1071,72 +1071,6 @@ freeout: t4_free_sge_resources(adap); | |||
| 1071 | } | 1071 | } |
| 1072 | 1072 | ||
| 1073 | /* | 1073 | /* |
| 1074 | * Returns 0 if new FW was successfully loaded, a positive errno if a load was | ||
| 1075 | * started but failed, and a negative errno if flash load couldn't start. | ||
| 1076 | */ | ||
| 1077 | static int upgrade_fw(struct adapter *adap) | ||
| 1078 | { | ||
| 1079 | int ret; | ||
| 1080 | u32 vers, exp_major; | ||
| 1081 | const struct fw_hdr *hdr; | ||
| 1082 | const struct firmware *fw; | ||
| 1083 | struct device *dev = adap->pdev_dev; | ||
| 1084 | char *fw_file_name; | ||
| 1085 | |||
| 1086 | switch (CHELSIO_CHIP_VERSION(adap->chip)) { | ||
| 1087 | case CHELSIO_T4: | ||
| 1088 | fw_file_name = FW_FNAME; | ||
| 1089 | exp_major = FW_VERSION_MAJOR; | ||
| 1090 | break; | ||
| 1091 | case CHELSIO_T5: | ||
| 1092 | fw_file_name = FW5_FNAME; | ||
| 1093 | exp_major = FW_VERSION_MAJOR_T5; | ||
| 1094 | break; | ||
| 1095 | default: | ||
| 1096 | dev_err(dev, "Unsupported chip type, %x\n", adap->chip); | ||
| 1097 | return -EINVAL; | ||
| 1098 | } | ||
| 1099 | |||
| 1100 | ret = request_firmware(&fw, fw_file_name, dev); | ||
| 1101 | if (ret < 0) { | ||
| 1102 | dev_err(dev, "unable to load firmware image %s, error %d\n", | ||
| 1103 | fw_file_name, ret); | ||
| 1104 | return ret; | ||
| 1105 | } | ||
| 1106 | |||
| 1107 | hdr = (const struct fw_hdr *)fw->data; | ||
| 1108 | vers = ntohl(hdr->fw_ver); | ||
| 1109 | if (FW_HDR_FW_VER_MAJOR_GET(vers) != exp_major) { | ||
| 1110 | ret = -EINVAL; /* wrong major version, won't do */ | ||
| 1111 | goto out; | ||
| 1112 | } | ||
| 1113 | |||
| 1114 | /* | ||
| 1115 | * If the flash FW is unusable or we found something newer, load it. | ||
| 1116 | */ | ||
| 1117 | if (FW_HDR_FW_VER_MAJOR_GET(adap->params.fw_vers) != exp_major || | ||
| 1118 | vers > adap->params.fw_vers) { | ||
| 1119 | dev_info(dev, "upgrading firmware ...\n"); | ||
| 1120 | ret = t4_fw_upgrade(adap, adap->mbox, fw->data, fw->size, | ||
| 1121 | /*force=*/false); | ||
| 1122 | if (!ret) | ||
| 1123 | dev_info(dev, | ||
| 1124 | "firmware upgraded to version %pI4 from %s\n", | ||
| 1125 | &hdr->fw_ver, fw_file_name); | ||
| 1126 | else | ||
| 1127 | dev_err(dev, "firmware upgrade failed! err=%d\n", -ret); | ||
| 1128 | } else { | ||
| 1129 | /* | ||
| 1130 | * Tell our caller that we didn't upgrade the firmware. | ||
| 1131 | */ | ||
| 1132 | ret = -EINVAL; | ||
| 1133 | } | ||
| 1134 | |||
| 1135 | out: release_firmware(fw); | ||
| 1136 | return ret; | ||
| 1137 | } | ||
| 1138 | |||
| 1139 | /* | ||
| 1140 | * Allocate a chunk of memory using kmalloc or, if that fails, vmalloc. | 1074 | * Allocate a chunk of memory using kmalloc or, if that fails, vmalloc. |
| 1141 | * The allocated memory is cleared. | 1075 | * The allocated memory is cleared. |
| 1142 | */ | 1076 | */ |
| @@ -1415,7 +1349,7 @@ static int get_sset_count(struct net_device *dev, int sset) | |||
| 1415 | static int get_regs_len(struct net_device *dev) | 1349 | static int get_regs_len(struct net_device *dev) |
| 1416 | { | 1350 | { |
| 1417 | struct adapter *adap = netdev2adap(dev); | 1351 | struct adapter *adap = netdev2adap(dev); |
| 1418 | if (is_t4(adap->chip)) | 1352 | if (is_t4(adap->params.chip)) |
| 1419 | return T4_REGMAP_SIZE; | 1353 | return T4_REGMAP_SIZE; |
| 1420 | else | 1354 | else |
| 1421 | return T5_REGMAP_SIZE; | 1355 | return T5_REGMAP_SIZE; |
| @@ -1499,7 +1433,7 @@ static void get_stats(struct net_device *dev, struct ethtool_stats *stats, | |||
| 1499 | data += sizeof(struct port_stats) / sizeof(u64); | 1433 | data += sizeof(struct port_stats) / sizeof(u64); |
| 1500 | collect_sge_port_stats(adapter, pi, (struct queue_port_stats *)data); | 1434 | collect_sge_port_stats(adapter, pi, (struct queue_port_stats *)data); |
| 1501 | data += sizeof(struct queue_port_stats) / sizeof(u64); | 1435 | data += sizeof(struct queue_port_stats) / sizeof(u64); |
| 1502 | if (!is_t4(adapter->chip)) { | 1436 | if (!is_t4(adapter->params.chip)) { |
| 1503 | t4_write_reg(adapter, SGE_STAT_CFG, STATSOURCE_T5(7)); | 1437 | t4_write_reg(adapter, SGE_STAT_CFG, STATSOURCE_T5(7)); |
| 1504 | val1 = t4_read_reg(adapter, SGE_STAT_TOTAL); | 1438 | val1 = t4_read_reg(adapter, SGE_STAT_TOTAL); |
| 1505 | val2 = t4_read_reg(adapter, SGE_STAT_MATCH); | 1439 | val2 = t4_read_reg(adapter, SGE_STAT_MATCH); |
| @@ -1521,8 +1455,8 @@ static void get_stats(struct net_device *dev, struct ethtool_stats *stats, | |||
| 1521 | */ | 1455 | */ |
| 1522 | static inline unsigned int mk_adap_vers(const struct adapter *ap) | 1456 | static inline unsigned int mk_adap_vers(const struct adapter *ap) |
| 1523 | { | 1457 | { |
| 1524 | return CHELSIO_CHIP_VERSION(ap->chip) | | 1458 | return CHELSIO_CHIP_VERSION(ap->params.chip) | |
| 1525 | (CHELSIO_CHIP_RELEASE(ap->chip) << 10) | (1 << 16); | 1459 | (CHELSIO_CHIP_RELEASE(ap->params.chip) << 10) | (1 << 16); |
| 1526 | } | 1460 | } |
| 1527 | 1461 | ||
| 1528 | static void reg_block_dump(struct adapter *ap, void *buf, unsigned int start, | 1462 | static void reg_block_dump(struct adapter *ap, void *buf, unsigned int start, |
| @@ -2189,7 +2123,7 @@ static void get_regs(struct net_device *dev, struct ethtool_regs *regs, | |||
| 2189 | static const unsigned int *reg_ranges; | 2123 | static const unsigned int *reg_ranges; |
| 2190 | int arr_size = 0, buf_size = 0; | 2124 | int arr_size = 0, buf_size = 0; |
| 2191 | 2125 | ||
| 2192 | if (is_t4(ap->chip)) { | 2126 | if (is_t4(ap->params.chip)) { |
| 2193 | reg_ranges = &t4_reg_ranges[0]; | 2127 | reg_ranges = &t4_reg_ranges[0]; |
| 2194 | arr_size = ARRAY_SIZE(t4_reg_ranges); | 2128 | arr_size = ARRAY_SIZE(t4_reg_ranges); |
| 2195 | buf_size = T4_REGMAP_SIZE; | 2129 | buf_size = T4_REGMAP_SIZE; |
| @@ -2967,7 +2901,7 @@ static int setup_debugfs(struct adapter *adap) | |||
| 2967 | size = t4_read_reg(adap, MA_EDRAM1_BAR); | 2901 | size = t4_read_reg(adap, MA_EDRAM1_BAR); |
| 2968 | add_debugfs_mem(adap, "edc1", MEM_EDC1, EDRAM_SIZE_GET(size)); | 2902 | add_debugfs_mem(adap, "edc1", MEM_EDC1, EDRAM_SIZE_GET(size)); |
| 2969 | } | 2903 | } |
| 2970 | if (is_t4(adap->chip)) { | 2904 | if (is_t4(adap->params.chip)) { |
| 2971 | size = t4_read_reg(adap, MA_EXT_MEMORY_BAR); | 2905 | size = t4_read_reg(adap, MA_EXT_MEMORY_BAR); |
| 2972 | if (i & EXT_MEM_ENABLE) | 2906 | if (i & EXT_MEM_ENABLE) |
| 2973 | add_debugfs_mem(adap, "mc", MEM_MC, | 2907 | add_debugfs_mem(adap, "mc", MEM_MC, |
| @@ -3419,7 +3353,7 @@ unsigned int cxgb4_dbfifo_count(const struct net_device *dev, int lpfifo) | |||
| 3419 | 3353 | ||
| 3420 | v1 = t4_read_reg(adap, A_SGE_DBFIFO_STATUS); | 3354 | v1 = t4_read_reg(adap, A_SGE_DBFIFO_STATUS); |
| 3421 | v2 = t4_read_reg(adap, SGE_DBFIFO_STATUS2); | 3355 | v2 = t4_read_reg(adap, SGE_DBFIFO_STATUS2); |
| 3422 | if (is_t4(adap->chip)) { | 3356 | if (is_t4(adap->params.chip)) { |
| 3423 | lp_count = G_LP_COUNT(v1); | 3357 | lp_count = G_LP_COUNT(v1); |
| 3424 | hp_count = G_HP_COUNT(v1); | 3358 | hp_count = G_HP_COUNT(v1); |
| 3425 | } else { | 3359 | } else { |
| @@ -3588,7 +3522,7 @@ static void drain_db_fifo(struct adapter *adap, int usecs) | |||
| 3588 | do { | 3522 | do { |
| 3589 | v1 = t4_read_reg(adap, A_SGE_DBFIFO_STATUS); | 3523 | v1 = t4_read_reg(adap, A_SGE_DBFIFO_STATUS); |
| 3590 | v2 = t4_read_reg(adap, SGE_DBFIFO_STATUS2); | 3524 | v2 = t4_read_reg(adap, SGE_DBFIFO_STATUS2); |
| 3591 | if (is_t4(adap->chip)) { | 3525 | if (is_t4(adap->params.chip)) { |
| 3592 | lp_count = G_LP_COUNT(v1); | 3526 | lp_count = G_LP_COUNT(v1); |
| 3593 | hp_count = G_HP_COUNT(v1); | 3527 | hp_count = G_HP_COUNT(v1); |
| 3594 | } else { | 3528 | } else { |
| @@ -3708,7 +3642,7 @@ static void process_db_drop(struct work_struct *work) | |||
| 3708 | 3642 | ||
| 3709 | adap = container_of(work, struct adapter, db_drop_task); | 3643 | adap = container_of(work, struct adapter, db_drop_task); |
| 3710 | 3644 | ||
| 3711 | if (is_t4(adap->chip)) { | 3645 | if (is_t4(adap->params.chip)) { |
| 3712 | disable_dbs(adap); | 3646 | disable_dbs(adap); |
| 3713 | notify_rdma_uld(adap, CXGB4_CONTROL_DB_DROP); | 3647 | notify_rdma_uld(adap, CXGB4_CONTROL_DB_DROP); |
| 3714 | drain_db_fifo(adap, 1); | 3648 | drain_db_fifo(adap, 1); |
| @@ -3753,7 +3687,7 @@ static void process_db_drop(struct work_struct *work) | |||
| 3753 | 3687 | ||
| 3754 | void t4_db_full(struct adapter *adap) | 3688 | void t4_db_full(struct adapter *adap) |
| 3755 | { | 3689 | { |
| 3756 | if (is_t4(adap->chip)) { | 3690 | if (is_t4(adap->params.chip)) { |
| 3757 | t4_set_reg_field(adap, SGE_INT_ENABLE3, | 3691 | t4_set_reg_field(adap, SGE_INT_ENABLE3, |
| 3758 | DBFIFO_HP_INT | DBFIFO_LP_INT, 0); | 3692 | DBFIFO_HP_INT | DBFIFO_LP_INT, 0); |
| 3759 | queue_work(workq, &adap->db_full_task); | 3693 | queue_work(workq, &adap->db_full_task); |
| @@ -3762,7 +3696,7 @@ void t4_db_full(struct adapter *adap) | |||
| 3762 | 3696 | ||
| 3763 | void t4_db_dropped(struct adapter *adap) | 3697 | void t4_db_dropped(struct adapter *adap) |
| 3764 | { | 3698 | { |
| 3765 | if (is_t4(adap->chip)) | 3699 | if (is_t4(adap->params.chip)) |
| 3766 | queue_work(workq, &adap->db_drop_task); | 3700 | queue_work(workq, &adap->db_drop_task); |
| 3767 | } | 3701 | } |
| 3768 | 3702 | ||
| @@ -3789,7 +3723,7 @@ static void uld_attach(struct adapter *adap, unsigned int uld) | |||
| 3789 | lli.nchan = adap->params.nports; | 3723 | lli.nchan = adap->params.nports; |
| 3790 | lli.nports = adap->params.nports; | 3724 | lli.nports = adap->params.nports; |
| 3791 | lli.wr_cred = adap->params.ofldq_wr_cred; | 3725 | lli.wr_cred = adap->params.ofldq_wr_cred; |
| 3792 | lli.adapter_type = adap->params.rev; | 3726 | lli.adapter_type = adap->params.chip; |
| 3793 | lli.iscsi_iolen = MAXRXDATA_GET(t4_read_reg(adap, TP_PARA_REG2)); | 3727 | lli.iscsi_iolen = MAXRXDATA_GET(t4_read_reg(adap, TP_PARA_REG2)); |
| 3794 | lli.udb_density = 1 << QUEUESPERPAGEPF0_GET( | 3728 | lli.udb_density = 1 << QUEUESPERPAGEPF0_GET( |
| 3795 | t4_read_reg(adap, SGE_EGRESS_QUEUES_PER_PAGE_PF) >> | 3729 | t4_read_reg(adap, SGE_EGRESS_QUEUES_PER_PAGE_PF) >> |
| @@ -4483,7 +4417,7 @@ static void setup_memwin(struct adapter *adap) | |||
| 4483 | u32 bar0, mem_win0_base, mem_win1_base, mem_win2_base; | 4417 | u32 bar0, mem_win0_base, mem_win1_base, mem_win2_base; |
| 4484 | 4418 | ||
| 4485 | bar0 = pci_resource_start(adap->pdev, 0); /* truncation intentional */ | 4419 | bar0 = pci_resource_start(adap->pdev, 0); /* truncation intentional */ |
| 4486 | if (is_t4(adap->chip)) { | 4420 | if (is_t4(adap->params.chip)) { |
| 4487 | mem_win0_base = bar0 + MEMWIN0_BASE; | 4421 | mem_win0_base = bar0 + MEMWIN0_BASE; |
| 4488 | mem_win1_base = bar0 + MEMWIN1_BASE; | 4422 | mem_win1_base = bar0 + MEMWIN1_BASE; |
| 4489 | mem_win2_base = bar0 + MEMWIN2_BASE; | 4423 | mem_win2_base = bar0 + MEMWIN2_BASE; |
| @@ -4668,8 +4602,10 @@ static int adap_init0_config(struct adapter *adapter, int reset) | |||
| 4668 | const struct firmware *cf; | 4602 | const struct firmware *cf; |
| 4669 | unsigned long mtype = 0, maddr = 0; | 4603 | unsigned long mtype = 0, maddr = 0; |
| 4670 | u32 finiver, finicsum, cfcsum; | 4604 | u32 finiver, finicsum, cfcsum; |
| 4671 | int ret, using_flash; | 4605 | int ret; |
| 4606 | int config_issued = 0; | ||
| 4672 | char *fw_config_file, fw_config_file_path[256]; | 4607 | char *fw_config_file, fw_config_file_path[256]; |
| 4608 | char *config_name = NULL; | ||
| 4673 | 4609 | ||
| 4674 | /* | 4610 | /* |
| 4675 | * Reset device if necessary. | 4611 | * Reset device if necessary. |
| @@ -4686,9 +4622,9 @@ static int adap_init0_config(struct adapter *adapter, int reset) | |||
| 4686 | * then use that. Otherwise, use the configuration file stored | 4622 | * then use that. Otherwise, use the configuration file stored |
| 4687 | * in the adapter flash ... | 4623 | * in the adapter flash ... |
| 4688 | */ | 4624 | */ |
| 4689 | switch (CHELSIO_CHIP_VERSION(adapter->chip)) { | 4625 | switch (CHELSIO_CHIP_VERSION(adapter->params.chip)) { |
| 4690 | case CHELSIO_T4: | 4626 | case CHELSIO_T4: |
| 4691 | fw_config_file = FW_CFNAME; | 4627 | fw_config_file = FW4_CFNAME; |
| 4692 | break; | 4628 | break; |
| 4693 | case CHELSIO_T5: | 4629 | case CHELSIO_T5: |
| 4694 | fw_config_file = FW5_CFNAME; | 4630 | fw_config_file = FW5_CFNAME; |
| @@ -4702,13 +4638,16 @@ static int adap_init0_config(struct adapter *adapter, int reset) | |||
| 4702 | 4638 | ||
| 4703 | ret = request_firmware(&cf, fw_config_file, adapter->pdev_dev); | 4639 | ret = request_firmware(&cf, fw_config_file, adapter->pdev_dev); |
| 4704 | if (ret < 0) { | 4640 | if (ret < 0) { |
| 4705 | using_flash = 1; | 4641 | config_name = "On FLASH"; |
| 4706 | mtype = FW_MEMTYPE_CF_FLASH; | 4642 | mtype = FW_MEMTYPE_CF_FLASH; |
| 4707 | maddr = t4_flash_cfg_addr(adapter); | 4643 | maddr = t4_flash_cfg_addr(adapter); |
| 4708 | } else { | 4644 | } else { |
| 4709 | u32 params[7], val[7]; | 4645 | u32 params[7], val[7]; |
| 4710 | 4646 | ||
| 4711 | using_flash = 0; | 4647 | sprintf(fw_config_file_path, |
| 4648 | "/lib/firmware/%s", fw_config_file); | ||
| 4649 | config_name = fw_config_file_path; | ||
| 4650 | |||
| 4712 | if (cf->size >= FLASH_CFG_MAX_SIZE) | 4651 | if (cf->size >= FLASH_CFG_MAX_SIZE) |
| 4713 | ret = -ENOMEM; | 4652 | ret = -ENOMEM; |
| 4714 | else { | 4653 | else { |
| @@ -4776,6 +4715,26 @@ static int adap_init0_config(struct adapter *adapter, int reset) | |||
| 4776 | FW_LEN16(caps_cmd)); | 4715 | FW_LEN16(caps_cmd)); |
| 4777 | ret = t4_wr_mbox(adapter, adapter->mbox, &caps_cmd, sizeof(caps_cmd), | 4716 | ret = t4_wr_mbox(adapter, adapter->mbox, &caps_cmd, sizeof(caps_cmd), |
| 4778 | &caps_cmd); | 4717 | &caps_cmd); |
| 4718 | |||
| 4719 | /* If the CAPS_CONFIG failed with an ENOENT (for a Firmware | ||
| 4720 | * Configuration File in FLASH), our last gasp effort is to use the | ||
| 4721 | * Firmware Configuration File which is embedded in the firmware. A | ||
| 4722 | * very few early versions of the firmware didn't have one embedded | ||
| 4723 | * but we can ignore those. | ||
| 4724 | */ | ||
| 4725 | if (ret == -ENOENT) { | ||
| 4726 | memset(&caps_cmd, 0, sizeof(caps_cmd)); | ||
| 4727 | caps_cmd.op_to_write = | ||
| 4728 | htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) | | ||
| 4729 | FW_CMD_REQUEST | | ||
| 4730 | FW_CMD_READ); | ||
| 4731 | caps_cmd.cfvalid_to_len16 = htonl(FW_LEN16(caps_cmd)); | ||
| 4732 | ret = t4_wr_mbox(adapter, adapter->mbox, &caps_cmd, | ||
| 4733 | sizeof(caps_cmd), &caps_cmd); | ||
| 4734 | config_name = "Firmware Default"; | ||
| 4735 | } | ||
| 4736 | |||
| 4737 | config_issued = 1; | ||
| 4779 | if (ret < 0) | 4738 | if (ret < 0) |
| 4780 | goto bye; | 4739 | goto bye; |
| 4781 | 4740 | ||
| @@ -4816,7 +4775,6 @@ static int adap_init0_config(struct adapter *adapter, int reset) | |||
| 4816 | if (ret < 0) | 4775 | if (ret < 0) |
| 4817 | goto bye; | 4776 | goto bye; |
| 4818 | 4777 | ||
| 4819 | sprintf(fw_config_file_path, "/lib/firmware/%s", fw_config_file); | ||
| 4820 | /* | 4778 | /* |
| 4821 | * Return successfully and note that we're operating with parameters | 4779 | * Return successfully and note that we're operating with parameters |
| 4822 | * not supplied by the driver, rather than from hard-wired | 4780 | * not supplied by the driver, rather than from hard-wired |
| @@ -4824,11 +4782,8 @@ static int adap_init0_config(struct adapter *adapter, int reset) | |||
| 4824 | */ | 4782 | */ |
| 4825 | adapter->flags |= USING_SOFT_PARAMS; | 4783 | adapter->flags |= USING_SOFT_PARAMS; |
| 4826 | dev_info(adapter->pdev_dev, "Successfully configured using Firmware "\ | 4784 | dev_info(adapter->pdev_dev, "Successfully configured using Firmware "\ |
| 4827 | "Configuration File %s, version %#x, computed checksum %#x\n", | 4785 | "Configuration File \"%s\", version %#x, computed checksum %#x\n", |
| 4828 | (using_flash | 4786 | config_name, finiver, cfcsum); |
| 4829 | ? "in device FLASH" | ||
| 4830 | : fw_config_file_path), | ||
| 4831 | finiver, cfcsum); | ||
| 4832 | return 0; | 4787 | return 0; |
| 4833 | 4788 | ||
| 4834 | /* | 4789 | /* |
| @@ -4837,9 +4792,9 @@ static int adap_init0_config(struct adapter *adapter, int reset) | |||
| 4837 | * want to issue a warning since this is fairly common.) | 4792 | * want to issue a warning since this is fairly common.) |
| 4838 | */ | 4793 | */ |
| 4839 | bye: | 4794 | bye: |
| 4840 | if (ret != -ENOENT) | 4795 | if (config_issued && ret != -ENOENT) |
| 4841 | dev_warn(adapter->pdev_dev, "Configuration file error %d\n", | 4796 | dev_warn(adapter->pdev_dev, "\"%s\" configuration file error %d\n", |
| 4842 | -ret); | 4797 | config_name, -ret); |
| 4843 | return ret; | 4798 | return ret; |
| 4844 | } | 4799 | } |
| 4845 | 4800 | ||
| @@ -5086,6 +5041,47 @@ bye: | |||
| 5086 | return ret; | 5041 | return ret; |
| 5087 | } | 5042 | } |
| 5088 | 5043 | ||
| 5044 | static struct fw_info fw_info_array[] = { | ||
| 5045 | { | ||
| 5046 | .chip = CHELSIO_T4, | ||
| 5047 | .fs_name = FW4_CFNAME, | ||
| 5048 | .fw_mod_name = FW4_FNAME, | ||
| 5049 | .fw_hdr = { | ||
| 5050 | .chip = FW_HDR_CHIP_T4, | ||
| 5051 | .fw_ver = __cpu_to_be32(FW_VERSION(T4)), | ||
| 5052 | .intfver_nic = FW_INTFVER(T4, NIC), | ||
| 5053 | .intfver_vnic = FW_INTFVER(T4, VNIC), | ||
| 5054 | .intfver_ri = FW_INTFVER(T4, RI), | ||
| 5055 | .intfver_iscsi = FW_INTFVER(T4, ISCSI), | ||
| 5056 | .intfver_fcoe = FW_INTFVER(T4, FCOE), | ||
| 5057 | }, | ||
| 5058 | }, { | ||
| 5059 | .chip = CHELSIO_T5, | ||
| 5060 | .fs_name = FW5_CFNAME, | ||
| 5061 | .fw_mod_name = FW5_FNAME, | ||
| 5062 | .fw_hdr = { | ||
| 5063 | .chip = FW_HDR_CHIP_T5, | ||
| 5064 | .fw_ver = __cpu_to_be32(FW_VERSION(T5)), | ||
| 5065 | .intfver_nic = FW_INTFVER(T5, NIC), | ||
| 5066 | .intfver_vnic = FW_INTFVER(T5, VNIC), | ||
| 5067 | .intfver_ri = FW_INTFVER(T5, RI), | ||
| 5068 | .intfver_iscsi = FW_INTFVER(T5, ISCSI), | ||
| 5069 | .intfver_fcoe = FW_INTFVER(T5, FCOE), | ||
| 5070 | }, | ||
| 5071 | } | ||
| 5072 | }; | ||
| 5073 | |||
| 5074 | static struct fw_info *find_fw_info(int chip) | ||
| 5075 | { | ||
| 5076 | int i; | ||
| 5077 | |||
| 5078 | for (i = 0; i < ARRAY_SIZE(fw_info_array); i++) { | ||
| 5079 | if (fw_info_array[i].chip == chip) | ||
| 5080 | return &fw_info_array[i]; | ||
| 5081 | } | ||
| 5082 | return NULL; | ||
| 5083 | } | ||
| 5084 | |||
| 5089 | /* | 5085 | /* |
| 5090 | * Phase 0 of initialization: contact FW, obtain config, perform basic init. | 5086 | * Phase 0 of initialization: contact FW, obtain config, perform basic init. |
| 5091 | */ | 5087 | */ |
| @@ -5123,44 +5119,54 @@ static int adap_init0(struct adapter *adap) | |||
| 5123 | * later reporting and B. to warn if the currently loaded firmware | 5119 | * later reporting and B. to warn if the currently loaded firmware |
| 5124 | * is excessively mismatched relative to the driver.) | 5120 | * is excessively mismatched relative to the driver.) |
| 5125 | */ | 5121 | */ |
| 5126 | ret = t4_check_fw_version(adap); | 5122 | t4_get_fw_version(adap, &adap->params.fw_vers); |
| 5127 | 5123 | t4_get_tp_version(adap, &adap->params.tp_vers); | |
| 5128 | /* The error code -EFAULT is returned by t4_check_fw_version() if | ||
| 5129 | * firmware on adapter < supported firmware. If firmware on adapter | ||
| 5130 | * is too old (not supported by driver) and we're the MASTER_PF set | ||
| 5131 | * adapter state to DEV_STATE_UNINIT to force firmware upgrade | ||
| 5132 | * and reinitialization. | ||
| 5133 | */ | ||
| 5134 | if ((adap->flags & MASTER_PF) && ret == -EFAULT) | ||
| 5135 | state = DEV_STATE_UNINIT; | ||
| 5136 | if ((adap->flags & MASTER_PF) && state != DEV_STATE_INIT) { | 5124 | if ((adap->flags & MASTER_PF) && state != DEV_STATE_INIT) { |
| 5137 | if (ret == -EINVAL || ret == -EFAULT || ret > 0) { | 5125 | struct fw_info *fw_info; |
| 5138 | if (upgrade_fw(adap) >= 0) { | 5126 | struct fw_hdr *card_fw; |
| 5139 | /* | 5127 | const struct firmware *fw; |
| 5140 | * Note that the chip was reset as part of the | 5128 | const u8 *fw_data = NULL; |
| 5141 | * firmware upgrade so we don't reset it again | 5129 | unsigned int fw_size = 0; |
| 5142 | * below and grab the new firmware version. | 5130 | |
| 5143 | */ | 5131 | /* This is the firmware whose headers the driver was compiled |
| 5144 | reset = 0; | 5132 | * against |
| 5145 | ret = t4_check_fw_version(adap); | 5133 | */ |
| 5146 | } else | 5134 | fw_info = find_fw_info(CHELSIO_CHIP_VERSION(adap->params.chip)); |
| 5147 | if (ret == -EFAULT) { | 5135 | if (fw_info == NULL) { |
| 5148 | /* | 5136 | dev_err(adap->pdev_dev, |
| 5149 | * Firmware is old but still might | 5137 | "unable to get firmware info for chip %d.\n", |
| 5150 | * work if we force reinitialization | 5138 | CHELSIO_CHIP_VERSION(adap->params.chip)); |
| 5151 | * of the adapter. Ignoring FW upgrade | 5139 | return -EINVAL; |
| 5152 | * failure. | ||
| 5153 | */ | ||
| 5154 | dev_warn(adap->pdev_dev, | ||
| 5155 | "Ignoring firmware upgrade " | ||
| 5156 | "failure, and forcing driver " | ||
| 5157 | "to reinitialize the " | ||
| 5158 | "adapter.\n"); | ||
| 5159 | ret = 0; | ||
| 5160 | } | ||
| 5161 | } | 5140 | } |
| 5141 | |||
| 5142 | /* allocate memory to read the header of the firmware on the | ||
| 5143 | * card | ||
| 5144 | */ | ||
| 5145 | card_fw = t4_alloc_mem(sizeof(*card_fw)); | ||
| 5146 | |||
| 5147 | /* Get FW from from /lib/firmware/ */ | ||
| 5148 | ret = request_firmware(&fw, fw_info->fw_mod_name, | ||
| 5149 | adap->pdev_dev); | ||
| 5150 | if (ret < 0) { | ||
| 5151 | dev_err(adap->pdev_dev, | ||
| 5152 | "unable to load firmware image %s, error %d\n", | ||
| 5153 | fw_info->fw_mod_name, ret); | ||
| 5154 | } else { | ||
| 5155 | fw_data = fw->data; | ||
| 5156 | fw_size = fw->size; | ||
| 5157 | } | ||
| 5158 | |||
| 5159 | /* upgrade FW logic */ | ||
| 5160 | ret = t4_prep_fw(adap, fw_info, fw_data, fw_size, card_fw, | ||
| 5161 | state, &reset); | ||
| 5162 | |||
| 5163 | /* Cleaning up */ | ||
| 5164 | if (fw != NULL) | ||
| 5165 | release_firmware(fw); | ||
| 5166 | t4_free_mem(card_fw); | ||
| 5167 | |||
| 5162 | if (ret < 0) | 5168 | if (ret < 0) |
| 5163 | return ret; | 5169 | goto bye; |
| 5164 | } | 5170 | } |
| 5165 | 5171 | ||
| 5166 | /* | 5172 | /* |
| @@ -5245,7 +5251,7 @@ static int adap_init0(struct adapter *adap) | |||
| 5245 | if (ret == -ENOENT) { | 5251 | if (ret == -ENOENT) { |
| 5246 | dev_info(adap->pdev_dev, | 5252 | dev_info(adap->pdev_dev, |
| 5247 | "No Configuration File present " | 5253 | "No Configuration File present " |
| 5248 | "on adapter. Using hard-wired " | 5254 | "on adapter. Using hard-wired " |
| 5249 | "configuration parameters.\n"); | 5255 | "configuration parameters.\n"); |
| 5250 | ret = adap_init0_no_config(adap, reset); | 5256 | ret = adap_init0_no_config(adap, reset); |
| 5251 | } | 5257 | } |
| @@ -5787,7 +5793,7 @@ static void print_port_info(const struct net_device *dev) | |||
| 5787 | 5793 | ||
| 5788 | netdev_info(dev, "Chelsio %s rev %d %s %sNIC PCIe x%d%s%s\n", | 5794 | netdev_info(dev, "Chelsio %s rev %d %s %sNIC PCIe x%d%s%s\n", |
| 5789 | adap->params.vpd.id, | 5795 | adap->params.vpd.id, |
| 5790 | CHELSIO_CHIP_RELEASE(adap->params.rev), buf, | 5796 | CHELSIO_CHIP_RELEASE(adap->params.chip), buf, |
| 5791 | is_offload(adap) ? "R" : "", adap->params.pci.width, spd, | 5797 | is_offload(adap) ? "R" : "", adap->params.pci.width, spd, |
| 5792 | (adap->flags & USING_MSIX) ? " MSI-X" : | 5798 | (adap->flags & USING_MSIX) ? " MSI-X" : |
| 5793 | (adap->flags & USING_MSI) ? " MSI" : ""); | 5799 | (adap->flags & USING_MSI) ? " MSI" : ""); |
| @@ -5910,7 +5916,7 @@ static int init_one(struct pci_dev *pdev, const struct pci_device_id *ent) | |||
| 5910 | if (err) | 5916 | if (err) |
| 5911 | goto out_unmap_bar0; | 5917 | goto out_unmap_bar0; |
| 5912 | 5918 | ||
| 5913 | if (!is_t4(adapter->chip)) { | 5919 | if (!is_t4(adapter->params.chip)) { |
| 5914 | s_qpp = QUEUESPERPAGEPF1 * adapter->fn; | 5920 | s_qpp = QUEUESPERPAGEPF1 * adapter->fn; |
| 5915 | qpp = 1 << QUEUESPERPAGEPF0_GET(t4_read_reg(adapter, | 5921 | qpp = 1 << QUEUESPERPAGEPF0_GET(t4_read_reg(adapter, |
| 5916 | SGE_EGRESS_QUEUES_PER_PAGE_PF) >> s_qpp); | 5922 | SGE_EGRESS_QUEUES_PER_PAGE_PF) >> s_qpp); |
| @@ -6064,7 +6070,7 @@ sriov: | |||
| 6064 | out_free_dev: | 6070 | out_free_dev: |
| 6065 | free_some_resources(adapter); | 6071 | free_some_resources(adapter); |
| 6066 | out_unmap_bar: | 6072 | out_unmap_bar: |
| 6067 | if (!is_t4(adapter->chip)) | 6073 | if (!is_t4(adapter->params.chip)) |
| 6068 | iounmap(adapter->bar2); | 6074 | iounmap(adapter->bar2); |
| 6069 | out_unmap_bar0: | 6075 | out_unmap_bar0: |
| 6070 | iounmap(adapter->regs); | 6076 | iounmap(adapter->regs); |
| @@ -6116,7 +6122,7 @@ static void remove_one(struct pci_dev *pdev) | |||
| 6116 | 6122 | ||
| 6117 | free_some_resources(adapter); | 6123 | free_some_resources(adapter); |
| 6118 | iounmap(adapter->regs); | 6124 | iounmap(adapter->regs); |
| 6119 | if (!is_t4(adapter->chip)) | 6125 | if (!is_t4(adapter->params.chip)) |
| 6120 | iounmap(adapter->bar2); | 6126 | iounmap(adapter->bar2); |
| 6121 | kfree(adapter); | 6127 | kfree(adapter); |
| 6122 | pci_disable_pcie_error_reporting(pdev); | 6128 | pci_disable_pcie_error_reporting(pdev); |
diff --git a/drivers/net/ethernet/chelsio/cxgb4/sge.c b/drivers/net/ethernet/chelsio/cxgb4/sge.c index ac311f5f3eb9..cc380c36e1a8 100644 --- a/drivers/net/ethernet/chelsio/cxgb4/sge.c +++ b/drivers/net/ethernet/chelsio/cxgb4/sge.c | |||
| @@ -509,7 +509,7 @@ static inline void ring_fl_db(struct adapter *adap, struct sge_fl *q) | |||
| 509 | u32 val; | 509 | u32 val; |
| 510 | if (q->pend_cred >= 8) { | 510 | if (q->pend_cred >= 8) { |
| 511 | val = PIDX(q->pend_cred / 8); | 511 | val = PIDX(q->pend_cred / 8); |
| 512 | if (!is_t4(adap->chip)) | 512 | if (!is_t4(adap->params.chip)) |
| 513 | val |= DBTYPE(1); | 513 | val |= DBTYPE(1); |
| 514 | wmb(); | 514 | wmb(); |
| 515 | t4_write_reg(adap, MYPF_REG(SGE_PF_KDOORBELL), DBPRIO(1) | | 515 | t4_write_reg(adap, MYPF_REG(SGE_PF_KDOORBELL), DBPRIO(1) | |
| @@ -847,7 +847,7 @@ static inline void ring_tx_db(struct adapter *adap, struct sge_txq *q, int n) | |||
| 847 | wmb(); /* write descriptors before telling HW */ | 847 | wmb(); /* write descriptors before telling HW */ |
| 848 | spin_lock(&q->db_lock); | 848 | spin_lock(&q->db_lock); |
| 849 | if (!q->db_disabled) { | 849 | if (!q->db_disabled) { |
| 850 | if (is_t4(adap->chip)) { | 850 | if (is_t4(adap->params.chip)) { |
| 851 | t4_write_reg(adap, MYPF_REG(SGE_PF_KDOORBELL), | 851 | t4_write_reg(adap, MYPF_REG(SGE_PF_KDOORBELL), |
| 852 | QID(q->cntxt_id) | PIDX(n)); | 852 | QID(q->cntxt_id) | PIDX(n)); |
| 853 | } else { | 853 | } else { |
| @@ -1596,7 +1596,7 @@ static noinline int handle_trace_pkt(struct adapter *adap, | |||
| 1596 | return 0; | 1596 | return 0; |
| 1597 | } | 1597 | } |
| 1598 | 1598 | ||
| 1599 | if (is_t4(adap->chip)) | 1599 | if (is_t4(adap->params.chip)) |
| 1600 | __skb_pull(skb, sizeof(struct cpl_trace_pkt)); | 1600 | __skb_pull(skb, sizeof(struct cpl_trace_pkt)); |
| 1601 | else | 1601 | else |
| 1602 | __skb_pull(skb, sizeof(struct cpl_t5_trace_pkt)); | 1602 | __skb_pull(skb, sizeof(struct cpl_t5_trace_pkt)); |
| @@ -1661,7 +1661,7 @@ int t4_ethrx_handler(struct sge_rspq *q, const __be64 *rsp, | |||
| 1661 | const struct cpl_rx_pkt *pkt; | 1661 | const struct cpl_rx_pkt *pkt; |
| 1662 | struct sge_eth_rxq *rxq = container_of(q, struct sge_eth_rxq, rspq); | 1662 | struct sge_eth_rxq *rxq = container_of(q, struct sge_eth_rxq, rspq); |
| 1663 | struct sge *s = &q->adap->sge; | 1663 | struct sge *s = &q->adap->sge; |
| 1664 | int cpl_trace_pkt = is_t4(q->adap->chip) ? | 1664 | int cpl_trace_pkt = is_t4(q->adap->params.chip) ? |
| 1665 | CPL_TRACE_PKT : CPL_TRACE_PKT_T5; | 1665 | CPL_TRACE_PKT : CPL_TRACE_PKT_T5; |
| 1666 | 1666 | ||
| 1667 | if (unlikely(*(u8 *)rsp == cpl_trace_pkt)) | 1667 | if (unlikely(*(u8 *)rsp == cpl_trace_pkt)) |
| @@ -2182,7 +2182,7 @@ err: | |||
| 2182 | static void init_txq(struct adapter *adap, struct sge_txq *q, unsigned int id) | 2182 | static void init_txq(struct adapter *adap, struct sge_txq *q, unsigned int id) |
| 2183 | { | 2183 | { |
| 2184 | q->cntxt_id = id; | 2184 | q->cntxt_id = id; |
| 2185 | if (!is_t4(adap->chip)) { | 2185 | if (!is_t4(adap->params.chip)) { |
| 2186 | unsigned int s_qpp; | 2186 | unsigned int s_qpp; |
| 2187 | unsigned short udb_density; | 2187 | unsigned short udb_density; |
| 2188 | unsigned long qpshift; | 2188 | unsigned long qpshift; |
| @@ -2641,7 +2641,7 @@ static int t4_sge_init_hard(struct adapter *adap) | |||
| 2641 | * Set up to drop DOORBELL writes when the DOORBELL FIFO overflows | 2641 | * Set up to drop DOORBELL writes when the DOORBELL FIFO overflows |
| 2642 | * and generate an interrupt when this occurs so we can recover. | 2642 | * and generate an interrupt when this occurs so we can recover. |
| 2643 | */ | 2643 | */ |
| 2644 | if (is_t4(adap->chip)) { | 2644 | if (is_t4(adap->params.chip)) { |
| 2645 | t4_set_reg_field(adap, A_SGE_DBFIFO_STATUS, | 2645 | t4_set_reg_field(adap, A_SGE_DBFIFO_STATUS, |
| 2646 | V_HP_INT_THRESH(M_HP_INT_THRESH) | | 2646 | V_HP_INT_THRESH(M_HP_INT_THRESH) | |
| 2647 | V_LP_INT_THRESH(M_LP_INT_THRESH), | 2647 | V_LP_INT_THRESH(M_LP_INT_THRESH), |
diff --git a/drivers/net/ethernet/chelsio/cxgb4/t4_hw.c b/drivers/net/ethernet/chelsio/cxgb4/t4_hw.c index 4cbb2f9850be..74a6fce5a15a 100644 --- a/drivers/net/ethernet/chelsio/cxgb4/t4_hw.c +++ b/drivers/net/ethernet/chelsio/cxgb4/t4_hw.c | |||
| @@ -296,7 +296,7 @@ int t4_mc_read(struct adapter *adap, int idx, u32 addr, __be32 *data, u64 *ecc) | |||
| 296 | u32 mc_bist_cmd, mc_bist_cmd_addr, mc_bist_cmd_len; | 296 | u32 mc_bist_cmd, mc_bist_cmd_addr, mc_bist_cmd_len; |
| 297 | u32 mc_bist_status_rdata, mc_bist_data_pattern; | 297 | u32 mc_bist_status_rdata, mc_bist_data_pattern; |
| 298 | 298 | ||
| 299 | if (is_t4(adap->chip)) { | 299 | if (is_t4(adap->params.chip)) { |
| 300 | mc_bist_cmd = MC_BIST_CMD; | 300 | mc_bist_cmd = MC_BIST_CMD; |
| 301 | mc_bist_cmd_addr = MC_BIST_CMD_ADDR; | 301 | mc_bist_cmd_addr = MC_BIST_CMD_ADDR; |
| 302 | mc_bist_cmd_len = MC_BIST_CMD_LEN; | 302 | mc_bist_cmd_len = MC_BIST_CMD_LEN; |
| @@ -349,7 +349,7 @@ int t4_edc_read(struct adapter *adap, int idx, u32 addr, __be32 *data, u64 *ecc) | |||
| 349 | u32 edc_bist_cmd, edc_bist_cmd_addr, edc_bist_cmd_len; | 349 | u32 edc_bist_cmd, edc_bist_cmd_addr, edc_bist_cmd_len; |
| 350 | u32 edc_bist_cmd_data_pattern, edc_bist_status_rdata; | 350 | u32 edc_bist_cmd_data_pattern, edc_bist_status_rdata; |
| 351 | 351 | ||
| 352 | if (is_t4(adap->chip)) { | 352 | if (is_t4(adap->params.chip)) { |
| 353 | edc_bist_cmd = EDC_REG(EDC_BIST_CMD, idx); | 353 | edc_bist_cmd = EDC_REG(EDC_BIST_CMD, idx); |
| 354 | edc_bist_cmd_addr = EDC_REG(EDC_BIST_CMD_ADDR, idx); | 354 | edc_bist_cmd_addr = EDC_REG(EDC_BIST_CMD_ADDR, idx); |
| 355 | edc_bist_cmd_len = EDC_REG(EDC_BIST_CMD_LEN, idx); | 355 | edc_bist_cmd_len = EDC_REG(EDC_BIST_CMD_LEN, idx); |
| @@ -402,7 +402,7 @@ int t4_edc_read(struct adapter *adap, int idx, u32 addr, __be32 *data, u64 *ecc) | |||
| 402 | static int t4_mem_win_rw(struct adapter *adap, u32 addr, __be32 *data, int dir) | 402 | static int t4_mem_win_rw(struct adapter *adap, u32 addr, __be32 *data, int dir) |
| 403 | { | 403 | { |
| 404 | int i; | 404 | int i; |
| 405 | u32 win_pf = is_t4(adap->chip) ? 0 : V_PFNUM(adap->fn); | 405 | u32 win_pf = is_t4(adap->params.chip) ? 0 : V_PFNUM(adap->fn); |
| 406 | 406 | ||
| 407 | /* | 407 | /* |
| 408 | * Setup offset into PCIE memory window. Address must be a | 408 | * Setup offset into PCIE memory window. Address must be a |
| @@ -863,104 +863,169 @@ unlock: | |||
| 863 | } | 863 | } |
| 864 | 864 | ||
| 865 | /** | 865 | /** |
| 866 | * get_fw_version - read the firmware version | 866 | * t4_get_fw_version - read the firmware version |
| 867 | * @adapter: the adapter | 867 | * @adapter: the adapter |
| 868 | * @vers: where to place the version | 868 | * @vers: where to place the version |
| 869 | * | 869 | * |
| 870 | * Reads the FW version from flash. | 870 | * Reads the FW version from flash. |
| 871 | */ | 871 | */ |
| 872 | static int get_fw_version(struct adapter *adapter, u32 *vers) | 872 | int t4_get_fw_version(struct adapter *adapter, u32 *vers) |
| 873 | { | 873 | { |
| 874 | return t4_read_flash(adapter, adapter->params.sf_fw_start + | 874 | return t4_read_flash(adapter, FLASH_FW_START + |
| 875 | offsetof(struct fw_hdr, fw_ver), 1, vers, 0); | 875 | offsetof(struct fw_hdr, fw_ver), 1, |
| 876 | vers, 0); | ||
| 876 | } | 877 | } |
| 877 | 878 | ||
| 878 | /** | 879 | /** |
| 879 | * get_tp_version - read the TP microcode version | 880 | * t4_get_tp_version - read the TP microcode version |
| 880 | * @adapter: the adapter | 881 | * @adapter: the adapter |
| 881 | * @vers: where to place the version | 882 | * @vers: where to place the version |
| 882 | * | 883 | * |
| 883 | * Reads the TP microcode version from flash. | 884 | * Reads the TP microcode version from flash. |
| 884 | */ | 885 | */ |
| 885 | static int get_tp_version(struct adapter *adapter, u32 *vers) | 886 | int t4_get_tp_version(struct adapter *adapter, u32 *vers) |
| 886 | { | 887 | { |
| 887 | return t4_read_flash(adapter, adapter->params.sf_fw_start + | 888 | return t4_read_flash(adapter, FLASH_FW_START + |
| 888 | offsetof(struct fw_hdr, tp_microcode_ver), | 889 | offsetof(struct fw_hdr, tp_microcode_ver), |
| 889 | 1, vers, 0); | 890 | 1, vers, 0); |
| 890 | } | 891 | } |
| 891 | 892 | ||
| 892 | /** | 893 | /* Is the given firmware API compatible with the one the driver was compiled |
| 893 | * t4_check_fw_version - check if the FW is compatible with this driver | 894 | * with? |
| 894 | * @adapter: the adapter | ||
| 895 | * | ||
| 896 | * Checks if an adapter's FW is compatible with the driver. Returns 0 | ||
| 897 | * if there's exact match, a negative error if the version could not be | ||
| 898 | * read or there's a major version mismatch, and a positive value if the | ||
| 899 | * expected major version is found but there's a minor version mismatch. | ||
| 900 | */ | 895 | */ |
| 901 | int t4_check_fw_version(struct adapter *adapter) | 896 | static int fw_compatible(const struct fw_hdr *hdr1, const struct fw_hdr *hdr2) |
| 902 | { | 897 | { |
| 903 | u32 api_vers[2]; | ||
| 904 | int ret, major, minor, micro; | ||
| 905 | int exp_major, exp_minor, exp_micro; | ||
| 906 | 898 | ||
| 907 | ret = get_fw_version(adapter, &adapter->params.fw_vers); | 899 | /* short circuit if it's the exact same firmware version */ |
| 908 | if (!ret) | 900 | if (hdr1->chip == hdr2->chip && hdr1->fw_ver == hdr2->fw_ver) |
| 909 | ret = get_tp_version(adapter, &adapter->params.tp_vers); | 901 | return 1; |
| 910 | if (!ret) | ||
| 911 | ret = t4_read_flash(adapter, adapter->params.sf_fw_start + | ||
| 912 | offsetof(struct fw_hdr, intfver_nic), | ||
| 913 | 2, api_vers, 1); | ||
| 914 | if (ret) | ||
| 915 | return ret; | ||
| 916 | 902 | ||
| 917 | major = FW_HDR_FW_VER_MAJOR_GET(adapter->params.fw_vers); | 903 | #define SAME_INTF(x) (hdr1->intfver_##x == hdr2->intfver_##x) |
| 918 | minor = FW_HDR_FW_VER_MINOR_GET(adapter->params.fw_vers); | 904 | if (hdr1->chip == hdr2->chip && SAME_INTF(nic) && SAME_INTF(vnic) && |
| 919 | micro = FW_HDR_FW_VER_MICRO_GET(adapter->params.fw_vers); | 905 | SAME_INTF(ri) && SAME_INTF(iscsi) && SAME_INTF(fcoe)) |
| 906 | return 1; | ||
| 907 | #undef SAME_INTF | ||
| 920 | 908 | ||
| 921 | switch (CHELSIO_CHIP_VERSION(adapter->chip)) { | 909 | return 0; |
| 922 | case CHELSIO_T4: | 910 | } |
| 923 | exp_major = FW_VERSION_MAJOR; | ||
| 924 | exp_minor = FW_VERSION_MINOR; | ||
| 925 | exp_micro = FW_VERSION_MICRO; | ||
| 926 | break; | ||
| 927 | case CHELSIO_T5: | ||
| 928 | exp_major = FW_VERSION_MAJOR_T5; | ||
| 929 | exp_minor = FW_VERSION_MINOR_T5; | ||
| 930 | exp_micro = FW_VERSION_MICRO_T5; | ||
| 931 | break; | ||
| 932 | default: | ||
| 933 | dev_err(adapter->pdev_dev, "Unsupported chip type, %x\n", | ||
| 934 | adapter->chip); | ||
| 935 | return -EINVAL; | ||
| 936 | } | ||
| 937 | 911 | ||
| 938 | memcpy(adapter->params.api_vers, api_vers, | 912 | /* The firmware in the filesystem is usable, but should it be installed? |
| 939 | sizeof(adapter->params.api_vers)); | 913 | * This routine explains itself in detail if it indicates the filesystem |
| 914 | * firmware should be installed. | ||
| 915 | */ | ||
| 916 | static int should_install_fs_fw(struct adapter *adap, int card_fw_usable, | ||
| 917 | int k, int c) | ||
| 918 | { | ||
| 919 | const char *reason; | ||
| 940 | 920 | ||
| 941 | if (major < exp_major || (major == exp_major && minor < exp_minor) || | 921 | if (!card_fw_usable) { |
| 942 | (major == exp_major && minor == exp_minor && micro < exp_micro)) { | 922 | reason = "incompatible or unusable"; |
| 943 | dev_err(adapter->pdev_dev, | 923 | goto install; |
| 944 | "Card has firmware version %u.%u.%u, minimum " | ||
| 945 | "supported firmware is %u.%u.%u.\n", major, minor, | ||
| 946 | micro, exp_major, exp_minor, exp_micro); | ||
| 947 | return -EFAULT; | ||
| 948 | } | 924 | } |
| 949 | 925 | ||
| 950 | if (major != exp_major) { /* major mismatch - fail */ | 926 | if (k > c) { |
| 951 | dev_err(adapter->pdev_dev, | 927 | reason = "older than the version supported with this driver"; |
| 952 | "card FW has major version %u, driver wants %u\n", | 928 | goto install; |
| 953 | major, exp_major); | ||
| 954 | return -EINVAL; | ||
| 955 | } | 929 | } |
| 956 | 930 | ||
| 957 | if (minor == exp_minor && micro == exp_micro) | 931 | return 0; |
| 958 | return 0; /* perfect match */ | 932 | |
| 933 | install: | ||
| 934 | dev_err(adap->pdev_dev, "firmware on card (%u.%u.%u.%u) is %s, " | ||
| 935 | "installing firmware %u.%u.%u.%u on card.\n", | ||
| 936 | FW_HDR_FW_VER_MAJOR_GET(c), FW_HDR_FW_VER_MINOR_GET(c), | ||
| 937 | FW_HDR_FW_VER_MICRO_GET(c), FW_HDR_FW_VER_BUILD_GET(c), reason, | ||
| 938 | FW_HDR_FW_VER_MAJOR_GET(k), FW_HDR_FW_VER_MINOR_GET(k), | ||
| 939 | FW_HDR_FW_VER_MICRO_GET(k), FW_HDR_FW_VER_BUILD_GET(k)); | ||
| 959 | 940 | ||
| 960 | /* Minor/micro version mismatch. Report it but often it's OK. */ | ||
| 961 | return 1; | 941 | return 1; |
| 962 | } | 942 | } |
| 963 | 943 | ||
| 944 | int t4_prep_fw(struct adapter *adap, struct fw_info *fw_info, | ||
| 945 | const u8 *fw_data, unsigned int fw_size, | ||
| 946 | struct fw_hdr *card_fw, enum dev_state state, | ||
| 947 | int *reset) | ||
| 948 | { | ||
| 949 | int ret, card_fw_usable, fs_fw_usable; | ||
| 950 | const struct fw_hdr *fs_fw; | ||
| 951 | const struct fw_hdr *drv_fw; | ||
| 952 | |||
| 953 | drv_fw = &fw_info->fw_hdr; | ||
| 954 | |||
| 955 | /* Read the header of the firmware on the card */ | ||
| 956 | ret = -t4_read_flash(adap, FLASH_FW_START, | ||
| 957 | sizeof(*card_fw) / sizeof(uint32_t), | ||
| 958 | (uint32_t *)card_fw, 1); | ||
| 959 | if (ret == 0) { | ||
| 960 | card_fw_usable = fw_compatible(drv_fw, (const void *)card_fw); | ||
| 961 | } else { | ||
| 962 | dev_err(adap->pdev_dev, | ||
| 963 | "Unable to read card's firmware header: %d\n", ret); | ||
| 964 | card_fw_usable = 0; | ||
| 965 | } | ||
| 966 | |||
| 967 | if (fw_data != NULL) { | ||
| 968 | fs_fw = (const void *)fw_data; | ||
| 969 | fs_fw_usable = fw_compatible(drv_fw, fs_fw); | ||
| 970 | } else { | ||
| 971 | fs_fw = NULL; | ||
| 972 | fs_fw_usable = 0; | ||
| 973 | } | ||
| 974 | |||
| 975 | if (card_fw_usable && card_fw->fw_ver == drv_fw->fw_ver && | ||
| 976 | (!fs_fw_usable || fs_fw->fw_ver == drv_fw->fw_ver)) { | ||
| 977 | /* Common case: the firmware on the card is an exact match and | ||
| 978 | * the filesystem one is an exact match too, or the filesystem | ||
| 979 | * one is absent/incompatible. | ||
| 980 | */ | ||
| 981 | } else if (fs_fw_usable && state == DEV_STATE_UNINIT && | ||
| 982 | should_install_fs_fw(adap, card_fw_usable, | ||
| 983 | be32_to_cpu(fs_fw->fw_ver), | ||
| 984 | be32_to_cpu(card_fw->fw_ver))) { | ||
| 985 | ret = -t4_fw_upgrade(adap, adap->mbox, fw_data, | ||
| 986 | fw_size, 0); | ||
| 987 | if (ret != 0) { | ||
| 988 | dev_err(adap->pdev_dev, | ||
| 989 | "failed to install firmware: %d\n", ret); | ||
| 990 | goto bye; | ||
| 991 | } | ||
| 992 | |||
| 993 | /* Installed successfully, update the cached header too. */ | ||
| 994 | memcpy(card_fw, fs_fw, sizeof(*card_fw)); | ||
| 995 | card_fw_usable = 1; | ||
| 996 | *reset = 0; /* already reset as part of load_fw */ | ||
| 997 | } | ||
| 998 | |||
| 999 | if (!card_fw_usable) { | ||
| 1000 | uint32_t d, c, k; | ||
| 1001 | |||
| 1002 | d = be32_to_cpu(drv_fw->fw_ver); | ||
| 1003 | c = be32_to_cpu(card_fw->fw_ver); | ||
| 1004 | k = fs_fw ? be32_to_cpu(fs_fw->fw_ver) : 0; | ||
| 1005 | |||
| 1006 | dev_err(adap->pdev_dev, "Cannot find a usable firmware: " | ||
| 1007 | "chip state %d, " | ||
| 1008 | "driver compiled with %d.%d.%d.%d, " | ||
| 1009 | "card has %d.%d.%d.%d, filesystem has %d.%d.%d.%d\n", | ||
| 1010 | state, | ||
| 1011 | FW_HDR_FW_VER_MAJOR_GET(d), FW_HDR_FW_VER_MINOR_GET(d), | ||
| 1012 | FW_HDR_FW_VER_MICRO_GET(d), FW_HDR_FW_VER_BUILD_GET(d), | ||
| 1013 | FW_HDR_FW_VER_MAJOR_GET(c), FW_HDR_FW_VER_MINOR_GET(c), | ||
| 1014 | FW_HDR_FW_VER_MICRO_GET(c), FW_HDR_FW_VER_BUILD_GET(c), | ||
| 1015 | FW_HDR_FW_VER_MAJOR_GET(k), FW_HDR_FW_VER_MINOR_GET(k), | ||
| 1016 | FW_HDR_FW_VER_MICRO_GET(k), FW_HDR_FW_VER_BUILD_GET(k)); | ||
| 1017 | ret = EINVAL; | ||
| 1018 | goto bye; | ||
| 1019 | } | ||
| 1020 | |||
| 1021 | /* We're using whatever's on the card and it's known to be good. */ | ||
| 1022 | adap->params.fw_vers = be32_to_cpu(card_fw->fw_ver); | ||
| 1023 | adap->params.tp_vers = be32_to_cpu(card_fw->tp_microcode_ver); | ||
| 1024 | |||
| 1025 | bye: | ||
| 1026 | return ret; | ||
| 1027 | } | ||
| 1028 | |||
| 964 | /** | 1029 | /** |
| 965 | * t4_flash_erase_sectors - erase a range of flash sectors | 1030 | * t4_flash_erase_sectors - erase a range of flash sectors |
| 966 | * @adapter: the adapter | 1031 | * @adapter: the adapter |
| @@ -1368,7 +1433,7 @@ static void pcie_intr_handler(struct adapter *adapter) | |||
| 1368 | PCIE_CORE_UTL_PCI_EXPRESS_PORT_STATUS, | 1433 | PCIE_CORE_UTL_PCI_EXPRESS_PORT_STATUS, |
| 1369 | pcie_port_intr_info) + | 1434 | pcie_port_intr_info) + |
| 1370 | t4_handle_intr_status(adapter, PCIE_INT_CAUSE, | 1435 | t4_handle_intr_status(adapter, PCIE_INT_CAUSE, |
| 1371 | is_t4(adapter->chip) ? | 1436 | is_t4(adapter->params.chip) ? |
| 1372 | pcie_intr_info : t5_pcie_intr_info); | 1437 | pcie_intr_info : t5_pcie_intr_info); |
| 1373 | 1438 | ||
| 1374 | if (fat) | 1439 | if (fat) |
| @@ -1782,7 +1847,7 @@ static void xgmac_intr_handler(struct adapter *adap, int port) | |||
| 1782 | { | 1847 | { |
| 1783 | u32 v, int_cause_reg; | 1848 | u32 v, int_cause_reg; |
| 1784 | 1849 | ||
| 1785 | if (is_t4(adap->chip)) | 1850 | if (is_t4(adap->params.chip)) |
| 1786 | int_cause_reg = PORT_REG(port, XGMAC_PORT_INT_CAUSE); | 1851 | int_cause_reg = PORT_REG(port, XGMAC_PORT_INT_CAUSE); |
| 1787 | else | 1852 | else |
| 1788 | int_cause_reg = T5_PORT_REG(port, MAC_PORT_INT_CAUSE); | 1853 | int_cause_reg = T5_PORT_REG(port, MAC_PORT_INT_CAUSE); |
| @@ -2250,7 +2315,7 @@ void t4_get_port_stats(struct adapter *adap, int idx, struct port_stats *p) | |||
| 2250 | 2315 | ||
| 2251 | #define GET_STAT(name) \ | 2316 | #define GET_STAT(name) \ |
| 2252 | t4_read_reg64(adap, \ | 2317 | t4_read_reg64(adap, \ |
| 2253 | (is_t4(adap->chip) ? PORT_REG(idx, MPS_PORT_STAT_##name##_L) : \ | 2318 | (is_t4(adap->params.chip) ? PORT_REG(idx, MPS_PORT_STAT_##name##_L) : \ |
| 2254 | T5_PORT_REG(idx, MPS_PORT_STAT_##name##_L))) | 2319 | T5_PORT_REG(idx, MPS_PORT_STAT_##name##_L))) |
| 2255 | #define GET_STAT_COM(name) t4_read_reg64(adap, MPS_STAT_##name##_L) | 2320 | #define GET_STAT_COM(name) t4_read_reg64(adap, MPS_STAT_##name##_L) |
| 2256 | 2321 | ||
| @@ -2332,7 +2397,7 @@ void t4_wol_magic_enable(struct adapter *adap, unsigned int port, | |||
| 2332 | { | 2397 | { |
| 2333 | u32 mag_id_reg_l, mag_id_reg_h, port_cfg_reg; | 2398 | u32 mag_id_reg_l, mag_id_reg_h, port_cfg_reg; |
| 2334 | 2399 | ||
| 2335 | if (is_t4(adap->chip)) { | 2400 | if (is_t4(adap->params.chip)) { |
| 2336 | mag_id_reg_l = PORT_REG(port, XGMAC_PORT_MAGIC_MACID_LO); | 2401 | mag_id_reg_l = PORT_REG(port, XGMAC_PORT_MAGIC_MACID_LO); |
| 2337 | mag_id_reg_h = PORT_REG(port, XGMAC_PORT_MAGIC_MACID_HI); | 2402 | mag_id_reg_h = PORT_REG(port, XGMAC_PORT_MAGIC_MACID_HI); |
| 2338 | port_cfg_reg = PORT_REG(port, XGMAC_PORT_CFG2); | 2403 | port_cfg_reg = PORT_REG(port, XGMAC_PORT_CFG2); |
| @@ -2374,7 +2439,7 @@ int t4_wol_pat_enable(struct adapter *adap, unsigned int port, unsigned int map, | |||
| 2374 | int i; | 2439 | int i; |
| 2375 | u32 port_cfg_reg; | 2440 | u32 port_cfg_reg; |
| 2376 | 2441 | ||
| 2377 | if (is_t4(adap->chip)) | 2442 | if (is_t4(adap->params.chip)) |
| 2378 | port_cfg_reg = PORT_REG(port, XGMAC_PORT_CFG2); | 2443 | port_cfg_reg = PORT_REG(port, XGMAC_PORT_CFG2); |
| 2379 | else | 2444 | else |
| 2380 | port_cfg_reg = T5_PORT_REG(port, MAC_PORT_CFG2); | 2445 | port_cfg_reg = T5_PORT_REG(port, MAC_PORT_CFG2); |
| @@ -2387,7 +2452,7 @@ int t4_wol_pat_enable(struct adapter *adap, unsigned int port, unsigned int map, | |||
| 2387 | return -EINVAL; | 2452 | return -EINVAL; |
| 2388 | 2453 | ||
| 2389 | #define EPIO_REG(name) \ | 2454 | #define EPIO_REG(name) \ |
| 2390 | (is_t4(adap->chip) ? PORT_REG(port, XGMAC_PORT_EPIO_##name) : \ | 2455 | (is_t4(adap->params.chip) ? PORT_REG(port, XGMAC_PORT_EPIO_##name) : \ |
| 2391 | T5_PORT_REG(port, MAC_PORT_EPIO_##name)) | 2456 | T5_PORT_REG(port, MAC_PORT_EPIO_##name)) |
| 2392 | 2457 | ||
| 2393 | t4_write_reg(adap, EPIO_REG(DATA1), mask0 >> 32); | 2458 | t4_write_reg(adap, EPIO_REG(DATA1), mask0 >> 32); |
| @@ -2474,7 +2539,7 @@ int t4_fwaddrspace_write(struct adapter *adap, unsigned int mbox, | |||
| 2474 | int t4_mem_win_read_len(struct adapter *adap, u32 addr, __be32 *data, int len) | 2539 | int t4_mem_win_read_len(struct adapter *adap, u32 addr, __be32 *data, int len) |
| 2475 | { | 2540 | { |
| 2476 | int i, off; | 2541 | int i, off; |
| 2477 | u32 win_pf = is_t4(adap->chip) ? 0 : V_PFNUM(adap->fn); | 2542 | u32 win_pf = is_t4(adap->params.chip) ? 0 : V_PFNUM(adap->fn); |
| 2478 | 2543 | ||
| 2479 | /* Align on a 2KB boundary. | 2544 | /* Align on a 2KB boundary. |
| 2480 | */ | 2545 | */ |
| @@ -3306,7 +3371,7 @@ int t4_alloc_mac_filt(struct adapter *adap, unsigned int mbox, | |||
| 3306 | int i, ret; | 3371 | int i, ret; |
| 3307 | struct fw_vi_mac_cmd c; | 3372 | struct fw_vi_mac_cmd c; |
| 3308 | struct fw_vi_mac_exact *p; | 3373 | struct fw_vi_mac_exact *p; |
| 3309 | unsigned int max_naddr = is_t4(adap->chip) ? | 3374 | unsigned int max_naddr = is_t4(adap->params.chip) ? |
| 3310 | NUM_MPS_CLS_SRAM_L_INSTANCES : | 3375 | NUM_MPS_CLS_SRAM_L_INSTANCES : |
| 3311 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; | 3376 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; |
| 3312 | 3377 | ||
| @@ -3368,7 +3433,7 @@ int t4_change_mac(struct adapter *adap, unsigned int mbox, unsigned int viid, | |||
| 3368 | int ret, mode; | 3433 | int ret, mode; |
| 3369 | struct fw_vi_mac_cmd c; | 3434 | struct fw_vi_mac_cmd c; |
| 3370 | struct fw_vi_mac_exact *p = c.u.exact; | 3435 | struct fw_vi_mac_exact *p = c.u.exact; |
| 3371 | unsigned int max_mac_addr = is_t4(adap->chip) ? | 3436 | unsigned int max_mac_addr = is_t4(adap->params.chip) ? |
| 3372 | NUM_MPS_CLS_SRAM_L_INSTANCES : | 3437 | NUM_MPS_CLS_SRAM_L_INSTANCES : |
| 3373 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; | 3438 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; |
| 3374 | 3439 | ||
| @@ -3699,13 +3764,14 @@ int t4_prep_adapter(struct adapter *adapter) | |||
| 3699 | { | 3764 | { |
| 3700 | int ret, ver; | 3765 | int ret, ver; |
| 3701 | uint16_t device_id; | 3766 | uint16_t device_id; |
| 3767 | u32 pl_rev; | ||
| 3702 | 3768 | ||
| 3703 | ret = t4_wait_dev_ready(adapter); | 3769 | ret = t4_wait_dev_ready(adapter); |
| 3704 | if (ret < 0) | 3770 | if (ret < 0) |
| 3705 | return ret; | 3771 | return ret; |
| 3706 | 3772 | ||
| 3707 | get_pci_mode(adapter, &adapter->params.pci); | 3773 | get_pci_mode(adapter, &adapter->params.pci); |
| 3708 | adapter->params.rev = t4_read_reg(adapter, PL_REV); | 3774 | pl_rev = G_REV(t4_read_reg(adapter, PL_REV)); |
| 3709 | 3775 | ||
| 3710 | ret = get_flash_params(adapter); | 3776 | ret = get_flash_params(adapter); |
| 3711 | if (ret < 0) { | 3777 | if (ret < 0) { |
| @@ -3717,14 +3783,13 @@ int t4_prep_adapter(struct adapter *adapter) | |||
| 3717 | */ | 3783 | */ |
| 3718 | pci_read_config_word(adapter->pdev, PCI_DEVICE_ID, &device_id); | 3784 | pci_read_config_word(adapter->pdev, PCI_DEVICE_ID, &device_id); |
| 3719 | ver = device_id >> 12; | 3785 | ver = device_id >> 12; |
| 3786 | adapter->params.chip = 0; | ||
| 3720 | switch (ver) { | 3787 | switch (ver) { |
| 3721 | case CHELSIO_T4: | 3788 | case CHELSIO_T4: |
| 3722 | adapter->chip = CHELSIO_CHIP_CODE(CHELSIO_T4, | 3789 | adapter->params.chip |= CHELSIO_CHIP_CODE(CHELSIO_T4, pl_rev); |
| 3723 | adapter->params.rev); | ||
| 3724 | break; | 3790 | break; |
| 3725 | case CHELSIO_T5: | 3791 | case CHELSIO_T5: |
| 3726 | adapter->chip = CHELSIO_CHIP_CODE(CHELSIO_T5, | 3792 | adapter->params.chip |= CHELSIO_CHIP_CODE(CHELSIO_T5, pl_rev); |
| 3727 | adapter->params.rev); | ||
| 3728 | break; | 3793 | break; |
| 3729 | default: | 3794 | default: |
| 3730 | dev_err(adapter->pdev_dev, "Device %d is not supported\n", | 3795 | dev_err(adapter->pdev_dev, "Device %d is not supported\n", |
| @@ -3732,9 +3797,6 @@ int t4_prep_adapter(struct adapter *adapter) | |||
| 3732 | return -EINVAL; | 3797 | return -EINVAL; |
| 3733 | } | 3798 | } |
| 3734 | 3799 | ||
| 3735 | /* Reassign the updated revision field */ | ||
| 3736 | adapter->params.rev = adapter->chip; | ||
| 3737 | |||
| 3738 | init_cong_ctrl(adapter->params.a_wnd, adapter->params.b_wnd); | 3800 | init_cong_ctrl(adapter->params.a_wnd, adapter->params.b_wnd); |
| 3739 | 3801 | ||
| 3740 | /* | 3802 | /* |
diff --git a/drivers/net/ethernet/chelsio/cxgb4/t4_regs.h b/drivers/net/ethernet/chelsio/cxgb4/t4_regs.h index ef146c0ba481..0a8205d69d2c 100644 --- a/drivers/net/ethernet/chelsio/cxgb4/t4_regs.h +++ b/drivers/net/ethernet/chelsio/cxgb4/t4_regs.h | |||
| @@ -1092,6 +1092,11 @@ | |||
| 1092 | 1092 | ||
| 1093 | #define PL_REV 0x1943c | 1093 | #define PL_REV 0x1943c |
| 1094 | 1094 | ||
| 1095 | #define S_REV 0 | ||
| 1096 | #define M_REV 0xfU | ||
| 1097 | #define V_REV(x) ((x) << S_REV) | ||
| 1098 | #define G_REV(x) (((x) >> S_REV) & M_REV) | ||
| 1099 | |||
| 1095 | #define LE_DB_CONFIG 0x19c04 | 1100 | #define LE_DB_CONFIG 0x19c04 |
| 1096 | #define HASHEN 0x00100000U | 1101 | #define HASHEN 0x00100000U |
| 1097 | 1102 | ||
| @@ -1199,4 +1204,13 @@ | |||
| 1199 | #define EDC_STRIDE_T5 (EDC_T51_BASE_ADDR - EDC_T50_BASE_ADDR) | 1204 | #define EDC_STRIDE_T5 (EDC_T51_BASE_ADDR - EDC_T50_BASE_ADDR) |
| 1200 | #define EDC_REG_T5(reg, idx) (reg + EDC_STRIDE_T5 * idx) | 1205 | #define EDC_REG_T5(reg, idx) (reg + EDC_STRIDE_T5 * idx) |
| 1201 | 1206 | ||
| 1207 | #define A_PL_VF_REV 0x4 | ||
| 1208 | #define A_PL_VF_WHOAMI 0x0 | ||
| 1209 | #define A_PL_VF_REVISION 0x8 | ||
| 1210 | |||
| 1211 | #define S_CHIPID 4 | ||
| 1212 | #define M_CHIPID 0xfU | ||
| 1213 | #define V_CHIPID(x) ((x) << S_CHIPID) | ||
| 1214 | #define G_CHIPID(x) (((x) >> S_CHIPID) & M_CHIPID) | ||
| 1215 | |||
| 1202 | #endif /* __T4_REGS_H */ | 1216 | #endif /* __T4_REGS_H */ |
diff --git a/drivers/net/ethernet/chelsio/cxgb4/t4fw_api.h b/drivers/net/ethernet/chelsio/cxgb4/t4fw_api.h index 6f77ac487743..74fea74ce0aa 100644 --- a/drivers/net/ethernet/chelsio/cxgb4/t4fw_api.h +++ b/drivers/net/ethernet/chelsio/cxgb4/t4fw_api.h | |||
| @@ -2157,7 +2157,7 @@ struct fw_debug_cmd { | |||
| 2157 | 2157 | ||
| 2158 | struct fw_hdr { | 2158 | struct fw_hdr { |
| 2159 | u8 ver; | 2159 | u8 ver; |
| 2160 | u8 reserved1; | 2160 | u8 chip; /* terminator chip type */ |
| 2161 | __be16 len512; /* bin length in units of 512-bytes */ | 2161 | __be16 len512; /* bin length in units of 512-bytes */ |
| 2162 | __be32 fw_ver; /* firmware version */ | 2162 | __be32 fw_ver; /* firmware version */ |
| 2163 | __be32 tp_microcode_ver; | 2163 | __be32 tp_microcode_ver; |
| @@ -2176,6 +2176,11 @@ struct fw_hdr { | |||
| 2176 | __be32 reserved6[23]; | 2176 | __be32 reserved6[23]; |
| 2177 | }; | 2177 | }; |
| 2178 | 2178 | ||
| 2179 | enum fw_hdr_chip { | ||
| 2180 | FW_HDR_CHIP_T4, | ||
| 2181 | FW_HDR_CHIP_T5 | ||
| 2182 | }; | ||
| 2183 | |||
| 2179 | #define FW_HDR_FW_VER_MAJOR_GET(x) (((x) >> 24) & 0xff) | 2184 | #define FW_HDR_FW_VER_MAJOR_GET(x) (((x) >> 24) & 0xff) |
| 2180 | #define FW_HDR_FW_VER_MINOR_GET(x) (((x) >> 16) & 0xff) | 2185 | #define FW_HDR_FW_VER_MINOR_GET(x) (((x) >> 16) & 0xff) |
| 2181 | #define FW_HDR_FW_VER_MICRO_GET(x) (((x) >> 8) & 0xff) | 2186 | #define FW_HDR_FW_VER_MICRO_GET(x) (((x) >> 8) & 0xff) |
diff --git a/drivers/net/ethernet/chelsio/cxgb4vf/adapter.h b/drivers/net/ethernet/chelsio/cxgb4vf/adapter.h index be5c7ef6ca93..68eaa9c88c7d 100644 --- a/drivers/net/ethernet/chelsio/cxgb4vf/adapter.h +++ b/drivers/net/ethernet/chelsio/cxgb4vf/adapter.h | |||
| @@ -344,7 +344,6 @@ struct adapter { | |||
| 344 | unsigned long registered_device_map; | 344 | unsigned long registered_device_map; |
| 345 | unsigned long open_device_map; | 345 | unsigned long open_device_map; |
| 346 | unsigned long flags; | 346 | unsigned long flags; |
| 347 | enum chip_type chip; | ||
| 348 | struct adapter_params params; | 347 | struct adapter_params params; |
| 349 | 348 | ||
| 350 | /* queue and interrupt resources */ | 349 | /* queue and interrupt resources */ |
diff --git a/drivers/net/ethernet/chelsio/cxgb4vf/cxgb4vf_main.c b/drivers/net/ethernet/chelsio/cxgb4vf/cxgb4vf_main.c index 5f90ec5f7519..0899c0983594 100644 --- a/drivers/net/ethernet/chelsio/cxgb4vf/cxgb4vf_main.c +++ b/drivers/net/ethernet/chelsio/cxgb4vf/cxgb4vf_main.c | |||
| @@ -1064,7 +1064,7 @@ static inline unsigned int mk_adap_vers(const struct adapter *adapter) | |||
| 1064 | /* | 1064 | /* |
| 1065 | * Chip version 4, revision 0x3f (cxgb4vf). | 1065 | * Chip version 4, revision 0x3f (cxgb4vf). |
| 1066 | */ | 1066 | */ |
| 1067 | return CHELSIO_CHIP_VERSION(adapter->chip) | (0x3f << 10); | 1067 | return CHELSIO_CHIP_VERSION(adapter->params.chip) | (0x3f << 10); |
| 1068 | } | 1068 | } |
| 1069 | 1069 | ||
| 1070 | /* | 1070 | /* |
| @@ -1551,9 +1551,13 @@ static void cxgb4vf_get_regs(struct net_device *dev, | |||
| 1551 | reg_block_dump(adapter, regbuf, | 1551 | reg_block_dump(adapter, regbuf, |
| 1552 | T4VF_MPS_BASE_ADDR + T4VF_MOD_MAP_MPS_FIRST, | 1552 | T4VF_MPS_BASE_ADDR + T4VF_MOD_MAP_MPS_FIRST, |
| 1553 | T4VF_MPS_BASE_ADDR + T4VF_MOD_MAP_MPS_LAST); | 1553 | T4VF_MPS_BASE_ADDR + T4VF_MOD_MAP_MPS_LAST); |
| 1554 | |||
| 1555 | /* T5 adds new registers in the PL Register map. | ||
| 1556 | */ | ||
| 1554 | reg_block_dump(adapter, regbuf, | 1557 | reg_block_dump(adapter, regbuf, |
| 1555 | T4VF_PL_BASE_ADDR + T4VF_MOD_MAP_PL_FIRST, | 1558 | T4VF_PL_BASE_ADDR + T4VF_MOD_MAP_PL_FIRST, |
| 1556 | T4VF_PL_BASE_ADDR + T4VF_MOD_MAP_PL_LAST); | 1559 | T4VF_PL_BASE_ADDR + (is_t4(adapter->params.chip) |
| 1560 | ? A_PL_VF_WHOAMI : A_PL_VF_REVISION)); | ||
| 1557 | reg_block_dump(adapter, regbuf, | 1561 | reg_block_dump(adapter, regbuf, |
| 1558 | T4VF_CIM_BASE_ADDR + T4VF_MOD_MAP_CIM_FIRST, | 1562 | T4VF_CIM_BASE_ADDR + T4VF_MOD_MAP_CIM_FIRST, |
| 1559 | T4VF_CIM_BASE_ADDR + T4VF_MOD_MAP_CIM_LAST); | 1563 | T4VF_CIM_BASE_ADDR + T4VF_MOD_MAP_CIM_LAST); |
| @@ -2087,6 +2091,7 @@ static int adap_init0(struct adapter *adapter) | |||
| 2087 | unsigned int ethqsets; | 2091 | unsigned int ethqsets; |
| 2088 | int err; | 2092 | int err; |
| 2089 | u32 param, val = 0; | 2093 | u32 param, val = 0; |
| 2094 | unsigned int chipid; | ||
| 2090 | 2095 | ||
| 2091 | /* | 2096 | /* |
| 2092 | * Wait for the device to become ready before proceeding ... | 2097 | * Wait for the device to become ready before proceeding ... |
| @@ -2114,12 +2119,14 @@ static int adap_init0(struct adapter *adapter) | |||
| 2114 | return err; | 2119 | return err; |
| 2115 | } | 2120 | } |
| 2116 | 2121 | ||
| 2122 | adapter->params.chip = 0; | ||
| 2117 | switch (adapter->pdev->device >> 12) { | 2123 | switch (adapter->pdev->device >> 12) { |
| 2118 | case CHELSIO_T4: | 2124 | case CHELSIO_T4: |
| 2119 | adapter->chip = CHELSIO_CHIP_CODE(CHELSIO_T4, 0); | 2125 | adapter->params.chip = CHELSIO_CHIP_CODE(CHELSIO_T4, 0); |
| 2120 | break; | 2126 | break; |
| 2121 | case CHELSIO_T5: | 2127 | case CHELSIO_T5: |
| 2122 | adapter->chip = CHELSIO_CHIP_CODE(CHELSIO_T5, 0); | 2128 | chipid = G_REV(t4_read_reg(adapter, A_PL_VF_REV)); |
| 2129 | adapter->params.chip |= CHELSIO_CHIP_CODE(CHELSIO_T5, chipid); | ||
| 2123 | break; | 2130 | break; |
| 2124 | } | 2131 | } |
| 2125 | 2132 | ||
diff --git a/drivers/net/ethernet/chelsio/cxgb4vf/sge.c b/drivers/net/ethernet/chelsio/cxgb4vf/sge.c index 8475c4cda9e4..0a89963c48ce 100644 --- a/drivers/net/ethernet/chelsio/cxgb4vf/sge.c +++ b/drivers/net/ethernet/chelsio/cxgb4vf/sge.c | |||
| @@ -537,7 +537,7 @@ static inline void ring_fl_db(struct adapter *adapter, struct sge_fl *fl) | |||
| 537 | */ | 537 | */ |
| 538 | if (fl->pend_cred >= FL_PER_EQ_UNIT) { | 538 | if (fl->pend_cred >= FL_PER_EQ_UNIT) { |
| 539 | val = PIDX(fl->pend_cred / FL_PER_EQ_UNIT); | 539 | val = PIDX(fl->pend_cred / FL_PER_EQ_UNIT); |
| 540 | if (!is_t4(adapter->chip)) | 540 | if (!is_t4(adapter->params.chip)) |
| 541 | val |= DBTYPE(1); | 541 | val |= DBTYPE(1); |
| 542 | wmb(); | 542 | wmb(); |
| 543 | t4_write_reg(adapter, T4VF_SGE_BASE_ADDR + SGE_VF_KDOORBELL, | 543 | t4_write_reg(adapter, T4VF_SGE_BASE_ADDR + SGE_VF_KDOORBELL, |
diff --git a/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_common.h b/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_common.h index 53cbfed21d0b..61362450d05b 100644 --- a/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_common.h +++ b/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_common.h | |||
| @@ -39,21 +39,28 @@ | |||
| 39 | #include "../cxgb4/t4fw_api.h" | 39 | #include "../cxgb4/t4fw_api.h" |
| 40 | 40 | ||
| 41 | #define CHELSIO_CHIP_CODE(version, revision) (((version) << 4) | (revision)) | 41 | #define CHELSIO_CHIP_CODE(version, revision) (((version) << 4) | (revision)) |
| 42 | #define CHELSIO_CHIP_VERSION(code) ((code) >> 4) | 42 | #define CHELSIO_CHIP_VERSION(code) (((code) >> 4) & 0xf) |
| 43 | #define CHELSIO_CHIP_RELEASE(code) ((code) & 0xf) | 43 | #define CHELSIO_CHIP_RELEASE(code) ((code) & 0xf) |
| 44 | 44 | ||
| 45 | /* All T4 and later chips have their PCI-E Device IDs encoded as 0xVFPP where: | ||
| 46 | * | ||
| 47 | * V = "4" for T4; "5" for T5, etc. or | ||
| 48 | * = "a" for T4 FPGA; "b" for T4 FPGA, etc. | ||
| 49 | * F = "0" for PF 0..3; "4".."7" for PF4..7; and "8" for VFs | ||
| 50 | * PP = adapter product designation | ||
| 51 | */ | ||
| 45 | #define CHELSIO_T4 0x4 | 52 | #define CHELSIO_T4 0x4 |
| 46 | #define CHELSIO_T5 0x5 | 53 | #define CHELSIO_T5 0x5 |
| 47 | 54 | ||
| 48 | enum chip_type { | 55 | enum chip_type { |
| 49 | T4_A1 = CHELSIO_CHIP_CODE(CHELSIO_T4, 0), | 56 | T4_A1 = CHELSIO_CHIP_CODE(CHELSIO_T4, 1), |
| 50 | T4_A2 = CHELSIO_CHIP_CODE(CHELSIO_T4, 1), | 57 | T4_A2 = CHELSIO_CHIP_CODE(CHELSIO_T4, 2), |
| 51 | T4_A3 = CHELSIO_CHIP_CODE(CHELSIO_T4, 2), | ||
| 52 | T4_FIRST_REV = T4_A1, | 58 | T4_FIRST_REV = T4_A1, |
| 53 | T4_LAST_REV = T4_A3, | 59 | T4_LAST_REV = T4_A2, |
| 54 | 60 | ||
| 55 | T5_A1 = CHELSIO_CHIP_CODE(CHELSIO_T5, 0), | 61 | T5_A0 = CHELSIO_CHIP_CODE(CHELSIO_T5, 0), |
| 56 | T5_FIRST_REV = T5_A1, | 62 | T5_A1 = CHELSIO_CHIP_CODE(CHELSIO_T5, 1), |
| 63 | T5_FIRST_REV = T5_A0, | ||
| 57 | T5_LAST_REV = T5_A1, | 64 | T5_LAST_REV = T5_A1, |
| 58 | }; | 65 | }; |
| 59 | 66 | ||
| @@ -203,6 +210,7 @@ struct adapter_params { | |||
| 203 | struct vpd_params vpd; /* Vital Product Data */ | 210 | struct vpd_params vpd; /* Vital Product Data */ |
| 204 | struct rss_params rss; /* Receive Side Scaling */ | 211 | struct rss_params rss; /* Receive Side Scaling */ |
| 205 | struct vf_resources vfres; /* Virtual Function Resource limits */ | 212 | struct vf_resources vfres; /* Virtual Function Resource limits */ |
| 213 | enum chip_type chip; /* chip code */ | ||
| 206 | u8 nports; /* # of Ethernet "ports" */ | 214 | u8 nports; /* # of Ethernet "ports" */ |
| 207 | }; | 215 | }; |
| 208 | 216 | ||
| @@ -253,7 +261,7 @@ static inline int t4vf_wr_mbox_ns(struct adapter *adapter, const void *cmd, | |||
| 253 | 261 | ||
| 254 | static inline int is_t4(enum chip_type chip) | 262 | static inline int is_t4(enum chip_type chip) |
| 255 | { | 263 | { |
| 256 | return (chip >= T4_FIRST_REV && chip <= T4_LAST_REV); | 264 | return CHELSIO_CHIP_VERSION(chip) == CHELSIO_T4; |
| 257 | } | 265 | } |
| 258 | 266 | ||
| 259 | int t4vf_wait_dev_ready(struct adapter *); | 267 | int t4vf_wait_dev_ready(struct adapter *); |
diff --git a/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_hw.c b/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_hw.c index 9f96dc3bb112..d958c44341b5 100644 --- a/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_hw.c +++ b/drivers/net/ethernet/chelsio/cxgb4vf/t4vf_hw.c | |||
| @@ -1027,7 +1027,7 @@ int t4vf_alloc_mac_filt(struct adapter *adapter, unsigned int viid, bool free, | |||
| 1027 | unsigned nfilters = 0; | 1027 | unsigned nfilters = 0; |
| 1028 | unsigned int rem = naddr; | 1028 | unsigned int rem = naddr; |
| 1029 | struct fw_vi_mac_cmd cmd, rpl; | 1029 | struct fw_vi_mac_cmd cmd, rpl; |
| 1030 | unsigned int max_naddr = is_t4(adapter->chip) ? | 1030 | unsigned int max_naddr = is_t4(adapter->params.chip) ? |
| 1031 | NUM_MPS_CLS_SRAM_L_INSTANCES : | 1031 | NUM_MPS_CLS_SRAM_L_INSTANCES : |
| 1032 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; | 1032 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; |
| 1033 | 1033 | ||
| @@ -1121,7 +1121,7 @@ int t4vf_change_mac(struct adapter *adapter, unsigned int viid, | |||
| 1121 | struct fw_vi_mac_exact *p = &cmd.u.exact[0]; | 1121 | struct fw_vi_mac_exact *p = &cmd.u.exact[0]; |
| 1122 | size_t len16 = DIV_ROUND_UP(offsetof(struct fw_vi_mac_cmd, | 1122 | size_t len16 = DIV_ROUND_UP(offsetof(struct fw_vi_mac_cmd, |
| 1123 | u.exact[1]), 16); | 1123 | u.exact[1]), 16); |
| 1124 | unsigned int max_naddr = is_t4(adapter->chip) ? | 1124 | unsigned int max_naddr = is_t4(adapter->params.chip) ? |
| 1125 | NUM_MPS_CLS_SRAM_L_INSTANCES : | 1125 | NUM_MPS_CLS_SRAM_L_INSTANCES : |
| 1126 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; | 1126 | NUM_MPS_T5_CLS_SRAM_L_INSTANCES; |
| 1127 | 1127 | ||
diff --git a/drivers/net/ethernet/emulex/benet/be.h b/drivers/net/ethernet/emulex/benet/be.h index f4825db5d179..5878df619b53 100644 --- a/drivers/net/ethernet/emulex/benet/be.h +++ b/drivers/net/ethernet/emulex/benet/be.h | |||
| @@ -503,6 +503,7 @@ struct be_adapter { | |||
| 503 | }; | 503 | }; |
| 504 | 504 | ||
| 505 | #define be_physfn(adapter) (!adapter->virtfn) | 505 | #define be_physfn(adapter) (!adapter->virtfn) |
| 506 | #define be_virtfn(adapter) (adapter->virtfn) | ||
| 506 | #define sriov_enabled(adapter) (adapter->num_vfs > 0) | 507 | #define sriov_enabled(adapter) (adapter->num_vfs > 0) |
| 507 | #define sriov_want(adapter) (be_physfn(adapter) && \ | 508 | #define sriov_want(adapter) (be_physfn(adapter) && \ |
| 508 | (num_vfs || pci_num_vf(adapter->pdev))) | 509 | (num_vfs || pci_num_vf(adapter->pdev))) |
diff --git a/drivers/net/ethernet/emulex/benet/be_cmds.c b/drivers/net/ethernet/emulex/benet/be_cmds.c index dbcd5262c016..e0e8bc1ef14c 100644 --- a/drivers/net/ethernet/emulex/benet/be_cmds.c +++ b/drivers/net/ethernet/emulex/benet/be_cmds.c | |||
| @@ -1032,6 +1032,13 @@ int be_cmd_cq_create(struct be_adapter *adapter, struct be_queue_info *cq, | |||
| 1032 | } else { | 1032 | } else { |
| 1033 | req->hdr.version = 2; | 1033 | req->hdr.version = 2; |
| 1034 | req->page_size = 1; /* 1 for 4K */ | 1034 | req->page_size = 1; /* 1 for 4K */ |
| 1035 | |||
| 1036 | /* coalesce-wm field in this cmd is not relevant to Lancer. | ||
| 1037 | * Lancer uses COMMON_MODIFY_CQ to set this field | ||
| 1038 | */ | ||
| 1039 | if (!lancer_chip(adapter)) | ||
| 1040 | AMAP_SET_BITS(struct amap_cq_context_v2, coalescwm, | ||
| 1041 | ctxt, coalesce_wm); | ||
| 1035 | AMAP_SET_BITS(struct amap_cq_context_v2, nodelay, ctxt, | 1042 | AMAP_SET_BITS(struct amap_cq_context_v2, nodelay, ctxt, |
| 1036 | no_delay); | 1043 | no_delay); |
| 1037 | AMAP_SET_BITS(struct amap_cq_context_v2, count, ctxt, | 1044 | AMAP_SET_BITS(struct amap_cq_context_v2, count, ctxt, |
diff --git a/drivers/net/ethernet/emulex/benet/be_hw.h b/drivers/net/ethernet/emulex/benet/be_hw.h index 3e2162121601..dc88782185f2 100644 --- a/drivers/net/ethernet/emulex/benet/be_hw.h +++ b/drivers/net/ethernet/emulex/benet/be_hw.h | |||
| @@ -64,6 +64,9 @@ | |||
| 64 | #define SLIPORT_ERROR_NO_RESOURCE1 0x2 | 64 | #define SLIPORT_ERROR_NO_RESOURCE1 0x2 |
| 65 | #define SLIPORT_ERROR_NO_RESOURCE2 0x9 | 65 | #define SLIPORT_ERROR_NO_RESOURCE2 0x9 |
| 66 | 66 | ||
| 67 | #define SLIPORT_ERROR_FW_RESET1 0x2 | ||
| 68 | #define SLIPORT_ERROR_FW_RESET2 0x0 | ||
| 69 | |||
| 67 | /********* Memory BAR register ************/ | 70 | /********* Memory BAR register ************/ |
| 68 | #define PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET 0xfc | 71 | #define PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET 0xfc |
| 69 | /* Host Interrupt Enable, if set interrupts are enabled although "PCI Interrupt | 72 | /* Host Interrupt Enable, if set interrupts are enabled although "PCI Interrupt |
diff --git a/drivers/net/ethernet/emulex/benet/be_main.c b/drivers/net/ethernet/emulex/benet/be_main.c index abde97471636..0fde69d5cb6a 100644 --- a/drivers/net/ethernet/emulex/benet/be_main.c +++ b/drivers/net/ethernet/emulex/benet/be_main.c | |||
| @@ -2464,8 +2464,16 @@ void be_detect_error(struct be_adapter *adapter) | |||
| 2464 | */ | 2464 | */ |
| 2465 | if (sliport_status & SLIPORT_STATUS_ERR_MASK) { | 2465 | if (sliport_status & SLIPORT_STATUS_ERR_MASK) { |
| 2466 | adapter->hw_error = true; | 2466 | adapter->hw_error = true; |
| 2467 | dev_err(&adapter->pdev->dev, | 2467 | /* Do not log error messages if its a FW reset */ |
| 2468 | "Error detected in the card\n"); | 2468 | if (sliport_err1 == SLIPORT_ERROR_FW_RESET1 && |
| 2469 | sliport_err2 == SLIPORT_ERROR_FW_RESET2) { | ||
| 2470 | dev_info(&adapter->pdev->dev, | ||
| 2471 | "Firmware update in progress\n"); | ||
| 2472 | return; | ||
| 2473 | } else { | ||
| 2474 | dev_err(&adapter->pdev->dev, | ||
| 2475 | "Error detected in the card\n"); | ||
| 2476 | } | ||
| 2469 | } | 2477 | } |
| 2470 | 2478 | ||
| 2471 | if (sliport_status & SLIPORT_STATUS_ERR_MASK) { | 2479 | if (sliport_status & SLIPORT_STATUS_ERR_MASK) { |
| @@ -2658,8 +2666,8 @@ static int be_close(struct net_device *netdev) | |||
| 2658 | 2666 | ||
| 2659 | be_roce_dev_close(adapter); | 2667 | be_roce_dev_close(adapter); |
| 2660 | 2668 | ||
| 2661 | for_all_evt_queues(adapter, eqo, i) { | 2669 | if (adapter->flags & BE_FLAGS_NAPI_ENABLED) { |
| 2662 | if (adapter->flags & BE_FLAGS_NAPI_ENABLED) { | 2670 | for_all_evt_queues(adapter, eqo, i) { |
| 2663 | napi_disable(&eqo->napi); | 2671 | napi_disable(&eqo->napi); |
| 2664 | be_disable_busy_poll(eqo); | 2672 | be_disable_busy_poll(eqo); |
| 2665 | } | 2673 | } |
| @@ -2932,28 +2940,35 @@ static void be_cancel_worker(struct be_adapter *adapter) | |||
| 2932 | } | 2940 | } |
| 2933 | } | 2941 | } |
| 2934 | 2942 | ||
| 2935 | static int be_clear(struct be_adapter *adapter) | 2943 | static void be_mac_clear(struct be_adapter *adapter) |
| 2936 | { | 2944 | { |
| 2937 | int i; | 2945 | int i; |
| 2938 | 2946 | ||
| 2947 | if (adapter->pmac_id) { | ||
| 2948 | for (i = 0; i < (adapter->uc_macs + 1); i++) | ||
| 2949 | be_cmd_pmac_del(adapter, adapter->if_handle, | ||
| 2950 | adapter->pmac_id[i], 0); | ||
| 2951 | adapter->uc_macs = 0; | ||
| 2952 | |||
| 2953 | kfree(adapter->pmac_id); | ||
| 2954 | adapter->pmac_id = NULL; | ||
| 2955 | } | ||
| 2956 | } | ||
| 2957 | |||
| 2958 | static int be_clear(struct be_adapter *adapter) | ||
| 2959 | { | ||
| 2939 | be_cancel_worker(adapter); | 2960 | be_cancel_worker(adapter); |
| 2940 | 2961 | ||
| 2941 | if (sriov_enabled(adapter)) | 2962 | if (sriov_enabled(adapter)) |
| 2942 | be_vf_clear(adapter); | 2963 | be_vf_clear(adapter); |
| 2943 | 2964 | ||
| 2944 | /* delete the primary mac along with the uc-mac list */ | 2965 | /* delete the primary mac along with the uc-mac list */ |
| 2945 | for (i = 0; i < (adapter->uc_macs + 1); i++) | 2966 | be_mac_clear(adapter); |
| 2946 | be_cmd_pmac_del(adapter, adapter->if_handle, | ||
| 2947 | adapter->pmac_id[i], 0); | ||
| 2948 | adapter->uc_macs = 0; | ||
| 2949 | 2967 | ||
| 2950 | be_cmd_if_destroy(adapter, adapter->if_handle, 0); | 2968 | be_cmd_if_destroy(adapter, adapter->if_handle, 0); |
| 2951 | 2969 | ||
| 2952 | be_clear_queues(adapter); | 2970 | be_clear_queues(adapter); |
| 2953 | 2971 | ||
| 2954 | kfree(adapter->pmac_id); | ||
| 2955 | adapter->pmac_id = NULL; | ||
| 2956 | |||
| 2957 | be_msix_disable(adapter); | 2972 | be_msix_disable(adapter); |
| 2958 | return 0; | 2973 | return 0; |
| 2959 | } | 2974 | } |
| @@ -3253,12 +3268,10 @@ static int be_mac_setup(struct be_adapter *adapter) | |||
| 3253 | memcpy(mac, adapter->netdev->dev_addr, ETH_ALEN); | 3268 | memcpy(mac, adapter->netdev->dev_addr, ETH_ALEN); |
| 3254 | } | 3269 | } |
| 3255 | 3270 | ||
| 3256 | /* On BE3 VFs this cmd may fail due to lack of privilege. | 3271 | /* For BE3-R VFs, the PF programs the initial MAC address */ |
| 3257 | * Ignore the failure as in this case pmac_id is fetched | 3272 | if (!(BEx_chip(adapter) && be_virtfn(adapter))) |
| 3258 | * in the IFACE_CREATE cmd. | 3273 | be_cmd_pmac_add(adapter, mac, adapter->if_handle, |
| 3259 | */ | 3274 | &adapter->pmac_id[0], 0); |
| 3260 | be_cmd_pmac_add(adapter, mac, adapter->if_handle, | ||
| 3261 | &adapter->pmac_id[0], 0); | ||
| 3262 | return 0; | 3275 | return 0; |
| 3263 | } | 3276 | } |
| 3264 | 3277 | ||
| @@ -3814,6 +3827,8 @@ static int lancer_fw_download(struct be_adapter *adapter, | |||
| 3814 | } | 3827 | } |
| 3815 | 3828 | ||
| 3816 | if (change_status == LANCER_FW_RESET_NEEDED) { | 3829 | if (change_status == LANCER_FW_RESET_NEEDED) { |
| 3830 | dev_info(&adapter->pdev->dev, | ||
| 3831 | "Resetting adapter to activate new FW\n"); | ||
| 3817 | status = lancer_physdev_ctrl(adapter, | 3832 | status = lancer_physdev_ctrl(adapter, |
| 3818 | PHYSDEV_CONTROL_FW_RESET_MASK); | 3833 | PHYSDEV_CONTROL_FW_RESET_MASK); |
| 3819 | if (status) { | 3834 | if (status) { |
| @@ -4365,13 +4380,13 @@ static int lancer_recover_func(struct be_adapter *adapter) | |||
| 4365 | goto err; | 4380 | goto err; |
| 4366 | } | 4381 | } |
| 4367 | 4382 | ||
| 4368 | dev_err(dev, "Error recovery successful\n"); | 4383 | dev_err(dev, "Adapter recovery successful\n"); |
| 4369 | return 0; | 4384 | return 0; |
| 4370 | err: | 4385 | err: |
| 4371 | if (status == -EAGAIN) | 4386 | if (status == -EAGAIN) |
| 4372 | dev_err(dev, "Waiting for resource provisioning\n"); | 4387 | dev_err(dev, "Waiting for resource provisioning\n"); |
| 4373 | else | 4388 | else |
| 4374 | dev_err(dev, "Error recovery failed\n"); | 4389 | dev_err(dev, "Adapter recovery failed\n"); |
| 4375 | 4390 | ||
| 4376 | return status; | 4391 | return status; |
| 4377 | } | 4392 | } |
| @@ -4599,6 +4614,7 @@ static int be_suspend(struct pci_dev *pdev, pm_message_t state) | |||
| 4599 | if (adapter->wol) | 4614 | if (adapter->wol) |
| 4600 | be_setup_wol(adapter, true); | 4615 | be_setup_wol(adapter, true); |
| 4601 | 4616 | ||
| 4617 | be_intr_set(adapter, false); | ||
| 4602 | cancel_delayed_work_sync(&adapter->func_recovery_work); | 4618 | cancel_delayed_work_sync(&adapter->func_recovery_work); |
| 4603 | 4619 | ||
| 4604 | netif_device_detach(netdev); | 4620 | netif_device_detach(netdev); |
| @@ -4634,6 +4650,7 @@ static int be_resume(struct pci_dev *pdev) | |||
| 4634 | if (status) | 4650 | if (status) |
| 4635 | return status; | 4651 | return status; |
| 4636 | 4652 | ||
| 4653 | be_intr_set(adapter, true); | ||
| 4637 | /* tell fw we're ready to fire cmds */ | 4654 | /* tell fw we're ready to fire cmds */ |
| 4638 | status = be_cmd_fw_init(adapter); | 4655 | status = be_cmd_fw_init(adapter); |
| 4639 | if (status) | 4656 | if (status) |
diff --git a/drivers/net/ethernet/freescale/fec_main.c b/drivers/net/ethernet/freescale/fec_main.c index 4cbebf3d80eb..e7c8b749c5a5 100644 --- a/drivers/net/ethernet/freescale/fec_main.c +++ b/drivers/net/ethernet/freescale/fec_main.c | |||
| @@ -98,10 +98,6 @@ static void set_multicast_list(struct net_device *ndev); | |||
| 98 | * detected as not set during a prior frame transmission, then the | 98 | * detected as not set during a prior frame transmission, then the |
| 99 | * ENET_TDAR[TDAR] bit is cleared at a later time, even if additional TxBDs | 99 | * ENET_TDAR[TDAR] bit is cleared at a later time, even if additional TxBDs |
| 100 | * were added to the ring and the ENET_TDAR[TDAR] bit is set. This results in | 100 | * were added to the ring and the ENET_TDAR[TDAR] bit is set. This results in |
| 101 | * If the ready bit in the transmit buffer descriptor (TxBD[R]) is previously | ||
| 102 | * detected as not set during a prior frame transmission, then the | ||
| 103 | * ENET_TDAR[TDAR] bit is cleared at a later time, even if additional TxBDs | ||
| 104 | * were added to the ring and the ENET_TDAR[TDAR] bit is set. This results in | ||
| 105 | * frames not being transmitted until there is a 0-to-1 transition on | 101 | * frames not being transmitted until there is a 0-to-1 transition on |
| 106 | * ENET_TDAR[TDAR]. | 102 | * ENET_TDAR[TDAR]. |
| 107 | */ | 103 | */ |
| @@ -385,7 +381,7 @@ fec_enet_start_xmit(struct sk_buff *skb, struct net_device *ndev) | |||
| 385 | * data. | 381 | * data. |
| 386 | */ | 382 | */ |
| 387 | bdp->cbd_bufaddr = dma_map_single(&fep->pdev->dev, bufaddr, | 383 | bdp->cbd_bufaddr = dma_map_single(&fep->pdev->dev, bufaddr, |
| 388 | FEC_ENET_TX_FRSIZE, DMA_TO_DEVICE); | 384 | skb->len, DMA_TO_DEVICE); |
| 389 | if (dma_mapping_error(&fep->pdev->dev, bdp->cbd_bufaddr)) { | 385 | if (dma_mapping_error(&fep->pdev->dev, bdp->cbd_bufaddr)) { |
| 390 | bdp->cbd_bufaddr = 0; | 386 | bdp->cbd_bufaddr = 0; |
| 391 | fep->tx_skbuff[index] = NULL; | 387 | fep->tx_skbuff[index] = NULL; |
| @@ -779,11 +775,10 @@ fec_enet_tx(struct net_device *ndev) | |||
| 779 | else | 775 | else |
| 780 | index = bdp - fep->tx_bd_base; | 776 | index = bdp - fep->tx_bd_base; |
| 781 | 777 | ||
| 782 | dma_unmap_single(&fep->pdev->dev, bdp->cbd_bufaddr, | ||
| 783 | FEC_ENET_TX_FRSIZE, DMA_TO_DEVICE); | ||
| 784 | bdp->cbd_bufaddr = 0; | ||
| 785 | |||
| 786 | skb = fep->tx_skbuff[index]; | 778 | skb = fep->tx_skbuff[index]; |
| 779 | dma_unmap_single(&fep->pdev->dev, bdp->cbd_bufaddr, skb->len, | ||
| 780 | DMA_TO_DEVICE); | ||
| 781 | bdp->cbd_bufaddr = 0; | ||
| 787 | 782 | ||
| 788 | /* Check for errors. */ | 783 | /* Check for errors. */ |
| 789 | if (status & (BD_ENET_TX_HB | BD_ENET_TX_LC | | 784 | if (status & (BD_ENET_TX_HB | BD_ENET_TX_LC | |
diff --git a/drivers/net/ethernet/ibm/ehea/ehea_main.c b/drivers/net/ethernet/ibm/ehea/ehea_main.c index 2d1c6bdd3618..7628e0fd8455 100644 --- a/drivers/net/ethernet/ibm/ehea/ehea_main.c +++ b/drivers/net/ethernet/ibm/ehea/ehea_main.c | |||
| @@ -3033,7 +3033,7 @@ static struct ehea_port *ehea_setup_single_port(struct ehea_adapter *adapter, | |||
| 3033 | 3033 | ||
| 3034 | dev->hw_features = NETIF_F_SG | NETIF_F_TSO | | 3034 | dev->hw_features = NETIF_F_SG | NETIF_F_TSO | |
| 3035 | NETIF_F_IP_CSUM | NETIF_F_HW_VLAN_CTAG_TX; | 3035 | NETIF_F_IP_CSUM | NETIF_F_HW_VLAN_CTAG_TX; |
| 3036 | dev->features = NETIF_F_SG | NETIF_F_FRAGLIST | NETIF_F_TSO | | 3036 | dev->features = NETIF_F_SG | NETIF_F_TSO | |
| 3037 | NETIF_F_HIGHDMA | NETIF_F_IP_CSUM | | 3037 | NETIF_F_HIGHDMA | NETIF_F_IP_CSUM | |
| 3038 | NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX | | 3038 | NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX | |
| 3039 | NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_RXCSUM; | 3039 | NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_RXCSUM; |
diff --git a/drivers/net/ethernet/intel/e1000/e1000.h b/drivers/net/ethernet/intel/e1000/e1000.h index 58c147271a36..f9313b36c887 100644 --- a/drivers/net/ethernet/intel/e1000/e1000.h +++ b/drivers/net/ethernet/intel/e1000/e1000.h | |||
| @@ -83,6 +83,11 @@ struct e1000_adapter; | |||
| 83 | 83 | ||
| 84 | #define E1000_MAX_INTR 10 | 84 | #define E1000_MAX_INTR 10 |
| 85 | 85 | ||
| 86 | /* | ||
| 87 | * Count for polling __E1000_RESET condition every 10-20msec. | ||
| 88 | */ | ||
| 89 | #define E1000_CHECK_RESET_COUNT 50 | ||
| 90 | |||
| 86 | /* TX/RX descriptor defines */ | 91 | /* TX/RX descriptor defines */ |
| 87 | #define E1000_DEFAULT_TXD 256 | 92 | #define E1000_DEFAULT_TXD 256 |
| 88 | #define E1000_MAX_TXD 256 | 93 | #define E1000_MAX_TXD 256 |
| @@ -312,8 +317,6 @@ struct e1000_adapter { | |||
| 312 | struct delayed_work watchdog_task; | 317 | struct delayed_work watchdog_task; |
| 313 | struct delayed_work fifo_stall_task; | 318 | struct delayed_work fifo_stall_task; |
| 314 | struct delayed_work phy_info_task; | 319 | struct delayed_work phy_info_task; |
| 315 | |||
| 316 | struct mutex mutex; | ||
| 317 | }; | 320 | }; |
| 318 | 321 | ||
| 319 | enum e1000_state_t { | 322 | enum e1000_state_t { |
diff --git a/drivers/net/ethernet/intel/e1000/e1000_main.c b/drivers/net/ethernet/intel/e1000/e1000_main.c index e38622825fa7..46e6544ed1b7 100644 --- a/drivers/net/ethernet/intel/e1000/e1000_main.c +++ b/drivers/net/ethernet/intel/e1000/e1000_main.c | |||
| @@ -494,13 +494,20 @@ static void e1000_down_and_stop(struct e1000_adapter *adapter) | |||
| 494 | { | 494 | { |
| 495 | set_bit(__E1000_DOWN, &adapter->flags); | 495 | set_bit(__E1000_DOWN, &adapter->flags); |
| 496 | 496 | ||
| 497 | /* Only kill reset task if adapter is not resetting */ | ||
| 498 | if (!test_bit(__E1000_RESETTING, &adapter->flags)) | ||
| 499 | cancel_work_sync(&adapter->reset_task); | ||
| 500 | |||
| 501 | cancel_delayed_work_sync(&adapter->watchdog_task); | 497 | cancel_delayed_work_sync(&adapter->watchdog_task); |
| 498 | |||
| 499 | /* | ||
| 500 | * Since the watchdog task can reschedule other tasks, we should cancel | ||
| 501 | * it first, otherwise we can run into the situation when a work is | ||
| 502 | * still running after the adapter has been turned down. | ||
| 503 | */ | ||
| 504 | |||
| 502 | cancel_delayed_work_sync(&adapter->phy_info_task); | 505 | cancel_delayed_work_sync(&adapter->phy_info_task); |
| 503 | cancel_delayed_work_sync(&adapter->fifo_stall_task); | 506 | cancel_delayed_work_sync(&adapter->fifo_stall_task); |
| 507 | |||
| 508 | /* Only kill reset task if adapter is not resetting */ | ||
| 509 | if (!test_bit(__E1000_RESETTING, &adapter->flags)) | ||
| 510 | cancel_work_sync(&adapter->reset_task); | ||
| 504 | } | 511 | } |
| 505 | 512 | ||
| 506 | void e1000_down(struct e1000_adapter *adapter) | 513 | void e1000_down(struct e1000_adapter *adapter) |
| @@ -544,21 +551,8 @@ void e1000_down(struct e1000_adapter *adapter) | |||
| 544 | e1000_clean_all_rx_rings(adapter); | 551 | e1000_clean_all_rx_rings(adapter); |
| 545 | } | 552 | } |
| 546 | 553 | ||
| 547 | static void e1000_reinit_safe(struct e1000_adapter *adapter) | ||
| 548 | { | ||
| 549 | while (test_and_set_bit(__E1000_RESETTING, &adapter->flags)) | ||
| 550 | msleep(1); | ||
| 551 | mutex_lock(&adapter->mutex); | ||
| 552 | e1000_down(adapter); | ||
| 553 | e1000_up(adapter); | ||
| 554 | mutex_unlock(&adapter->mutex); | ||
| 555 | clear_bit(__E1000_RESETTING, &adapter->flags); | ||
| 556 | } | ||
| 557 | |||
| 558 | void e1000_reinit_locked(struct e1000_adapter *adapter) | 554 | void e1000_reinit_locked(struct e1000_adapter *adapter) |
| 559 | { | 555 | { |
| 560 | /* if rtnl_lock is not held the call path is bogus */ | ||
| 561 | ASSERT_RTNL(); | ||
| 562 | WARN_ON(in_interrupt()); | 556 | WARN_ON(in_interrupt()); |
| 563 | while (test_and_set_bit(__E1000_RESETTING, &adapter->flags)) | 557 | while (test_and_set_bit(__E1000_RESETTING, &adapter->flags)) |
| 564 | msleep(1); | 558 | msleep(1); |
| @@ -1316,7 +1310,6 @@ static int e1000_sw_init(struct e1000_adapter *adapter) | |||
| 1316 | e1000_irq_disable(adapter); | 1310 | e1000_irq_disable(adapter); |
| 1317 | 1311 | ||
| 1318 | spin_lock_init(&adapter->stats_lock); | 1312 | spin_lock_init(&adapter->stats_lock); |
| 1319 | mutex_init(&adapter->mutex); | ||
| 1320 | 1313 | ||
| 1321 | set_bit(__E1000_DOWN, &adapter->flags); | 1314 | set_bit(__E1000_DOWN, &adapter->flags); |
| 1322 | 1315 | ||
| @@ -1440,6 +1433,10 @@ static int e1000_close(struct net_device *netdev) | |||
| 1440 | { | 1433 | { |
| 1441 | struct e1000_adapter *adapter = netdev_priv(netdev); | 1434 | struct e1000_adapter *adapter = netdev_priv(netdev); |
| 1442 | struct e1000_hw *hw = &adapter->hw; | 1435 | struct e1000_hw *hw = &adapter->hw; |
| 1436 | int count = E1000_CHECK_RESET_COUNT; | ||
| 1437 | |||
| 1438 | while (test_bit(__E1000_RESETTING, &adapter->flags) && count--) | ||
| 1439 | usleep_range(10000, 20000); | ||
| 1443 | 1440 | ||
| 1444 | WARN_ON(test_bit(__E1000_RESETTING, &adapter->flags)); | 1441 | WARN_ON(test_bit(__E1000_RESETTING, &adapter->flags)); |
| 1445 | e1000_down(adapter); | 1442 | e1000_down(adapter); |
| @@ -2325,11 +2322,8 @@ static void e1000_update_phy_info_task(struct work_struct *work) | |||
| 2325 | struct e1000_adapter *adapter = container_of(work, | 2322 | struct e1000_adapter *adapter = container_of(work, |
| 2326 | struct e1000_adapter, | 2323 | struct e1000_adapter, |
| 2327 | phy_info_task.work); | 2324 | phy_info_task.work); |
| 2328 | if (test_bit(__E1000_DOWN, &adapter->flags)) | 2325 | |
| 2329 | return; | ||
| 2330 | mutex_lock(&adapter->mutex); | ||
| 2331 | e1000_phy_get_info(&adapter->hw, &adapter->phy_info); | 2326 | e1000_phy_get_info(&adapter->hw, &adapter->phy_info); |
| 2332 | mutex_unlock(&adapter->mutex); | ||
| 2333 | } | 2327 | } |
| 2334 | 2328 | ||
| 2335 | /** | 2329 | /** |
| @@ -2345,9 +2339,6 @@ static void e1000_82547_tx_fifo_stall_task(struct work_struct *work) | |||
| 2345 | struct net_device *netdev = adapter->netdev; | 2339 | struct net_device *netdev = adapter->netdev; |
| 2346 | u32 tctl; | 2340 | u32 tctl; |
| 2347 | 2341 | ||
| 2348 | if (test_bit(__E1000_DOWN, &adapter->flags)) | ||
| 2349 | return; | ||
| 2350 | mutex_lock(&adapter->mutex); | ||
| 2351 | if (atomic_read(&adapter->tx_fifo_stall)) { | 2342 | if (atomic_read(&adapter->tx_fifo_stall)) { |
| 2352 | if ((er32(TDT) == er32(TDH)) && | 2343 | if ((er32(TDT) == er32(TDH)) && |
| 2353 | (er32(TDFT) == er32(TDFH)) && | 2344 | (er32(TDFT) == er32(TDFH)) && |
| @@ -2368,7 +2359,6 @@ static void e1000_82547_tx_fifo_stall_task(struct work_struct *work) | |||
| 2368 | schedule_delayed_work(&adapter->fifo_stall_task, 1); | 2359 | schedule_delayed_work(&adapter->fifo_stall_task, 1); |
| 2369 | } | 2360 | } |
| 2370 | } | 2361 | } |
| 2371 | mutex_unlock(&adapter->mutex); | ||
| 2372 | } | 2362 | } |
| 2373 | 2363 | ||
| 2374 | bool e1000_has_link(struct e1000_adapter *adapter) | 2364 | bool e1000_has_link(struct e1000_adapter *adapter) |
| @@ -2422,10 +2412,6 @@ static void e1000_watchdog(struct work_struct *work) | |||
| 2422 | struct e1000_tx_ring *txdr = adapter->tx_ring; | 2412 | struct e1000_tx_ring *txdr = adapter->tx_ring; |
| 2423 | u32 link, tctl; | 2413 | u32 link, tctl; |
| 2424 | 2414 | ||
| 2425 | if (test_bit(__E1000_DOWN, &adapter->flags)) | ||
| 2426 | return; | ||
| 2427 | |||
| 2428 | mutex_lock(&adapter->mutex); | ||
| 2429 | link = e1000_has_link(adapter); | 2415 | link = e1000_has_link(adapter); |
| 2430 | if ((netif_carrier_ok(netdev)) && link) | 2416 | if ((netif_carrier_ok(netdev)) && link) |
| 2431 | goto link_up; | 2417 | goto link_up; |
| @@ -2516,7 +2502,7 @@ link_up: | |||
| 2516 | adapter->tx_timeout_count++; | 2502 | adapter->tx_timeout_count++; |
| 2517 | schedule_work(&adapter->reset_task); | 2503 | schedule_work(&adapter->reset_task); |
| 2518 | /* exit immediately since reset is imminent */ | 2504 | /* exit immediately since reset is imminent */ |
| 2519 | goto unlock; | 2505 | return; |
| 2520 | } | 2506 | } |
| 2521 | } | 2507 | } |
| 2522 | 2508 | ||
| @@ -2544,9 +2530,6 @@ link_up: | |||
| 2544 | /* Reschedule the task */ | 2530 | /* Reschedule the task */ |
| 2545 | if (!test_bit(__E1000_DOWN, &adapter->flags)) | 2531 | if (!test_bit(__E1000_DOWN, &adapter->flags)) |
| 2546 | schedule_delayed_work(&adapter->watchdog_task, 2 * HZ); | 2532 | schedule_delayed_work(&adapter->watchdog_task, 2 * HZ); |
| 2547 | |||
| 2548 | unlock: | ||
| 2549 | mutex_unlock(&adapter->mutex); | ||
| 2550 | } | 2533 | } |
| 2551 | 2534 | ||
| 2552 | enum latency_range { | 2535 | enum latency_range { |
| @@ -3495,10 +3478,8 @@ static void e1000_reset_task(struct work_struct *work) | |||
| 3495 | struct e1000_adapter *adapter = | 3478 | struct e1000_adapter *adapter = |
| 3496 | container_of(work, struct e1000_adapter, reset_task); | 3479 | container_of(work, struct e1000_adapter, reset_task); |
| 3497 | 3480 | ||
| 3498 | if (test_bit(__E1000_DOWN, &adapter->flags)) | ||
| 3499 | return; | ||
| 3500 | e_err(drv, "Reset adapter\n"); | 3481 | e_err(drv, "Reset adapter\n"); |
| 3501 | e1000_reinit_safe(adapter); | 3482 | e1000_reinit_locked(adapter); |
| 3502 | } | 3483 | } |
| 3503 | 3484 | ||
| 3504 | /** | 3485 | /** |
| @@ -4963,6 +4944,11 @@ static int __e1000_shutdown(struct pci_dev *pdev, bool *enable_wake) | |||
| 4963 | netif_device_detach(netdev); | 4944 | netif_device_detach(netdev); |
| 4964 | 4945 | ||
| 4965 | if (netif_running(netdev)) { | 4946 | if (netif_running(netdev)) { |
| 4947 | int count = E1000_CHECK_RESET_COUNT; | ||
| 4948 | |||
| 4949 | while (test_bit(__E1000_RESETTING, &adapter->flags) && count--) | ||
| 4950 | usleep_range(10000, 20000); | ||
| 4951 | |||
| 4966 | WARN_ON(test_bit(__E1000_RESETTING, &adapter->flags)); | 4952 | WARN_ON(test_bit(__E1000_RESETTING, &adapter->flags)); |
| 4967 | e1000_down(adapter); | 4953 | e1000_down(adapter); |
| 4968 | } | 4954 | } |
diff --git a/drivers/net/ethernet/intel/i40e/i40e_main.c b/drivers/net/ethernet/intel/i40e/i40e_main.c index be15938ba213..12b0932204ba 100644 --- a/drivers/net/ethernet/intel/i40e/i40e_main.c +++ b/drivers/net/ethernet/intel/i40e/i40e_main.c | |||
| @@ -354,6 +354,9 @@ static struct rtnl_link_stats64 *i40e_get_netdev_stats_struct( | |||
| 354 | struct rtnl_link_stats64 *vsi_stats = i40e_get_vsi_stats_struct(vsi); | 354 | struct rtnl_link_stats64 *vsi_stats = i40e_get_vsi_stats_struct(vsi); |
| 355 | int i; | 355 | int i; |
| 356 | 356 | ||
| 357 | if (!vsi->tx_rings) | ||
| 358 | return stats; | ||
| 359 | |||
| 357 | rcu_read_lock(); | 360 | rcu_read_lock(); |
| 358 | for (i = 0; i < vsi->num_queue_pairs; i++) { | 361 | for (i = 0; i < vsi->num_queue_pairs; i++) { |
| 359 | struct i40e_ring *tx_ring, *rx_ring; | 362 | struct i40e_ring *tx_ring, *rx_ring; |
diff --git a/drivers/net/ethernet/intel/igb/e1000_phy.c b/drivers/net/ethernet/intel/igb/e1000_phy.c index c4c4fe332c7e..ad2b74d95138 100644 --- a/drivers/net/ethernet/intel/igb/e1000_phy.c +++ b/drivers/net/ethernet/intel/igb/e1000_phy.c | |||
| @@ -1728,7 +1728,10 @@ s32 igb_phy_has_link(struct e1000_hw *hw, u32 iterations, | |||
| 1728 | * ownership of the resources, wait and try again to | 1728 | * ownership of the resources, wait and try again to |
| 1729 | * see if they have relinquished the resources yet. | 1729 | * see if they have relinquished the resources yet. |
| 1730 | */ | 1730 | */ |
| 1731 | udelay(usec_interval); | 1731 | if (usec_interval >= 1000) |
| 1732 | mdelay(usec_interval/1000); | ||
| 1733 | else | ||
| 1734 | udelay(usec_interval); | ||
| 1732 | } | 1735 | } |
| 1733 | ret_val = hw->phy.ops.read_reg(hw, PHY_STATUS, &phy_status); | 1736 | ret_val = hw->phy.ops.read_reg(hw, PHY_STATUS, &phy_status); |
| 1734 | if (ret_val) | 1737 | if (ret_val) |
diff --git a/drivers/net/ethernet/intel/igb/igb_ethtool.c b/drivers/net/ethernet/intel/igb/igb_ethtool.c index b0f3666b1d7f..c3143da497c8 100644 --- a/drivers/net/ethernet/intel/igb/igb_ethtool.c +++ b/drivers/net/ethernet/intel/igb/igb_ethtool.c | |||
| @@ -2062,14 +2062,15 @@ static void igb_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol) | |||
| 2062 | { | 2062 | { |
| 2063 | struct igb_adapter *adapter = netdev_priv(netdev); | 2063 | struct igb_adapter *adapter = netdev_priv(netdev); |
| 2064 | 2064 | ||
| 2065 | wol->supported = WAKE_UCAST | WAKE_MCAST | | ||
| 2066 | WAKE_BCAST | WAKE_MAGIC | | ||
| 2067 | WAKE_PHY; | ||
| 2068 | wol->wolopts = 0; | 2065 | wol->wolopts = 0; |
| 2069 | 2066 | ||
| 2070 | if (!(adapter->flags & IGB_FLAG_WOL_SUPPORTED)) | 2067 | if (!(adapter->flags & IGB_FLAG_WOL_SUPPORTED)) |
| 2071 | return; | 2068 | return; |
| 2072 | 2069 | ||
| 2070 | wol->supported = WAKE_UCAST | WAKE_MCAST | | ||
| 2071 | WAKE_BCAST | WAKE_MAGIC | | ||
| 2072 | WAKE_PHY; | ||
| 2073 | |||
| 2073 | /* apply any specific unsupported masks here */ | 2074 | /* apply any specific unsupported masks here */ |
| 2074 | switch (adapter->hw.device_id) { | 2075 | switch (adapter->hw.device_id) { |
| 2075 | default: | 2076 | default: |
diff --git a/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c b/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c index 0c55079ebee3..cc06854296a3 100644 --- a/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c +++ b/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c | |||
| @@ -4251,8 +4251,8 @@ static void ixgbe_disable_fwd_ring(struct ixgbe_fwd_adapter *vadapter, | |||
| 4251 | rx_ring->l2_accel_priv = NULL; | 4251 | rx_ring->l2_accel_priv = NULL; |
| 4252 | } | 4252 | } |
| 4253 | 4253 | ||
| 4254 | int ixgbe_fwd_ring_down(struct net_device *vdev, | 4254 | static int ixgbe_fwd_ring_down(struct net_device *vdev, |
| 4255 | struct ixgbe_fwd_adapter *accel) | 4255 | struct ixgbe_fwd_adapter *accel) |
| 4256 | { | 4256 | { |
| 4257 | struct ixgbe_adapter *adapter = accel->real_adapter; | 4257 | struct ixgbe_adapter *adapter = accel->real_adapter; |
| 4258 | unsigned int rxbase = accel->rx_base_queue; | 4258 | unsigned int rxbase = accel->rx_base_queue; |
| @@ -7986,10 +7986,9 @@ skip_sriov: | |||
| 7986 | NETIF_F_TSO | | 7986 | NETIF_F_TSO | |
| 7987 | NETIF_F_TSO6 | | 7987 | NETIF_F_TSO6 | |
| 7988 | NETIF_F_RXHASH | | 7988 | NETIF_F_RXHASH | |
| 7989 | NETIF_F_RXCSUM | | 7989 | NETIF_F_RXCSUM; |
| 7990 | NETIF_F_HW_L2FW_DOFFLOAD; | ||
| 7991 | 7990 | ||
| 7992 | netdev->hw_features = netdev->features; | 7991 | netdev->hw_features = netdev->features | NETIF_F_HW_L2FW_DOFFLOAD; |
| 7993 | 7992 | ||
| 7994 | switch (adapter->hw.mac.type) { | 7993 | switch (adapter->hw.mac.type) { |
| 7995 | case ixgbe_mac_82599EB: | 7994 | case ixgbe_mac_82599EB: |
diff --git a/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.c b/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.c index e4c676006be9..39217e5ff7dc 100644 --- a/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.c +++ b/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.c | |||
| @@ -46,6 +46,7 @@ static bool ixgbe_get_i2c_data(u32 *i2cctl); | |||
| 46 | static void ixgbe_i2c_bus_clear(struct ixgbe_hw *hw); | 46 | static void ixgbe_i2c_bus_clear(struct ixgbe_hw *hw); |
| 47 | static enum ixgbe_phy_type ixgbe_get_phy_type_from_id(u32 phy_id); | 47 | static enum ixgbe_phy_type ixgbe_get_phy_type_from_id(u32 phy_id); |
| 48 | static s32 ixgbe_get_phy_id(struct ixgbe_hw *hw); | 48 | static s32 ixgbe_get_phy_id(struct ixgbe_hw *hw); |
| 49 | static s32 ixgbe_identify_qsfp_module_generic(struct ixgbe_hw *hw); | ||
| 49 | 50 | ||
| 50 | /** | 51 | /** |
| 51 | * ixgbe_identify_phy_generic - Get physical layer module | 52 | * ixgbe_identify_phy_generic - Get physical layer module |
| @@ -1164,7 +1165,7 @@ err_read_i2c_eeprom: | |||
| 1164 | * | 1165 | * |
| 1165 | * Searches for and identifies the QSFP module and assigns appropriate PHY type | 1166 | * Searches for and identifies the QSFP module and assigns appropriate PHY type |
| 1166 | **/ | 1167 | **/ |
| 1167 | s32 ixgbe_identify_qsfp_module_generic(struct ixgbe_hw *hw) | 1168 | static s32 ixgbe_identify_qsfp_module_generic(struct ixgbe_hw *hw) |
| 1168 | { | 1169 | { |
| 1169 | struct ixgbe_adapter *adapter = hw->back; | 1170 | struct ixgbe_adapter *adapter = hw->back; |
| 1170 | s32 status = IXGBE_ERR_PHY_ADDR_INVALID; | 1171 | s32 status = IXGBE_ERR_PHY_ADDR_INVALID; |
diff --git a/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.h b/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.h index aae900a256da..fffcbdd2bf0e 100644 --- a/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.h +++ b/drivers/net/ethernet/intel/ixgbe/ixgbe_phy.h | |||
| @@ -145,7 +145,6 @@ s32 ixgbe_get_phy_firmware_version_generic(struct ixgbe_hw *hw, | |||
| 145 | s32 ixgbe_reset_phy_nl(struct ixgbe_hw *hw); | 145 | s32 ixgbe_reset_phy_nl(struct ixgbe_hw *hw); |
| 146 | s32 ixgbe_identify_module_generic(struct ixgbe_hw *hw); | 146 | s32 ixgbe_identify_module_generic(struct ixgbe_hw *hw); |
| 147 | s32 ixgbe_identify_sfp_module_generic(struct ixgbe_hw *hw); | 147 | s32 ixgbe_identify_sfp_module_generic(struct ixgbe_hw *hw); |
| 148 | s32 ixgbe_identify_qsfp_module_generic(struct ixgbe_hw *hw); | ||
| 149 | s32 ixgbe_get_sfp_init_sequence_offsets(struct ixgbe_hw *hw, | 148 | s32 ixgbe_get_sfp_init_sequence_offsets(struct ixgbe_hw *hw, |
| 150 | u16 *list_offset, | 149 | u16 *list_offset, |
| 151 | u16 *data_offset); | 150 | u16 *data_offset); |
diff --git a/drivers/net/ethernet/marvell/mvneta.c b/drivers/net/ethernet/marvell/mvneta.c index b8e232b4ea2d..d5f0d72e5e33 100644 --- a/drivers/net/ethernet/marvell/mvneta.c +++ b/drivers/net/ethernet/marvell/mvneta.c | |||
| @@ -1378,7 +1378,7 @@ static void mvneta_rxq_drop_pkts(struct mvneta_port *pp, | |||
| 1378 | 1378 | ||
| 1379 | dev_kfree_skb_any(skb); | 1379 | dev_kfree_skb_any(skb); |
| 1380 | dma_unmap_single(pp->dev->dev.parent, rx_desc->buf_phys_addr, | 1380 | dma_unmap_single(pp->dev->dev.parent, rx_desc->buf_phys_addr, |
| 1381 | rx_desc->data_size, DMA_FROM_DEVICE); | 1381 | MVNETA_RX_BUF_SIZE(pp->pkt_size), DMA_FROM_DEVICE); |
| 1382 | } | 1382 | } |
| 1383 | 1383 | ||
| 1384 | if (rx_done) | 1384 | if (rx_done) |
| @@ -1424,7 +1424,7 @@ static int mvneta_rx(struct mvneta_port *pp, int rx_todo, | |||
| 1424 | } | 1424 | } |
| 1425 | 1425 | ||
| 1426 | dma_unmap_single(pp->dev->dev.parent, rx_desc->buf_phys_addr, | 1426 | dma_unmap_single(pp->dev->dev.parent, rx_desc->buf_phys_addr, |
| 1427 | rx_desc->data_size, DMA_FROM_DEVICE); | 1427 | MVNETA_RX_BUF_SIZE(pp->pkt_size), DMA_FROM_DEVICE); |
| 1428 | 1428 | ||
| 1429 | rx_bytes = rx_desc->data_size - | 1429 | rx_bytes = rx_desc->data_size - |
| 1430 | (ETH_FCS_LEN + MVNETA_MH_SIZE); | 1430 | (ETH_FCS_LEN + MVNETA_MH_SIZE); |
diff --git a/drivers/net/ethernet/mellanox/mlx4/en_selftest.c b/drivers/net/ethernet/mellanox/mlx4/en_selftest.c index 40626690e8a8..c11d063473e5 100644 --- a/drivers/net/ethernet/mellanox/mlx4/en_selftest.c +++ b/drivers/net/ethernet/mellanox/mlx4/en_selftest.c | |||
| @@ -140,7 +140,6 @@ void mlx4_en_ex_selftest(struct net_device *dev, u32 *flags, u64 *buf) | |||
| 140 | { | 140 | { |
| 141 | struct mlx4_en_priv *priv = netdev_priv(dev); | 141 | struct mlx4_en_priv *priv = netdev_priv(dev); |
| 142 | struct mlx4_en_dev *mdev = priv->mdev; | 142 | struct mlx4_en_dev *mdev = priv->mdev; |
| 143 | struct mlx4_en_tx_ring *tx_ring; | ||
| 144 | int i, carrier_ok; | 143 | int i, carrier_ok; |
| 145 | 144 | ||
| 146 | memset(buf, 0, sizeof(u64) * MLX4_EN_NUM_SELF_TEST); | 145 | memset(buf, 0, sizeof(u64) * MLX4_EN_NUM_SELF_TEST); |
| @@ -150,16 +149,10 @@ void mlx4_en_ex_selftest(struct net_device *dev, u32 *flags, u64 *buf) | |||
| 150 | carrier_ok = netif_carrier_ok(dev); | 149 | carrier_ok = netif_carrier_ok(dev); |
| 151 | 150 | ||
| 152 | netif_carrier_off(dev); | 151 | netif_carrier_off(dev); |
| 153 | retry_tx: | ||
| 154 | /* Wait until all tx queues are empty. | 152 | /* Wait until all tx queues are empty. |
| 155 | * there should not be any additional incoming traffic | 153 | * there should not be any additional incoming traffic |
| 156 | * since we turned the carrier off */ | 154 | * since we turned the carrier off */ |
| 157 | msleep(200); | 155 | msleep(200); |
| 158 | for (i = 0; i < priv->tx_ring_num && carrier_ok; i++) { | ||
| 159 | tx_ring = priv->tx_ring[i]; | ||
| 160 | if (tx_ring->prod != (tx_ring->cons + tx_ring->last_nr_txbb)) | ||
| 161 | goto retry_tx; | ||
| 162 | } | ||
| 163 | 156 | ||
| 164 | if (priv->mdev->dev->caps.flags & | 157 | if (priv->mdev->dev->caps.flags & |
| 165 | MLX4_DEV_CAP_FLAG_UC_LOOPBACK) { | 158 | MLX4_DEV_CAP_FLAG_UC_LOOPBACK) { |
diff --git a/drivers/net/ethernet/mellanox/mlx4/main.c b/drivers/net/ethernet/mellanox/mlx4/main.c index 5789ea2c934d..01fc6515384d 100644 --- a/drivers/net/ethernet/mellanox/mlx4/main.c +++ b/drivers/net/ethernet/mellanox/mlx4/main.c | |||
| @@ -2635,6 +2635,8 @@ static int __init mlx4_init(void) | |||
| 2635 | return -ENOMEM; | 2635 | return -ENOMEM; |
| 2636 | 2636 | ||
| 2637 | ret = pci_register_driver(&mlx4_driver); | 2637 | ret = pci_register_driver(&mlx4_driver); |
| 2638 | if (ret < 0) | ||
| 2639 | destroy_workqueue(mlx4_wq); | ||
| 2638 | return ret < 0 ? ret : 0; | 2640 | return ret < 0 ? ret : 0; |
| 2639 | } | 2641 | } |
| 2640 | 2642 | ||
diff --git a/drivers/net/ethernet/nvidia/forcedeth.c b/drivers/net/ethernet/nvidia/forcedeth.c index 2d045be4b5cf..1e8b9514718b 100644 --- a/drivers/net/ethernet/nvidia/forcedeth.c +++ b/drivers/net/ethernet/nvidia/forcedeth.c | |||
| @@ -5150,8 +5150,10 @@ static void nv_self_test(struct net_device *dev, struct ethtool_test *test, u64 | |||
| 5150 | { | 5150 | { |
| 5151 | struct fe_priv *np = netdev_priv(dev); | 5151 | struct fe_priv *np = netdev_priv(dev); |
| 5152 | u8 __iomem *base = get_hwbase(dev); | 5152 | u8 __iomem *base = get_hwbase(dev); |
| 5153 | int result; | 5153 | int result, count; |
| 5154 | memset(buffer, 0, nv_get_sset_count(dev, ETH_SS_TEST)*sizeof(u64)); | 5154 | |
| 5155 | count = nv_get_sset_count(dev, ETH_SS_TEST); | ||
| 5156 | memset(buffer, 0, count * sizeof(u64)); | ||
| 5155 | 5157 | ||
| 5156 | if (!nv_link_test(dev)) { | 5158 | if (!nv_link_test(dev)) { |
| 5157 | test->flags |= ETH_TEST_FL_FAILED; | 5159 | test->flags |= ETH_TEST_FL_FAILED; |
| @@ -5195,7 +5197,7 @@ static void nv_self_test(struct net_device *dev, struct ethtool_test *test, u64 | |||
| 5195 | return; | 5197 | return; |
| 5196 | } | 5198 | } |
| 5197 | 5199 | ||
| 5198 | if (!nv_loopback_test(dev)) { | 5200 | if (count > NV_TEST_COUNT_BASE && !nv_loopback_test(dev)) { |
| 5199 | test->flags |= ETH_TEST_FL_FAILED; | 5201 | test->flags |= ETH_TEST_FL_FAILED; |
| 5200 | buffer[3] = 1; | 5202 | buffer[3] = 1; |
| 5201 | } | 5203 | } |
diff --git a/drivers/net/ethernet/qlogic/qlge/qlge.h b/drivers/net/ethernet/qlogic/qlge/qlge.h index 0c9c4e895595..03517478e589 100644 --- a/drivers/net/ethernet/qlogic/qlge/qlge.h +++ b/drivers/net/ethernet/qlogic/qlge/qlge.h | |||
| @@ -18,7 +18,7 @@ | |||
| 18 | */ | 18 | */ |
| 19 | #define DRV_NAME "qlge" | 19 | #define DRV_NAME "qlge" |
| 20 | #define DRV_STRING "QLogic 10 Gigabit PCI-E Ethernet Driver " | 20 | #define DRV_STRING "QLogic 10 Gigabit PCI-E Ethernet Driver " |
| 21 | #define DRV_VERSION "1.00.00.33" | 21 | #define DRV_VERSION "1.00.00.34" |
| 22 | 22 | ||
| 23 | #define WQ_ADDR_ALIGN 0x3 /* 4 byte alignment */ | 23 | #define WQ_ADDR_ALIGN 0x3 /* 4 byte alignment */ |
| 24 | 24 | ||
diff --git a/drivers/net/ethernet/qlogic/qlge/qlge_ethtool.c b/drivers/net/ethernet/qlogic/qlge/qlge_ethtool.c index 0780e039b271..8dee1beb9854 100644 --- a/drivers/net/ethernet/qlogic/qlge/qlge_ethtool.c +++ b/drivers/net/ethernet/qlogic/qlge/qlge_ethtool.c | |||
| @@ -181,6 +181,7 @@ static const char ql_gstrings_test[][ETH_GSTRING_LEN] = { | |||
| 181 | }; | 181 | }; |
| 182 | #define QLGE_TEST_LEN (sizeof(ql_gstrings_test) / ETH_GSTRING_LEN) | 182 | #define QLGE_TEST_LEN (sizeof(ql_gstrings_test) / ETH_GSTRING_LEN) |
| 183 | #define QLGE_STATS_LEN ARRAY_SIZE(ql_gstrings_stats) | 183 | #define QLGE_STATS_LEN ARRAY_SIZE(ql_gstrings_stats) |
| 184 | #define QLGE_RCV_MAC_ERR_STATS 7 | ||
| 184 | 185 | ||
| 185 | static int ql_update_ring_coalescing(struct ql_adapter *qdev) | 186 | static int ql_update_ring_coalescing(struct ql_adapter *qdev) |
| 186 | { | 187 | { |
| @@ -280,6 +281,9 @@ static void ql_update_stats(struct ql_adapter *qdev) | |||
| 280 | iter++; | 281 | iter++; |
| 281 | } | 282 | } |
| 282 | 283 | ||
| 284 | /* Update receive mac error statistics */ | ||
| 285 | iter += QLGE_RCV_MAC_ERR_STATS; | ||
| 286 | |||
| 283 | /* | 287 | /* |
| 284 | * Get Per-priority TX pause frame counter statistics. | 288 | * Get Per-priority TX pause frame counter statistics. |
| 285 | */ | 289 | */ |
diff --git a/drivers/net/ethernet/qlogic/qlge/qlge_main.c b/drivers/net/ethernet/qlogic/qlge/qlge_main.c index a245dc18d769..449f506d2e8f 100644 --- a/drivers/net/ethernet/qlogic/qlge/qlge_main.c +++ b/drivers/net/ethernet/qlogic/qlge/qlge_main.c | |||
| @@ -2376,14 +2376,6 @@ static netdev_features_t qlge_fix_features(struct net_device *ndev, | |||
| 2376 | netdev_features_t features) | 2376 | netdev_features_t features) |
| 2377 | { | 2377 | { |
| 2378 | int err; | 2378 | int err; |
| 2379 | /* | ||
| 2380 | * Since there is no support for separate rx/tx vlan accel | ||
| 2381 | * enable/disable make sure tx flag is always in same state as rx. | ||
| 2382 | */ | ||
| 2383 | if (features & NETIF_F_HW_VLAN_CTAG_RX) | ||
| 2384 | features |= NETIF_F_HW_VLAN_CTAG_TX; | ||
| 2385 | else | ||
| 2386 | features &= ~NETIF_F_HW_VLAN_CTAG_TX; | ||
| 2387 | 2379 | ||
| 2388 | /* Update the behavior of vlan accel in the adapter */ | 2380 | /* Update the behavior of vlan accel in the adapter */ |
| 2389 | err = qlge_update_hw_vlan_features(ndev, features); | 2381 | err = qlge_update_hw_vlan_features(ndev, features); |
diff --git a/drivers/net/ethernet/realtek/8139cp.c b/drivers/net/ethernet/realtek/8139cp.c index f2a2128165dd..737c1a881f78 100644 --- a/drivers/net/ethernet/realtek/8139cp.c +++ b/drivers/net/ethernet/realtek/8139cp.c | |||
| @@ -678,9 +678,6 @@ static void cp_tx (struct cp_private *cp) | |||
| 678 | le32_to_cpu(txd->opts1) & 0xffff, | 678 | le32_to_cpu(txd->opts1) & 0xffff, |
| 679 | PCI_DMA_TODEVICE); | 679 | PCI_DMA_TODEVICE); |
| 680 | 680 | ||
| 681 | bytes_compl += skb->len; | ||
| 682 | pkts_compl++; | ||
| 683 | |||
| 684 | if (status & LastFrag) { | 681 | if (status & LastFrag) { |
| 685 | if (status & (TxError | TxFIFOUnder)) { | 682 | if (status & (TxError | TxFIFOUnder)) { |
| 686 | netif_dbg(cp, tx_err, cp->dev, | 683 | netif_dbg(cp, tx_err, cp->dev, |
| @@ -702,6 +699,8 @@ static void cp_tx (struct cp_private *cp) | |||
| 702 | netif_dbg(cp, tx_done, cp->dev, | 699 | netif_dbg(cp, tx_done, cp->dev, |
| 703 | "tx done, slot %d\n", tx_tail); | 700 | "tx done, slot %d\n", tx_tail); |
| 704 | } | 701 | } |
| 702 | bytes_compl += skb->len; | ||
| 703 | pkts_compl++; | ||
| 705 | dev_kfree_skb_irq(skb); | 704 | dev_kfree_skb_irq(skb); |
| 706 | } | 705 | } |
| 707 | 706 | ||
diff --git a/drivers/net/ethernet/realtek/r8169.c b/drivers/net/ethernet/realtek/r8169.c index 799387570766..c737f0ea5de7 100644 --- a/drivers/net/ethernet/realtek/r8169.c +++ b/drivers/net/ethernet/realtek/r8169.c | |||
| @@ -3465,6 +3465,11 @@ static void rtl8168g_1_hw_phy_config(struct rtl8169_private *tp) | |||
| 3465 | rtl_writephy(tp, 0x14, 0x9065); | 3465 | rtl_writephy(tp, 0x14, 0x9065); |
| 3466 | rtl_writephy(tp, 0x14, 0x1065); | 3466 | rtl_writephy(tp, 0x14, 0x1065); |
| 3467 | 3467 | ||
| 3468 | /* Check ALDPS bit, disable it if enabled */ | ||
| 3469 | rtl_writephy(tp, 0x1f, 0x0a43); | ||
| 3470 | if (rtl_readphy(tp, 0x10) & 0x0004) | ||
| 3471 | rtl_w1w0_phy(tp, 0x10, 0x0000, 0x0004); | ||
| 3472 | |||
| 3468 | rtl_writephy(tp, 0x1f, 0x0000); | 3473 | rtl_writephy(tp, 0x1f, 0x0000); |
| 3469 | } | 3474 | } |
| 3470 | 3475 | ||
diff --git a/drivers/net/ethernet/sfc/efx.c b/drivers/net/ethernet/sfc/efx.c index 2e27837ce6a2..fd844b53e385 100644 --- a/drivers/net/ethernet/sfc/efx.c +++ b/drivers/net/ethernet/sfc/efx.c | |||
| @@ -585,7 +585,7 @@ static void efx_start_datapath(struct efx_nic *efx) | |||
| 585 | EFX_MAX_FRAME_LEN(efx->net_dev->mtu) + | 585 | EFX_MAX_FRAME_LEN(efx->net_dev->mtu) + |
| 586 | efx->type->rx_buffer_padding); | 586 | efx->type->rx_buffer_padding); |
| 587 | rx_buf_len = (sizeof(struct efx_rx_page_state) + | 587 | rx_buf_len = (sizeof(struct efx_rx_page_state) + |
| 588 | NET_IP_ALIGN + efx->rx_dma_len); | 588 | efx->rx_ip_align + efx->rx_dma_len); |
| 589 | if (rx_buf_len <= PAGE_SIZE) { | 589 | if (rx_buf_len <= PAGE_SIZE) { |
| 590 | efx->rx_scatter = efx->type->always_rx_scatter; | 590 | efx->rx_scatter = efx->type->always_rx_scatter; |
| 591 | efx->rx_buffer_order = 0; | 591 | efx->rx_buffer_order = 0; |
| @@ -645,6 +645,8 @@ static void efx_start_datapath(struct efx_nic *efx) | |||
| 645 | WARN_ON(channel->rx_pkt_n_frags); | 645 | WARN_ON(channel->rx_pkt_n_frags); |
| 646 | } | 646 | } |
| 647 | 647 | ||
| 648 | efx_ptp_start_datapath(efx); | ||
| 649 | |||
| 648 | if (netif_device_present(efx->net_dev)) | 650 | if (netif_device_present(efx->net_dev)) |
| 649 | netif_tx_wake_all_queues(efx->net_dev); | 651 | netif_tx_wake_all_queues(efx->net_dev); |
| 650 | } | 652 | } |
| @@ -659,6 +661,8 @@ static void efx_stop_datapath(struct efx_nic *efx) | |||
| 659 | EFX_ASSERT_RESET_SERIALISED(efx); | 661 | EFX_ASSERT_RESET_SERIALISED(efx); |
| 660 | BUG_ON(efx->port_enabled); | 662 | BUG_ON(efx->port_enabled); |
| 661 | 663 | ||
| 664 | efx_ptp_stop_datapath(efx); | ||
| 665 | |||
| 662 | /* Stop RX refill */ | 666 | /* Stop RX refill */ |
| 663 | efx_for_each_channel(channel, efx) { | 667 | efx_for_each_channel(channel, efx) { |
| 664 | efx_for_each_channel_rx_queue(rx_queue, channel) | 668 | efx_for_each_channel_rx_queue(rx_queue, channel) |
| @@ -2540,6 +2544,8 @@ static int efx_init_struct(struct efx_nic *efx, | |||
| 2540 | 2544 | ||
| 2541 | efx->net_dev = net_dev; | 2545 | efx->net_dev = net_dev; |
| 2542 | efx->rx_prefix_size = efx->type->rx_prefix_size; | 2546 | efx->rx_prefix_size = efx->type->rx_prefix_size; |
| 2547 | efx->rx_ip_align = | ||
| 2548 | NET_IP_ALIGN ? (efx->rx_prefix_size + NET_IP_ALIGN) % 4 : 0; | ||
| 2543 | efx->rx_packet_hash_offset = | 2549 | efx->rx_packet_hash_offset = |
| 2544 | efx->type->rx_hash_offset - efx->type->rx_prefix_size; | 2550 | efx->type->rx_hash_offset - efx->type->rx_prefix_size; |
| 2545 | spin_lock_init(&efx->stats_lock); | 2551 | spin_lock_init(&efx->stats_lock); |
diff --git a/drivers/net/ethernet/sfc/mcdi.c b/drivers/net/ethernet/sfc/mcdi.c index 366c8e3e3784..4b0bd8a1514d 100644 --- a/drivers/net/ethernet/sfc/mcdi.c +++ b/drivers/net/ethernet/sfc/mcdi.c | |||
| @@ -50,6 +50,7 @@ struct efx_mcdi_async_param { | |||
| 50 | static void efx_mcdi_timeout_async(unsigned long context); | 50 | static void efx_mcdi_timeout_async(unsigned long context); |
| 51 | static int efx_mcdi_drv_attach(struct efx_nic *efx, bool driver_operating, | 51 | static int efx_mcdi_drv_attach(struct efx_nic *efx, bool driver_operating, |
| 52 | bool *was_attached_out); | 52 | bool *was_attached_out); |
| 53 | static bool efx_mcdi_poll_once(struct efx_nic *efx); | ||
| 53 | 54 | ||
| 54 | static inline struct efx_mcdi_iface *efx_mcdi(struct efx_nic *efx) | 55 | static inline struct efx_mcdi_iface *efx_mcdi(struct efx_nic *efx) |
| 55 | { | 56 | { |
| @@ -237,6 +238,21 @@ static void efx_mcdi_read_response_header(struct efx_nic *efx) | |||
| 237 | } | 238 | } |
| 238 | } | 239 | } |
| 239 | 240 | ||
| 241 | static bool efx_mcdi_poll_once(struct efx_nic *efx) | ||
| 242 | { | ||
| 243 | struct efx_mcdi_iface *mcdi = efx_mcdi(efx); | ||
| 244 | |||
| 245 | rmb(); | ||
| 246 | if (!efx->type->mcdi_poll_response(efx)) | ||
| 247 | return false; | ||
| 248 | |||
| 249 | spin_lock_bh(&mcdi->iface_lock); | ||
| 250 | efx_mcdi_read_response_header(efx); | ||
| 251 | spin_unlock_bh(&mcdi->iface_lock); | ||
| 252 | |||
| 253 | return true; | ||
| 254 | } | ||
| 255 | |||
| 240 | static int efx_mcdi_poll(struct efx_nic *efx) | 256 | static int efx_mcdi_poll(struct efx_nic *efx) |
| 241 | { | 257 | { |
| 242 | struct efx_mcdi_iface *mcdi = efx_mcdi(efx); | 258 | struct efx_mcdi_iface *mcdi = efx_mcdi(efx); |
| @@ -272,18 +288,13 @@ static int efx_mcdi_poll(struct efx_nic *efx) | |||
| 272 | 288 | ||
| 273 | time = jiffies; | 289 | time = jiffies; |
| 274 | 290 | ||
| 275 | rmb(); | 291 | if (efx_mcdi_poll_once(efx)) |
| 276 | if (efx->type->mcdi_poll_response(efx)) | ||
| 277 | break; | 292 | break; |
| 278 | 293 | ||
| 279 | if (time_after(time, finish)) | 294 | if (time_after(time, finish)) |
| 280 | return -ETIMEDOUT; | 295 | return -ETIMEDOUT; |
| 281 | } | 296 | } |
| 282 | 297 | ||
| 283 | spin_lock_bh(&mcdi->iface_lock); | ||
| 284 | efx_mcdi_read_response_header(efx); | ||
| 285 | spin_unlock_bh(&mcdi->iface_lock); | ||
| 286 | |||
| 287 | /* Return rc=0 like wait_event_timeout() */ | 298 | /* Return rc=0 like wait_event_timeout() */ |
| 288 | return 0; | 299 | return 0; |
| 289 | } | 300 | } |
| @@ -619,6 +630,16 @@ int efx_mcdi_rpc_finish(struct efx_nic *efx, unsigned cmd, size_t inlen, | |||
| 619 | rc = efx_mcdi_await_completion(efx); | 630 | rc = efx_mcdi_await_completion(efx); |
| 620 | 631 | ||
| 621 | if (rc != 0) { | 632 | if (rc != 0) { |
| 633 | netif_err(efx, hw, efx->net_dev, | ||
| 634 | "MC command 0x%x inlen %d mode %d timed out\n", | ||
| 635 | cmd, (int)inlen, mcdi->mode); | ||
| 636 | |||
| 637 | if (mcdi->mode == MCDI_MODE_EVENTS && efx_mcdi_poll_once(efx)) { | ||
| 638 | netif_err(efx, hw, efx->net_dev, | ||
| 639 | "MCDI request was completed without an event\n"); | ||
| 640 | rc = 0; | ||
| 641 | } | ||
| 642 | |||
| 622 | /* Close the race with efx_mcdi_ev_cpl() executing just too late | 643 | /* Close the race with efx_mcdi_ev_cpl() executing just too late |
| 623 | * and completing a request we've just cancelled, by ensuring | 644 | * and completing a request we've just cancelled, by ensuring |
| 624 | * that the seqno check therein fails. | 645 | * that the seqno check therein fails. |
| @@ -627,11 +648,9 @@ int efx_mcdi_rpc_finish(struct efx_nic *efx, unsigned cmd, size_t inlen, | |||
| 627 | ++mcdi->seqno; | 648 | ++mcdi->seqno; |
| 628 | ++mcdi->credits; | 649 | ++mcdi->credits; |
| 629 | spin_unlock_bh(&mcdi->iface_lock); | 650 | spin_unlock_bh(&mcdi->iface_lock); |
| 651 | } | ||
| 630 | 652 | ||
| 631 | netif_err(efx, hw, efx->net_dev, | 653 | if (rc == 0) { |
| 632 | "MC command 0x%x inlen %d mode %d timed out\n", | ||
| 633 | cmd, (int)inlen, mcdi->mode); | ||
| 634 | } else { | ||
| 635 | size_t hdr_len, data_len; | 654 | size_t hdr_len, data_len; |
| 636 | 655 | ||
| 637 | /* At the very least we need a memory barrier here to ensure | 656 | /* At the very least we need a memory barrier here to ensure |
diff --git a/drivers/net/ethernet/sfc/mcdi.h b/drivers/net/ethernet/sfc/mcdi.h index 656a3277c2b2..15816cacb548 100644 --- a/drivers/net/ethernet/sfc/mcdi.h +++ b/drivers/net/ethernet/sfc/mcdi.h | |||
| @@ -75,6 +75,8 @@ struct efx_mcdi_mon { | |||
| 75 | unsigned long last_update; | 75 | unsigned long last_update; |
| 76 | struct device *device; | 76 | struct device *device; |
| 77 | struct efx_mcdi_mon_attribute *attrs; | 77 | struct efx_mcdi_mon_attribute *attrs; |
| 78 | struct attribute_group group; | ||
| 79 | const struct attribute_group *groups[2]; | ||
| 78 | unsigned int n_attrs; | 80 | unsigned int n_attrs; |
| 79 | }; | 81 | }; |
| 80 | 82 | ||
diff --git a/drivers/net/ethernet/sfc/mcdi_mon.c b/drivers/net/ethernet/sfc/mcdi_mon.c index 4cc5d95b2a5a..d72ad4fc3617 100644 --- a/drivers/net/ethernet/sfc/mcdi_mon.c +++ b/drivers/net/ethernet/sfc/mcdi_mon.c | |||
| @@ -139,17 +139,10 @@ static int efx_mcdi_mon_update(struct efx_nic *efx) | |||
| 139 | return rc; | 139 | return rc; |
| 140 | } | 140 | } |
| 141 | 141 | ||
| 142 | static ssize_t efx_mcdi_mon_show_name(struct device *dev, | ||
| 143 | struct device_attribute *attr, | ||
| 144 | char *buf) | ||
| 145 | { | ||
| 146 | return sprintf(buf, "%s\n", KBUILD_MODNAME); | ||
| 147 | } | ||
| 148 | |||
| 149 | static int efx_mcdi_mon_get_entry(struct device *dev, unsigned int index, | 142 | static int efx_mcdi_mon_get_entry(struct device *dev, unsigned int index, |
| 150 | efx_dword_t *entry) | 143 | efx_dword_t *entry) |
| 151 | { | 144 | { |
| 152 | struct efx_nic *efx = dev_get_drvdata(dev); | 145 | struct efx_nic *efx = dev_get_drvdata(dev->parent); |
| 153 | struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); | 146 | struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); |
| 154 | int rc; | 147 | int rc; |
| 155 | 148 | ||
| @@ -263,7 +256,7 @@ static ssize_t efx_mcdi_mon_show_label(struct device *dev, | |||
| 263 | efx_mcdi_sensor_type[mon_attr->type].label); | 256 | efx_mcdi_sensor_type[mon_attr->type].label); |
| 264 | } | 257 | } |
| 265 | 258 | ||
| 266 | static int | 259 | static void |
| 267 | efx_mcdi_mon_add_attr(struct efx_nic *efx, const char *name, | 260 | efx_mcdi_mon_add_attr(struct efx_nic *efx, const char *name, |
| 268 | ssize_t (*reader)(struct device *, | 261 | ssize_t (*reader)(struct device *, |
| 269 | struct device_attribute *, char *), | 262 | struct device_attribute *, char *), |
| @@ -272,7 +265,6 @@ efx_mcdi_mon_add_attr(struct efx_nic *efx, const char *name, | |||
| 272 | { | 265 | { |
| 273 | struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); | 266 | struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); |
| 274 | struct efx_mcdi_mon_attribute *attr = &hwmon->attrs[hwmon->n_attrs]; | 267 | struct efx_mcdi_mon_attribute *attr = &hwmon->attrs[hwmon->n_attrs]; |
| 275 | int rc; | ||
| 276 | 268 | ||
| 277 | strlcpy(attr->name, name, sizeof(attr->name)); | 269 | strlcpy(attr->name, name, sizeof(attr->name)); |
| 278 | attr->index = index; | 270 | attr->index = index; |
| @@ -286,10 +278,7 @@ efx_mcdi_mon_add_attr(struct efx_nic *efx, const char *name, | |||
| 286 | attr->dev_attr.attr.name = attr->name; | 278 | attr->dev_attr.attr.name = attr->name; |
| 287 | attr->dev_attr.attr.mode = S_IRUGO; | 279 | attr->dev_attr.attr.mode = S_IRUGO; |
| 288 | attr->dev_attr.show = reader; | 280 | attr->dev_attr.show = reader; |
| 289 | rc = device_create_file(&efx->pci_dev->dev, &attr->dev_attr); | 281 | hwmon->group.attrs[hwmon->n_attrs++] = &attr->dev_attr.attr; |
| 290 | if (rc == 0) | ||
| 291 | ++hwmon->n_attrs; | ||
| 292 | return rc; | ||
| 293 | } | 282 | } |
| 294 | 283 | ||
| 295 | int efx_mcdi_mon_probe(struct efx_nic *efx) | 284 | int efx_mcdi_mon_probe(struct efx_nic *efx) |
| @@ -338,26 +327,22 @@ int efx_mcdi_mon_probe(struct efx_nic *efx) | |||
| 338 | efx_mcdi_mon_update(efx); | 327 | efx_mcdi_mon_update(efx); |
| 339 | 328 | ||
| 340 | /* Allocate space for the maximum possible number of | 329 | /* Allocate space for the maximum possible number of |
| 341 | * attributes for this set of sensors: name of the driver plus | 330 | * attributes for this set of sensors: |
| 342 | * value, min, max, crit, alarm and label for each sensor. | 331 | * value, min, max, crit, alarm and label for each sensor. |
| 343 | */ | 332 | */ |
| 344 | n_attrs = 1 + 6 * n_sensors; | 333 | n_attrs = 6 * n_sensors; |
| 345 | hwmon->attrs = kcalloc(n_attrs, sizeof(*hwmon->attrs), GFP_KERNEL); | 334 | hwmon->attrs = kcalloc(n_attrs, sizeof(*hwmon->attrs), GFP_KERNEL); |
| 346 | if (!hwmon->attrs) { | 335 | if (!hwmon->attrs) { |
| 347 | rc = -ENOMEM; | 336 | rc = -ENOMEM; |
| 348 | goto fail; | 337 | goto fail; |
| 349 | } | 338 | } |
| 350 | 339 | hwmon->group.attrs = kcalloc(n_attrs + 1, sizeof(struct attribute *), | |
| 351 | hwmon->device = hwmon_device_register(&efx->pci_dev->dev); | 340 | GFP_KERNEL); |
| 352 | if (IS_ERR(hwmon->device)) { | 341 | if (!hwmon->group.attrs) { |
| 353 | rc = PTR_ERR(hwmon->device); | 342 | rc = -ENOMEM; |
| 354 | goto fail; | 343 | goto fail; |
| 355 | } | 344 | } |
| 356 | 345 | ||
| 357 | rc = efx_mcdi_mon_add_attr(efx, "name", efx_mcdi_mon_show_name, 0, 0, 0); | ||
| 358 | if (rc) | ||
| 359 | goto fail; | ||
| 360 | |||
| 361 | for (i = 0, j = -1, type = -1; ; i++) { | 346 | for (i = 0, j = -1, type = -1; ; i++) { |
| 362 | enum efx_hwmon_type hwmon_type; | 347 | enum efx_hwmon_type hwmon_type; |
| 363 | const char *hwmon_prefix; | 348 | const char *hwmon_prefix; |
| @@ -372,7 +357,7 @@ int efx_mcdi_mon_probe(struct efx_nic *efx) | |||
| 372 | page = type / 32; | 357 | page = type / 32; |
| 373 | j = -1; | 358 | j = -1; |
| 374 | if (page == n_pages) | 359 | if (page == n_pages) |
| 375 | return 0; | 360 | goto hwmon_register; |
| 376 | 361 | ||
| 377 | MCDI_SET_DWORD(inbuf, SENSOR_INFO_EXT_IN_PAGE, | 362 | MCDI_SET_DWORD(inbuf, SENSOR_INFO_EXT_IN_PAGE, |
| 378 | page); | 363 | page); |
| @@ -453,28 +438,22 @@ int efx_mcdi_mon_probe(struct efx_nic *efx) | |||
| 453 | if (min1 != max1) { | 438 | if (min1 != max1) { |
| 454 | snprintf(name, sizeof(name), "%s%u_input", | 439 | snprintf(name, sizeof(name), "%s%u_input", |
| 455 | hwmon_prefix, hwmon_index); | 440 | hwmon_prefix, hwmon_index); |
| 456 | rc = efx_mcdi_mon_add_attr( | 441 | efx_mcdi_mon_add_attr( |
| 457 | efx, name, efx_mcdi_mon_show_value, i, type, 0); | 442 | efx, name, efx_mcdi_mon_show_value, i, type, 0); |
| 458 | if (rc) | ||
| 459 | goto fail; | ||
| 460 | 443 | ||
| 461 | if (hwmon_type != EFX_HWMON_POWER) { | 444 | if (hwmon_type != EFX_HWMON_POWER) { |
| 462 | snprintf(name, sizeof(name), "%s%u_min", | 445 | snprintf(name, sizeof(name), "%s%u_min", |
| 463 | hwmon_prefix, hwmon_index); | 446 | hwmon_prefix, hwmon_index); |
| 464 | rc = efx_mcdi_mon_add_attr( | 447 | efx_mcdi_mon_add_attr( |
| 465 | efx, name, efx_mcdi_mon_show_limit, | 448 | efx, name, efx_mcdi_mon_show_limit, |
| 466 | i, type, min1); | 449 | i, type, min1); |
| 467 | if (rc) | ||
| 468 | goto fail; | ||
| 469 | } | 450 | } |
| 470 | 451 | ||
| 471 | snprintf(name, sizeof(name), "%s%u_max", | 452 | snprintf(name, sizeof(name), "%s%u_max", |
| 472 | hwmon_prefix, hwmon_index); | 453 | hwmon_prefix, hwmon_index); |
| 473 | rc = efx_mcdi_mon_add_attr( | 454 | efx_mcdi_mon_add_attr( |
| 474 | efx, name, efx_mcdi_mon_show_limit, | 455 | efx, name, efx_mcdi_mon_show_limit, |
| 475 | i, type, max1); | 456 | i, type, max1); |
| 476 | if (rc) | ||
| 477 | goto fail; | ||
| 478 | 457 | ||
| 479 | if (min2 != max2) { | 458 | if (min2 != max2) { |
| 480 | /* Assume max2 is critical value. | 459 | /* Assume max2 is critical value. |
| @@ -482,32 +461,38 @@ int efx_mcdi_mon_probe(struct efx_nic *efx) | |||
| 482 | */ | 461 | */ |
| 483 | snprintf(name, sizeof(name), "%s%u_crit", | 462 | snprintf(name, sizeof(name), "%s%u_crit", |
| 484 | hwmon_prefix, hwmon_index); | 463 | hwmon_prefix, hwmon_index); |
| 485 | rc = efx_mcdi_mon_add_attr( | 464 | efx_mcdi_mon_add_attr( |
| 486 | efx, name, efx_mcdi_mon_show_limit, | 465 | efx, name, efx_mcdi_mon_show_limit, |
| 487 | i, type, max2); | 466 | i, type, max2); |
| 488 | if (rc) | ||
| 489 | goto fail; | ||
| 490 | } | 467 | } |
| 491 | } | 468 | } |
| 492 | 469 | ||
| 493 | snprintf(name, sizeof(name), "%s%u_alarm", | 470 | snprintf(name, sizeof(name), "%s%u_alarm", |
| 494 | hwmon_prefix, hwmon_index); | 471 | hwmon_prefix, hwmon_index); |
| 495 | rc = efx_mcdi_mon_add_attr( | 472 | efx_mcdi_mon_add_attr( |
| 496 | efx, name, efx_mcdi_mon_show_alarm, i, type, 0); | 473 | efx, name, efx_mcdi_mon_show_alarm, i, type, 0); |
| 497 | if (rc) | ||
| 498 | goto fail; | ||
| 499 | 474 | ||
| 500 | if (type < ARRAY_SIZE(efx_mcdi_sensor_type) && | 475 | if (type < ARRAY_SIZE(efx_mcdi_sensor_type) && |
| 501 | efx_mcdi_sensor_type[type].label) { | 476 | efx_mcdi_sensor_type[type].label) { |
| 502 | snprintf(name, sizeof(name), "%s%u_label", | 477 | snprintf(name, sizeof(name), "%s%u_label", |
| 503 | hwmon_prefix, hwmon_index); | 478 | hwmon_prefix, hwmon_index); |
| 504 | rc = efx_mcdi_mon_add_attr( | 479 | efx_mcdi_mon_add_attr( |
| 505 | efx, name, efx_mcdi_mon_show_label, i, type, 0); | 480 | efx, name, efx_mcdi_mon_show_label, i, type, 0); |
| 506 | if (rc) | ||
| 507 | goto fail; | ||
| 508 | } | 481 | } |
| 509 | } | 482 | } |
| 510 | 483 | ||
| 484 | hwmon_register: | ||
| 485 | hwmon->groups[0] = &hwmon->group; | ||
| 486 | hwmon->device = hwmon_device_register_with_groups(&efx->pci_dev->dev, | ||
| 487 | KBUILD_MODNAME, NULL, | ||
| 488 | hwmon->groups); | ||
| 489 | if (IS_ERR(hwmon->device)) { | ||
| 490 | rc = PTR_ERR(hwmon->device); | ||
| 491 | goto fail; | ||
| 492 | } | ||
| 493 | |||
| 494 | return 0; | ||
| 495 | |||
| 511 | fail: | 496 | fail: |
| 512 | efx_mcdi_mon_remove(efx); | 497 | efx_mcdi_mon_remove(efx); |
| 513 | return rc; | 498 | return rc; |
| @@ -516,14 +501,11 @@ fail: | |||
| 516 | void efx_mcdi_mon_remove(struct efx_nic *efx) | 501 | void efx_mcdi_mon_remove(struct efx_nic *efx) |
| 517 | { | 502 | { |
| 518 | struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); | 503 | struct efx_mcdi_mon *hwmon = efx_mcdi_mon(efx); |
| 519 | unsigned int i; | ||
| 520 | 504 | ||
| 521 | for (i = 0; i < hwmon->n_attrs; i++) | ||
| 522 | device_remove_file(&efx->pci_dev->dev, | ||
| 523 | &hwmon->attrs[i].dev_attr); | ||
| 524 | kfree(hwmon->attrs); | ||
| 525 | if (hwmon->device) | 505 | if (hwmon->device) |
| 526 | hwmon_device_unregister(hwmon->device); | 506 | hwmon_device_unregister(hwmon->device); |
| 507 | kfree(hwmon->attrs); | ||
| 508 | kfree(hwmon->group.attrs); | ||
| 527 | efx_nic_free_buffer(efx, &hwmon->dma_buf); | 509 | efx_nic_free_buffer(efx, &hwmon->dma_buf); |
| 528 | } | 510 | } |
| 529 | 511 | ||
diff --git a/drivers/net/ethernet/sfc/net_driver.h b/drivers/net/ethernet/sfc/net_driver.h index b14a717ac3e8..542a0d252ae0 100644 --- a/drivers/net/ethernet/sfc/net_driver.h +++ b/drivers/net/ethernet/sfc/net_driver.h | |||
| @@ -683,6 +683,8 @@ struct vfdi_status; | |||
| 683 | * @n_channels: Number of channels in use | 683 | * @n_channels: Number of channels in use |
| 684 | * @n_rx_channels: Number of channels used for RX (= number of RX queues) | 684 | * @n_rx_channels: Number of channels used for RX (= number of RX queues) |
| 685 | * @n_tx_channels: Number of channels used for TX | 685 | * @n_tx_channels: Number of channels used for TX |
| 686 | * @rx_ip_align: RX DMA address offset to have IP header aligned in | ||
| 687 | * in accordance with NET_IP_ALIGN | ||
| 686 | * @rx_dma_len: Current maximum RX DMA length | 688 | * @rx_dma_len: Current maximum RX DMA length |
| 687 | * @rx_buffer_order: Order (log2) of number of pages for each RX buffer | 689 | * @rx_buffer_order: Order (log2) of number of pages for each RX buffer |
| 688 | * @rx_buffer_truesize: Amortised allocation size of an RX buffer, | 690 | * @rx_buffer_truesize: Amortised allocation size of an RX buffer, |
| @@ -816,6 +818,7 @@ struct efx_nic { | |||
| 816 | unsigned rss_spread; | 818 | unsigned rss_spread; |
| 817 | unsigned tx_channel_offset; | 819 | unsigned tx_channel_offset; |
| 818 | unsigned n_tx_channels; | 820 | unsigned n_tx_channels; |
| 821 | unsigned int rx_ip_align; | ||
| 819 | unsigned int rx_dma_len; | 822 | unsigned int rx_dma_len; |
| 820 | unsigned int rx_buffer_order; | 823 | unsigned int rx_buffer_order; |
| 821 | unsigned int rx_buffer_truesize; | 824 | unsigned int rx_buffer_truesize; |
diff --git a/drivers/net/ethernet/sfc/nic.h b/drivers/net/ethernet/sfc/nic.h index 11b6112d9249..91c63ec79c5f 100644 --- a/drivers/net/ethernet/sfc/nic.h +++ b/drivers/net/ethernet/sfc/nic.h | |||
| @@ -560,6 +560,8 @@ void efx_ptp_get_ts_info(struct efx_nic *efx, struct ethtool_ts_info *ts_info); | |||
| 560 | bool efx_ptp_is_ptp_tx(struct efx_nic *efx, struct sk_buff *skb); | 560 | bool efx_ptp_is_ptp_tx(struct efx_nic *efx, struct sk_buff *skb); |
| 561 | int efx_ptp_tx(struct efx_nic *efx, struct sk_buff *skb); | 561 | int efx_ptp_tx(struct efx_nic *efx, struct sk_buff *skb); |
| 562 | void efx_ptp_event(struct efx_nic *efx, efx_qword_t *ev); | 562 | void efx_ptp_event(struct efx_nic *efx, efx_qword_t *ev); |
| 563 | void efx_ptp_start_datapath(struct efx_nic *efx); | ||
| 564 | void efx_ptp_stop_datapath(struct efx_nic *efx); | ||
| 563 | 565 | ||
| 564 | extern const struct efx_nic_type falcon_a1_nic_type; | 566 | extern const struct efx_nic_type falcon_a1_nic_type; |
| 565 | extern const struct efx_nic_type falcon_b0_nic_type; | 567 | extern const struct efx_nic_type falcon_b0_nic_type; |
diff --git a/drivers/net/ethernet/sfc/ptp.c b/drivers/net/ethernet/sfc/ptp.c index 03acf57df045..3dd39dcfe36b 100644 --- a/drivers/net/ethernet/sfc/ptp.c +++ b/drivers/net/ethernet/sfc/ptp.c | |||
| @@ -220,6 +220,7 @@ struct efx_ptp_timeset { | |||
| 220 | * @evt_list: List of MC receive events awaiting packets | 220 | * @evt_list: List of MC receive events awaiting packets |
| 221 | * @evt_free_list: List of free events | 221 | * @evt_free_list: List of free events |
| 222 | * @evt_lock: Lock for manipulating evt_list and evt_free_list | 222 | * @evt_lock: Lock for manipulating evt_list and evt_free_list |
| 223 | * @evt_overflow: Boolean indicating that event list has overflowed | ||
| 223 | * @rx_evts: Instantiated events (on evt_list and evt_free_list) | 224 | * @rx_evts: Instantiated events (on evt_list and evt_free_list) |
| 224 | * @workwq: Work queue for processing pending PTP operations | 225 | * @workwq: Work queue for processing pending PTP operations |
| 225 | * @work: Work task | 226 | * @work: Work task |
| @@ -270,6 +271,7 @@ struct efx_ptp_data { | |||
| 270 | struct list_head evt_list; | 271 | struct list_head evt_list; |
| 271 | struct list_head evt_free_list; | 272 | struct list_head evt_free_list; |
| 272 | spinlock_t evt_lock; | 273 | spinlock_t evt_lock; |
| 274 | bool evt_overflow; | ||
| 273 | struct efx_ptp_event_rx rx_evts[MAX_RECEIVE_EVENTS]; | 275 | struct efx_ptp_event_rx rx_evts[MAX_RECEIVE_EVENTS]; |
| 274 | struct workqueue_struct *workwq; | 276 | struct workqueue_struct *workwq; |
| 275 | struct work_struct work; | 277 | struct work_struct work; |
| @@ -635,6 +637,11 @@ static void efx_ptp_drop_time_expired_events(struct efx_nic *efx) | |||
| 635 | } | 637 | } |
| 636 | } | 638 | } |
| 637 | } | 639 | } |
| 640 | /* If the event overflow flag is set and the event list is now empty | ||
| 641 | * clear the flag to re-enable the overflow warning message. | ||
| 642 | */ | ||
| 643 | if (ptp->evt_overflow && list_empty(&ptp->evt_list)) | ||
| 644 | ptp->evt_overflow = false; | ||
| 638 | spin_unlock_bh(&ptp->evt_lock); | 645 | spin_unlock_bh(&ptp->evt_lock); |
| 639 | } | 646 | } |
| 640 | 647 | ||
| @@ -676,6 +683,11 @@ static enum ptp_packet_state efx_ptp_match_rx(struct efx_nic *efx, | |||
| 676 | break; | 683 | break; |
| 677 | } | 684 | } |
| 678 | } | 685 | } |
| 686 | /* If the event overflow flag is set and the event list is now empty | ||
| 687 | * clear the flag to re-enable the overflow warning message. | ||
| 688 | */ | ||
| 689 | if (ptp->evt_overflow && list_empty(&ptp->evt_list)) | ||
| 690 | ptp->evt_overflow = false; | ||
| 679 | spin_unlock_bh(&ptp->evt_lock); | 691 | spin_unlock_bh(&ptp->evt_lock); |
| 680 | 692 | ||
| 681 | return rc; | 693 | return rc; |
| @@ -705,8 +717,9 @@ static bool efx_ptp_process_events(struct efx_nic *efx, struct sk_buff_head *q) | |||
| 705 | __skb_queue_tail(q, skb); | 717 | __skb_queue_tail(q, skb); |
| 706 | } else if (time_after(jiffies, match->expiry)) { | 718 | } else if (time_after(jiffies, match->expiry)) { |
| 707 | match->state = PTP_PACKET_STATE_TIMED_OUT; | 719 | match->state = PTP_PACKET_STATE_TIMED_OUT; |
| 708 | netif_warn(efx, rx_err, efx->net_dev, | 720 | if (net_ratelimit()) |
| 709 | "PTP packet - no timestamp seen\n"); | 721 | netif_warn(efx, rx_err, efx->net_dev, |
| 722 | "PTP packet - no timestamp seen\n"); | ||
| 710 | __skb_queue_tail(q, skb); | 723 | __skb_queue_tail(q, skb); |
| 711 | } else { | 724 | } else { |
| 712 | /* Replace unprocessed entry and stop */ | 725 | /* Replace unprocessed entry and stop */ |
| @@ -788,9 +801,14 @@ fail: | |||
| 788 | static int efx_ptp_stop(struct efx_nic *efx) | 801 | static int efx_ptp_stop(struct efx_nic *efx) |
| 789 | { | 802 | { |
| 790 | struct efx_ptp_data *ptp = efx->ptp_data; | 803 | struct efx_ptp_data *ptp = efx->ptp_data; |
| 791 | int rc = efx_ptp_disable(efx); | ||
| 792 | struct list_head *cursor; | 804 | struct list_head *cursor; |
| 793 | struct list_head *next; | 805 | struct list_head *next; |
| 806 | int rc; | ||
| 807 | |||
| 808 | if (ptp == NULL) | ||
| 809 | return 0; | ||
| 810 | |||
| 811 | rc = efx_ptp_disable(efx); | ||
| 794 | 812 | ||
| 795 | if (ptp->rxfilter_installed) { | 813 | if (ptp->rxfilter_installed) { |
| 796 | efx_filter_remove_id_safe(efx, EFX_FILTER_PRI_REQUIRED, | 814 | efx_filter_remove_id_safe(efx, EFX_FILTER_PRI_REQUIRED, |
| @@ -809,11 +827,19 @@ static int efx_ptp_stop(struct efx_nic *efx) | |||
| 809 | list_for_each_safe(cursor, next, &efx->ptp_data->evt_list) { | 827 | list_for_each_safe(cursor, next, &efx->ptp_data->evt_list) { |
| 810 | list_move(cursor, &efx->ptp_data->evt_free_list); | 828 | list_move(cursor, &efx->ptp_data->evt_free_list); |
| 811 | } | 829 | } |
| 830 | ptp->evt_overflow = false; | ||
| 812 | spin_unlock_bh(&efx->ptp_data->evt_lock); | 831 | spin_unlock_bh(&efx->ptp_data->evt_lock); |
| 813 | 832 | ||
| 814 | return rc; | 833 | return rc; |
| 815 | } | 834 | } |
| 816 | 835 | ||
| 836 | static int efx_ptp_restart(struct efx_nic *efx) | ||
| 837 | { | ||
| 838 | if (efx->ptp_data && efx->ptp_data->enabled) | ||
| 839 | return efx_ptp_start(efx); | ||
| 840 | return 0; | ||
| 841 | } | ||
| 842 | |||
| 817 | static void efx_ptp_pps_worker(struct work_struct *work) | 843 | static void efx_ptp_pps_worker(struct work_struct *work) |
| 818 | { | 844 | { |
| 819 | struct efx_ptp_data *ptp = | 845 | struct efx_ptp_data *ptp = |
| @@ -901,6 +927,7 @@ static int efx_ptp_probe_channel(struct efx_channel *channel) | |||
| 901 | spin_lock_init(&ptp->evt_lock); | 927 | spin_lock_init(&ptp->evt_lock); |
| 902 | for (pos = 0; pos < MAX_RECEIVE_EVENTS; pos++) | 928 | for (pos = 0; pos < MAX_RECEIVE_EVENTS; pos++) |
| 903 | list_add(&ptp->rx_evts[pos].link, &ptp->evt_free_list); | 929 | list_add(&ptp->rx_evts[pos].link, &ptp->evt_free_list); |
| 930 | ptp->evt_overflow = false; | ||
| 904 | 931 | ||
| 905 | ptp->phc_clock_info.owner = THIS_MODULE; | 932 | ptp->phc_clock_info.owner = THIS_MODULE; |
| 906 | snprintf(ptp->phc_clock_info.name, | 933 | snprintf(ptp->phc_clock_info.name, |
| @@ -989,7 +1016,11 @@ bool efx_ptp_is_ptp_tx(struct efx_nic *efx, struct sk_buff *skb) | |||
| 989 | skb->len >= PTP_MIN_LENGTH && | 1016 | skb->len >= PTP_MIN_LENGTH && |
| 990 | skb->len <= MC_CMD_PTP_IN_TRANSMIT_PACKET_MAXNUM && | 1017 | skb->len <= MC_CMD_PTP_IN_TRANSMIT_PACKET_MAXNUM && |
| 991 | likely(skb->protocol == htons(ETH_P_IP)) && | 1018 | likely(skb->protocol == htons(ETH_P_IP)) && |
| 1019 | skb_transport_header_was_set(skb) && | ||
| 1020 | skb_network_header_len(skb) >= sizeof(struct iphdr) && | ||
| 992 | ip_hdr(skb)->protocol == IPPROTO_UDP && | 1021 | ip_hdr(skb)->protocol == IPPROTO_UDP && |
| 1022 | skb_headlen(skb) >= | ||
| 1023 | skb_transport_offset(skb) + sizeof(struct udphdr) && | ||
| 993 | udp_hdr(skb)->dest == htons(PTP_EVENT_PORT); | 1024 | udp_hdr(skb)->dest == htons(PTP_EVENT_PORT); |
| 994 | } | 1025 | } |
| 995 | 1026 | ||
| @@ -1106,7 +1137,7 @@ static int efx_ptp_change_mode(struct efx_nic *efx, bool enable_wanted, | |||
| 1106 | { | 1137 | { |
| 1107 | if ((enable_wanted != efx->ptp_data->enabled) || | 1138 | if ((enable_wanted != efx->ptp_data->enabled) || |
| 1108 | (enable_wanted && (efx->ptp_data->mode != new_mode))) { | 1139 | (enable_wanted && (efx->ptp_data->mode != new_mode))) { |
| 1109 | int rc; | 1140 | int rc = 0; |
| 1110 | 1141 | ||
| 1111 | if (enable_wanted) { | 1142 | if (enable_wanted) { |
| 1112 | /* Change of mode requires disable */ | 1143 | /* Change of mode requires disable */ |
| @@ -1123,7 +1154,8 @@ static int efx_ptp_change_mode(struct efx_nic *efx, bool enable_wanted, | |||
| 1123 | * succeed. | 1154 | * succeed. |
| 1124 | */ | 1155 | */ |
| 1125 | efx->ptp_data->mode = new_mode; | 1156 | efx->ptp_data->mode = new_mode; |
| 1126 | rc = efx_ptp_start(efx); | 1157 | if (netif_running(efx->net_dev)) |
| 1158 | rc = efx_ptp_start(efx); | ||
| 1127 | if (rc == 0) { | 1159 | if (rc == 0) { |
| 1128 | rc = efx_ptp_synchronize(efx, | 1160 | rc = efx_ptp_synchronize(efx, |
| 1129 | PTP_SYNC_ATTEMPTS * 2); | 1161 | PTP_SYNC_ATTEMPTS * 2); |
| @@ -1295,8 +1327,13 @@ static void ptp_event_rx(struct efx_nic *efx, struct efx_ptp_data *ptp) | |||
| 1295 | list_add_tail(&evt->link, &ptp->evt_list); | 1327 | list_add_tail(&evt->link, &ptp->evt_list); |
| 1296 | 1328 | ||
| 1297 | queue_work(ptp->workwq, &ptp->work); | 1329 | queue_work(ptp->workwq, &ptp->work); |
| 1298 | } else { | 1330 | } else if (!ptp->evt_overflow) { |
| 1299 | netif_err(efx, rx_err, efx->net_dev, "No free PTP event"); | 1331 | /* Log a warning message and set the event overflow flag. |
| 1332 | * The message won't be logged again until the event queue | ||
| 1333 | * becomes empty. | ||
| 1334 | */ | ||
| 1335 | netif_err(efx, rx_err, efx->net_dev, "PTP event queue overflow\n"); | ||
| 1336 | ptp->evt_overflow = true; | ||
| 1300 | } | 1337 | } |
| 1301 | spin_unlock_bh(&ptp->evt_lock); | 1338 | spin_unlock_bh(&ptp->evt_lock); |
| 1302 | } | 1339 | } |
| @@ -1389,7 +1426,7 @@ static int efx_phc_adjfreq(struct ptp_clock_info *ptp, s32 delta) | |||
| 1389 | if (rc != 0) | 1426 | if (rc != 0) |
| 1390 | return rc; | 1427 | return rc; |
| 1391 | 1428 | ||
| 1392 | ptp_data->current_adjfreq = delta; | 1429 | ptp_data->current_adjfreq = adjustment_ns; |
| 1393 | return 0; | 1430 | return 0; |
| 1394 | } | 1431 | } |
| 1395 | 1432 | ||
| @@ -1404,7 +1441,7 @@ static int efx_phc_adjtime(struct ptp_clock_info *ptp, s64 delta) | |||
| 1404 | 1441 | ||
| 1405 | MCDI_SET_DWORD(inbuf, PTP_IN_OP, MC_CMD_PTP_OP_ADJUST); | 1442 | MCDI_SET_DWORD(inbuf, PTP_IN_OP, MC_CMD_PTP_OP_ADJUST); |
| 1406 | MCDI_SET_DWORD(inbuf, PTP_IN_PERIPH_ID, 0); | 1443 | MCDI_SET_DWORD(inbuf, PTP_IN_PERIPH_ID, 0); |
| 1407 | MCDI_SET_QWORD(inbuf, PTP_IN_ADJUST_FREQ, 0); | 1444 | MCDI_SET_QWORD(inbuf, PTP_IN_ADJUST_FREQ, ptp_data->current_adjfreq); |
| 1408 | MCDI_SET_DWORD(inbuf, PTP_IN_ADJUST_SECONDS, (u32)delta_ts.tv_sec); | 1445 | MCDI_SET_DWORD(inbuf, PTP_IN_ADJUST_SECONDS, (u32)delta_ts.tv_sec); |
| 1409 | MCDI_SET_DWORD(inbuf, PTP_IN_ADJUST_NANOSECONDS, (u32)delta_ts.tv_nsec); | 1446 | MCDI_SET_DWORD(inbuf, PTP_IN_ADJUST_NANOSECONDS, (u32)delta_ts.tv_nsec); |
| 1410 | return efx_mcdi_rpc(efx, MC_CMD_PTP, inbuf, sizeof(inbuf), | 1447 | return efx_mcdi_rpc(efx, MC_CMD_PTP, inbuf, sizeof(inbuf), |
| @@ -1491,3 +1528,14 @@ void efx_ptp_probe(struct efx_nic *efx) | |||
| 1491 | efx->extra_channel_type[EFX_EXTRA_CHANNEL_PTP] = | 1528 | efx->extra_channel_type[EFX_EXTRA_CHANNEL_PTP] = |
| 1492 | &efx_ptp_channel_type; | 1529 | &efx_ptp_channel_type; |
| 1493 | } | 1530 | } |
| 1531 | |||
| 1532 | void efx_ptp_start_datapath(struct efx_nic *efx) | ||
| 1533 | { | ||
| 1534 | if (efx_ptp_restart(efx)) | ||
| 1535 | netif_err(efx, drv, efx->net_dev, "Failed to restart PTP.\n"); | ||
| 1536 | } | ||
| 1537 | |||
| 1538 | void efx_ptp_stop_datapath(struct efx_nic *efx) | ||
| 1539 | { | ||
| 1540 | efx_ptp_stop(efx); | ||
| 1541 | } | ||
diff --git a/drivers/net/ethernet/sfc/rx.c b/drivers/net/ethernet/sfc/rx.c index 8f09e686fc23..42488df1f4ec 100644 --- a/drivers/net/ethernet/sfc/rx.c +++ b/drivers/net/ethernet/sfc/rx.c | |||
| @@ -94,7 +94,7 @@ static inline void efx_sync_rx_buffer(struct efx_nic *efx, | |||
| 94 | 94 | ||
| 95 | void efx_rx_config_page_split(struct efx_nic *efx) | 95 | void efx_rx_config_page_split(struct efx_nic *efx) |
| 96 | { | 96 | { |
| 97 | efx->rx_page_buf_step = ALIGN(efx->rx_dma_len + NET_IP_ALIGN, | 97 | efx->rx_page_buf_step = ALIGN(efx->rx_dma_len + efx->rx_ip_align, |
| 98 | EFX_RX_BUF_ALIGNMENT); | 98 | EFX_RX_BUF_ALIGNMENT); |
| 99 | efx->rx_bufs_per_page = efx->rx_buffer_order ? 1 : | 99 | efx->rx_bufs_per_page = efx->rx_buffer_order ? 1 : |
| 100 | ((PAGE_SIZE - sizeof(struct efx_rx_page_state)) / | 100 | ((PAGE_SIZE - sizeof(struct efx_rx_page_state)) / |
| @@ -189,9 +189,9 @@ static int efx_init_rx_buffers(struct efx_rx_queue *rx_queue) | |||
| 189 | do { | 189 | do { |
| 190 | index = rx_queue->added_count & rx_queue->ptr_mask; | 190 | index = rx_queue->added_count & rx_queue->ptr_mask; |
| 191 | rx_buf = efx_rx_buffer(rx_queue, index); | 191 | rx_buf = efx_rx_buffer(rx_queue, index); |
| 192 | rx_buf->dma_addr = dma_addr + NET_IP_ALIGN; | 192 | rx_buf->dma_addr = dma_addr + efx->rx_ip_align; |
| 193 | rx_buf->page = page; | 193 | rx_buf->page = page; |
| 194 | rx_buf->page_offset = page_offset + NET_IP_ALIGN; | 194 | rx_buf->page_offset = page_offset + efx->rx_ip_align; |
| 195 | rx_buf->len = efx->rx_dma_len; | 195 | rx_buf->len = efx->rx_dma_len; |
| 196 | rx_buf->flags = 0; | 196 | rx_buf->flags = 0; |
| 197 | ++rx_queue->added_count; | 197 | ++rx_queue->added_count; |
diff --git a/drivers/net/ethernet/smsc/smc91x.c b/drivers/net/ethernet/smsc/smc91x.c index 0c9b5d94154f..8bf29eb4a5a0 100644 --- a/drivers/net/ethernet/smsc/smc91x.c +++ b/drivers/net/ethernet/smsc/smc91x.c | |||
| @@ -82,6 +82,7 @@ static const char version[] = | |||
| 82 | #include <linux/mii.h> | 82 | #include <linux/mii.h> |
| 83 | #include <linux/workqueue.h> | 83 | #include <linux/workqueue.h> |
| 84 | #include <linux/of.h> | 84 | #include <linux/of.h> |
| 85 | #include <linux/of_device.h> | ||
| 85 | 86 | ||
| 86 | #include <linux/netdevice.h> | 87 | #include <linux/netdevice.h> |
| 87 | #include <linux/etherdevice.h> | 88 | #include <linux/etherdevice.h> |
| @@ -2184,6 +2185,15 @@ static void smc_release_datacs(struct platform_device *pdev, struct net_device * | |||
| 2184 | } | 2185 | } |
| 2185 | } | 2186 | } |
| 2186 | 2187 | ||
| 2188 | #if IS_BUILTIN(CONFIG_OF) | ||
| 2189 | static const struct of_device_id smc91x_match[] = { | ||
| 2190 | { .compatible = "smsc,lan91c94", }, | ||
| 2191 | { .compatible = "smsc,lan91c111", }, | ||
| 2192 | {}, | ||
| 2193 | }; | ||
| 2194 | MODULE_DEVICE_TABLE(of, smc91x_match); | ||
| 2195 | #endif | ||
| 2196 | |||
| 2187 | /* | 2197 | /* |
| 2188 | * smc_init(void) | 2198 | * smc_init(void) |
| 2189 | * Input parameters: | 2199 | * Input parameters: |
| @@ -2198,6 +2208,7 @@ static void smc_release_datacs(struct platform_device *pdev, struct net_device * | |||
| 2198 | static int smc_drv_probe(struct platform_device *pdev) | 2208 | static int smc_drv_probe(struct platform_device *pdev) |
| 2199 | { | 2209 | { |
| 2200 | struct smc91x_platdata *pd = dev_get_platdata(&pdev->dev); | 2210 | struct smc91x_platdata *pd = dev_get_platdata(&pdev->dev); |
| 2211 | const struct of_device_id *match = NULL; | ||
| 2201 | struct smc_local *lp; | 2212 | struct smc_local *lp; |
| 2202 | struct net_device *ndev; | 2213 | struct net_device *ndev; |
| 2203 | struct resource *res, *ires; | 2214 | struct resource *res, *ires; |
| @@ -2217,11 +2228,34 @@ static int smc_drv_probe(struct platform_device *pdev) | |||
| 2217 | */ | 2228 | */ |
| 2218 | 2229 | ||
| 2219 | lp = netdev_priv(ndev); | 2230 | lp = netdev_priv(ndev); |
| 2231 | lp->cfg.flags = 0; | ||
| 2220 | 2232 | ||
| 2221 | if (pd) { | 2233 | if (pd) { |
| 2222 | memcpy(&lp->cfg, pd, sizeof(lp->cfg)); | 2234 | memcpy(&lp->cfg, pd, sizeof(lp->cfg)); |
| 2223 | lp->io_shift = SMC91X_IO_SHIFT(lp->cfg.flags); | 2235 | lp->io_shift = SMC91X_IO_SHIFT(lp->cfg.flags); |
| 2224 | } else { | 2236 | } |
| 2237 | |||
| 2238 | #if IS_BUILTIN(CONFIG_OF) | ||
| 2239 | match = of_match_device(of_match_ptr(smc91x_match), &pdev->dev); | ||
| 2240 | if (match) { | ||
| 2241 | struct device_node *np = pdev->dev.of_node; | ||
| 2242 | u32 val; | ||
| 2243 | |||
| 2244 | /* Combination of IO widths supported, default to 16-bit */ | ||
| 2245 | if (!of_property_read_u32(np, "reg-io-width", &val)) { | ||
| 2246 | if (val & 1) | ||
| 2247 | lp->cfg.flags |= SMC91X_USE_8BIT; | ||
| 2248 | if ((val == 0) || (val & 2)) | ||
| 2249 | lp->cfg.flags |= SMC91X_USE_16BIT; | ||
| 2250 | if (val & 4) | ||
| 2251 | lp->cfg.flags |= SMC91X_USE_32BIT; | ||
| 2252 | } else { | ||
| 2253 | lp->cfg.flags |= SMC91X_USE_16BIT; | ||
| 2254 | } | ||
| 2255 | } | ||
| 2256 | #endif | ||
| 2257 | |||
| 2258 | if (!pd && !match) { | ||
| 2225 | lp->cfg.flags |= (SMC_CAN_USE_8BIT) ? SMC91X_USE_8BIT : 0; | 2259 | lp->cfg.flags |= (SMC_CAN_USE_8BIT) ? SMC91X_USE_8BIT : 0; |
| 2226 | lp->cfg.flags |= (SMC_CAN_USE_16BIT) ? SMC91X_USE_16BIT : 0; | 2260 | lp->cfg.flags |= (SMC_CAN_USE_16BIT) ? SMC91X_USE_16BIT : 0; |
| 2227 | lp->cfg.flags |= (SMC_CAN_USE_32BIT) ? SMC91X_USE_32BIT : 0; | 2261 | lp->cfg.flags |= (SMC_CAN_USE_32BIT) ? SMC91X_USE_32BIT : 0; |
| @@ -2370,15 +2404,6 @@ static int smc_drv_resume(struct device *dev) | |||
| 2370 | return 0; | 2404 | return 0; |
| 2371 | } | 2405 | } |
| 2372 | 2406 | ||
| 2373 | #ifdef CONFIG_OF | ||
| 2374 | static const struct of_device_id smc91x_match[] = { | ||
| 2375 | { .compatible = "smsc,lan91c94", }, | ||
| 2376 | { .compatible = "smsc,lan91c111", }, | ||
| 2377 | {}, | ||
| 2378 | }; | ||
| 2379 | MODULE_DEVICE_TABLE(of, smc91x_match); | ||
| 2380 | #endif | ||
| 2381 | |||
| 2382 | static struct dev_pm_ops smc_drv_pm_ops = { | 2407 | static struct dev_pm_ops smc_drv_pm_ops = { |
| 2383 | .suspend = smc_drv_suspend, | 2408 | .suspend = smc_drv_suspend, |
| 2384 | .resume = smc_drv_resume, | 2409 | .resume = smc_drv_resume, |
diff --git a/drivers/net/ethernet/smsc/smc91x.h b/drivers/net/ethernet/smsc/smc91x.h index c9d4c872e81d..749654b976bc 100644 --- a/drivers/net/ethernet/smsc/smc91x.h +++ b/drivers/net/ethernet/smsc/smc91x.h | |||
| @@ -46,7 +46,8 @@ | |||
| 46 | defined(CONFIG_MACH_LITTLETON) ||\ | 46 | defined(CONFIG_MACH_LITTLETON) ||\ |
| 47 | defined(CONFIG_MACH_ZYLONITE2) ||\ | 47 | defined(CONFIG_MACH_ZYLONITE2) ||\ |
| 48 | defined(CONFIG_ARCH_VIPER) ||\ | 48 | defined(CONFIG_ARCH_VIPER) ||\ |
| 49 | defined(CONFIG_MACH_STARGATE2) | 49 | defined(CONFIG_MACH_STARGATE2) ||\ |
| 50 | defined(CONFIG_ARCH_VERSATILE) | ||
| 50 | 51 | ||
| 51 | #include <asm/mach-types.h> | 52 | #include <asm/mach-types.h> |
| 52 | 53 | ||
| @@ -154,6 +155,8 @@ static inline void SMC_outw(u16 val, void __iomem *ioaddr, int reg) | |||
| 154 | #define SMC_outl(v, a, r) writel(v, (a) + (r)) | 155 | #define SMC_outl(v, a, r) writel(v, (a) + (r)) |
| 155 | #define SMC_insl(a, r, p, l) readsl((a) + (r), p, l) | 156 | #define SMC_insl(a, r, p, l) readsl((a) + (r), p, l) |
| 156 | #define SMC_outsl(a, r, p, l) writesl((a) + (r), p, l) | 157 | #define SMC_outsl(a, r, p, l) writesl((a) + (r), p, l) |
| 158 | #define SMC_insw(a, r, p, l) readsw((a) + (r), p, l) | ||
| 159 | #define SMC_outsw(a, r, p, l) writesw((a) + (r), p, l) | ||
| 157 | #define SMC_IRQ_FLAGS (-1) /* from resource */ | 160 | #define SMC_IRQ_FLAGS (-1) /* from resource */ |
| 158 | 161 | ||
| 159 | /* We actually can't write halfwords properly if not word aligned */ | 162 | /* We actually can't write halfwords properly if not word aligned */ |
| @@ -206,23 +209,6 @@ SMC_outw(u16 val, void __iomem *ioaddr, int reg) | |||
| 206 | #define RPC_LSA_DEFAULT RPC_LED_TX_RX | 209 | #define RPC_LSA_DEFAULT RPC_LED_TX_RX |
| 207 | #define RPC_LSB_DEFAULT RPC_LED_100_10 | 210 | #define RPC_LSB_DEFAULT RPC_LED_100_10 |
| 208 | 211 | ||
| 209 | #elif defined(CONFIG_ARCH_VERSATILE) | ||
| 210 | |||
| 211 | #define SMC_CAN_USE_8BIT 1 | ||
| 212 | #define SMC_CAN_USE_16BIT 1 | ||
| 213 | #define SMC_CAN_USE_32BIT 1 | ||
| 214 | #define SMC_NOWAIT 1 | ||
| 215 | |||
| 216 | #define SMC_inb(a, r) readb((a) + (r)) | ||
| 217 | #define SMC_inw(a, r) readw((a) + (r)) | ||
| 218 | #define SMC_inl(a, r) readl((a) + (r)) | ||
| 219 | #define SMC_outb(v, a, r) writeb(v, (a) + (r)) | ||
| 220 | #define SMC_outw(v, a, r) writew(v, (a) + (r)) | ||
| 221 | #define SMC_outl(v, a, r) writel(v, (a) + (r)) | ||
| 222 | #define SMC_insl(a, r, p, l) readsl((a) + (r), p, l) | ||
| 223 | #define SMC_outsl(a, r, p, l) writesl((a) + (r), p, l) | ||
| 224 | #define SMC_IRQ_FLAGS (-1) /* from resource */ | ||
| 225 | |||
| 226 | #elif defined(CONFIG_MN10300) | 212 | #elif defined(CONFIG_MN10300) |
| 227 | 213 | ||
| 228 | /* | 214 | /* |
diff --git a/drivers/net/ethernet/tehuti/tehuti.c b/drivers/net/ethernet/tehuti/tehuti.c index dd0dd6279b4e..4f1d2549130e 100644 --- a/drivers/net/ethernet/tehuti/tehuti.c +++ b/drivers/net/ethernet/tehuti/tehuti.c | |||
| @@ -2019,7 +2019,6 @@ bdx_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | |||
| 2019 | ndev->features = NETIF_F_IP_CSUM | NETIF_F_SG | NETIF_F_TSO | 2019 | ndev->features = NETIF_F_IP_CSUM | NETIF_F_SG | NETIF_F_TSO |
| 2020 | | NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX | | 2020 | | NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX | |
| 2021 | NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_RXCSUM | 2021 | NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_RXCSUM |
| 2022 | /*| NETIF_F_FRAGLIST */ | ||
| 2023 | ; | 2022 | ; |
| 2024 | ndev->hw_features = NETIF_F_IP_CSUM | NETIF_F_SG | | 2023 | ndev->hw_features = NETIF_F_IP_CSUM | NETIF_F_SG | |
| 2025 | NETIF_F_TSO | NETIF_F_HW_VLAN_CTAG_TX; | 2024 | NETIF_F_TSO | NETIF_F_HW_VLAN_CTAG_TX; |
diff --git a/drivers/net/ethernet/ti/cpsw.c b/drivers/net/ethernet/ti/cpsw.c index 7536a4c01293..5120d9ce1dd4 100644 --- a/drivers/net/ethernet/ti/cpsw.c +++ b/drivers/net/ethernet/ti/cpsw.c | |||
| @@ -1151,6 +1151,12 @@ static int cpsw_ndo_open(struct net_device *ndev) | |||
| 1151 | * receive descs | 1151 | * receive descs |
| 1152 | */ | 1152 | */ |
| 1153 | cpsw_info(priv, ifup, "submitted %d rx descriptors\n", i); | 1153 | cpsw_info(priv, ifup, "submitted %d rx descriptors\n", i); |
| 1154 | |||
| 1155 | if (cpts_register(&priv->pdev->dev, priv->cpts, | ||
| 1156 | priv->data.cpts_clock_mult, | ||
| 1157 | priv->data.cpts_clock_shift)) | ||
| 1158 | dev_err(priv->dev, "error registering cpts device\n"); | ||
| 1159 | |||
| 1154 | } | 1160 | } |
| 1155 | 1161 | ||
| 1156 | /* Enable Interrupt pacing if configured */ | 1162 | /* Enable Interrupt pacing if configured */ |
| @@ -1197,6 +1203,7 @@ static int cpsw_ndo_stop(struct net_device *ndev) | |||
| 1197 | netif_carrier_off(priv->ndev); | 1203 | netif_carrier_off(priv->ndev); |
| 1198 | 1204 | ||
| 1199 | if (cpsw_common_res_usage_state(priv) <= 1) { | 1205 | if (cpsw_common_res_usage_state(priv) <= 1) { |
| 1206 | cpts_unregister(priv->cpts); | ||
| 1200 | cpsw_intr_disable(priv); | 1207 | cpsw_intr_disable(priv); |
| 1201 | cpdma_ctlr_int_ctrl(priv->dma, false); | 1208 | cpdma_ctlr_int_ctrl(priv->dma, false); |
| 1202 | cpdma_ctlr_stop(priv->dma); | 1209 | cpdma_ctlr_stop(priv->dma); |
| @@ -1816,6 +1823,8 @@ static int cpsw_probe_dt(struct cpsw_platform_data *data, | |||
| 1816 | } | 1823 | } |
| 1817 | 1824 | ||
| 1818 | i++; | 1825 | i++; |
| 1826 | if (i == data->slaves) | ||
| 1827 | break; | ||
| 1819 | } | 1828 | } |
| 1820 | 1829 | ||
| 1821 | return 0; | 1830 | return 0; |
| @@ -1983,9 +1992,15 @@ static int cpsw_probe(struct platform_device *pdev) | |||
| 1983 | goto clean_runtime_disable_ret; | 1992 | goto clean_runtime_disable_ret; |
| 1984 | } | 1993 | } |
| 1985 | priv->regs = ss_regs; | 1994 | priv->regs = ss_regs; |
| 1986 | priv->version = __raw_readl(&priv->regs->id_ver); | ||
| 1987 | priv->host_port = HOST_PORT_NUM; | 1995 | priv->host_port = HOST_PORT_NUM; |
| 1988 | 1996 | ||
| 1997 | /* Need to enable clocks with runtime PM api to access module | ||
| 1998 | * registers | ||
| 1999 | */ | ||
| 2000 | pm_runtime_get_sync(&pdev->dev); | ||
| 2001 | priv->version = readl(&priv->regs->id_ver); | ||
| 2002 | pm_runtime_put_sync(&pdev->dev); | ||
| 2003 | |||
| 1989 | res = platform_get_resource(pdev, IORESOURCE_MEM, 1); | 2004 | res = platform_get_resource(pdev, IORESOURCE_MEM, 1); |
| 1990 | priv->wr_regs = devm_ioremap_resource(&pdev->dev, res); | 2005 | priv->wr_regs = devm_ioremap_resource(&pdev->dev, res); |
| 1991 | if (IS_ERR(priv->wr_regs)) { | 2006 | if (IS_ERR(priv->wr_regs)) { |
| @@ -2155,8 +2170,6 @@ static int cpsw_remove(struct platform_device *pdev) | |||
| 2155 | unregister_netdev(cpsw_get_slave_ndev(priv, 1)); | 2170 | unregister_netdev(cpsw_get_slave_ndev(priv, 1)); |
| 2156 | unregister_netdev(ndev); | 2171 | unregister_netdev(ndev); |
| 2157 | 2172 | ||
| 2158 | cpts_unregister(priv->cpts); | ||
| 2159 | |||
| 2160 | cpsw_ale_destroy(priv->ale); | 2173 | cpsw_ale_destroy(priv->ale); |
| 2161 | cpdma_chan_destroy(priv->txch); | 2174 | cpdma_chan_destroy(priv->txch); |
| 2162 | cpdma_chan_destroy(priv->rxch); | 2175 | cpdma_chan_destroy(priv->rxch); |
diff --git a/drivers/net/ethernet/ti/davinci_emac.c b/drivers/net/ethernet/ti/davinci_emac.c index 41ba974bf37c..cd9b164a0434 100644 --- a/drivers/net/ethernet/ti/davinci_emac.c +++ b/drivers/net/ethernet/ti/davinci_emac.c | |||
| @@ -61,6 +61,7 @@ | |||
| 61 | #include <linux/davinci_emac.h> | 61 | #include <linux/davinci_emac.h> |
| 62 | #include <linux/of.h> | 62 | #include <linux/of.h> |
| 63 | #include <linux/of_address.h> | 63 | #include <linux/of_address.h> |
| 64 | #include <linux/of_device.h> | ||
| 64 | #include <linux/of_irq.h> | 65 | #include <linux/of_irq.h> |
| 65 | #include <linux/of_net.h> | 66 | #include <linux/of_net.h> |
| 66 | 67 | ||
| @@ -1752,10 +1753,14 @@ static const struct net_device_ops emac_netdev_ops = { | |||
| 1752 | #endif | 1753 | #endif |
| 1753 | }; | 1754 | }; |
| 1754 | 1755 | ||
| 1756 | static const struct of_device_id davinci_emac_of_match[]; | ||
| 1757 | |||
| 1755 | static struct emac_platform_data * | 1758 | static struct emac_platform_data * |
| 1756 | davinci_emac_of_get_pdata(struct platform_device *pdev, struct emac_priv *priv) | 1759 | davinci_emac_of_get_pdata(struct platform_device *pdev, struct emac_priv *priv) |
| 1757 | { | 1760 | { |
| 1758 | struct device_node *np; | 1761 | struct device_node *np; |
| 1762 | const struct of_device_id *match; | ||
| 1763 | const struct emac_platform_data *auxdata; | ||
| 1759 | struct emac_platform_data *pdata = NULL; | 1764 | struct emac_platform_data *pdata = NULL; |
| 1760 | const u8 *mac_addr; | 1765 | const u8 *mac_addr; |
| 1761 | 1766 | ||
| @@ -1793,7 +1798,20 @@ davinci_emac_of_get_pdata(struct platform_device *pdev, struct emac_priv *priv) | |||
| 1793 | 1798 | ||
| 1794 | priv->phy_node = of_parse_phandle(np, "phy-handle", 0); | 1799 | priv->phy_node = of_parse_phandle(np, "phy-handle", 0); |
| 1795 | if (!priv->phy_node) | 1800 | if (!priv->phy_node) |
| 1796 | pdata->phy_id = ""; | 1801 | pdata->phy_id = NULL; |
| 1802 | |||
| 1803 | auxdata = pdev->dev.platform_data; | ||
| 1804 | if (auxdata) { | ||
| 1805 | pdata->interrupt_enable = auxdata->interrupt_enable; | ||
| 1806 | pdata->interrupt_disable = auxdata->interrupt_disable; | ||
| 1807 | } | ||
| 1808 | |||
| 1809 | match = of_match_device(davinci_emac_of_match, &pdev->dev); | ||
| 1810 | if (match && match->data) { | ||
| 1811 | auxdata = match->data; | ||
| 1812 | pdata->version = auxdata->version; | ||
| 1813 | pdata->hw_ram_addr = auxdata->hw_ram_addr; | ||
| 1814 | } | ||
| 1797 | 1815 | ||
| 1798 | pdev->dev.platform_data = pdata; | 1816 | pdev->dev.platform_data = pdata; |
| 1799 | 1817 | ||
| @@ -2020,8 +2038,14 @@ static const struct dev_pm_ops davinci_emac_pm_ops = { | |||
| 2020 | }; | 2038 | }; |
| 2021 | 2039 | ||
| 2022 | #if IS_ENABLED(CONFIG_OF) | 2040 | #if IS_ENABLED(CONFIG_OF) |
| 2041 | static const struct emac_platform_data am3517_emac_data = { | ||
| 2042 | .version = EMAC_VERSION_2, | ||
| 2043 | .hw_ram_addr = 0x01e20000, | ||
| 2044 | }; | ||
| 2045 | |||
| 2023 | static const struct of_device_id davinci_emac_of_match[] = { | 2046 | static const struct of_device_id davinci_emac_of_match[] = { |
| 2024 | {.compatible = "ti,davinci-dm6467-emac", }, | 2047 | {.compatible = "ti,davinci-dm6467-emac", }, |
| 2048 | {.compatible = "ti,am3517-emac", .data = &am3517_emac_data, }, | ||
| 2025 | {}, | 2049 | {}, |
| 2026 | }; | 2050 | }; |
| 2027 | MODULE_DEVICE_TABLE(of, davinci_emac_of_match); | 2051 | MODULE_DEVICE_TABLE(of, davinci_emac_of_match); |
diff --git a/drivers/net/ethernet/via/via-velocity.c b/drivers/net/ethernet/via/via-velocity.c index d022bf936572..ad61d26a44f3 100644 --- a/drivers/net/ethernet/via/via-velocity.c +++ b/drivers/net/ethernet/via/via-velocity.c | |||
| @@ -2172,16 +2172,13 @@ static int velocity_poll(struct napi_struct *napi, int budget) | |||
| 2172 | unsigned int rx_done; | 2172 | unsigned int rx_done; |
| 2173 | unsigned long flags; | 2173 | unsigned long flags; |
| 2174 | 2174 | ||
| 2175 | spin_lock_irqsave(&vptr->lock, flags); | ||
| 2176 | /* | 2175 | /* |
| 2177 | * Do rx and tx twice for performance (taken from the VIA | 2176 | * Do rx and tx twice for performance (taken from the VIA |
| 2178 | * out-of-tree driver). | 2177 | * out-of-tree driver). |
| 2179 | */ | 2178 | */ |
| 2180 | rx_done = velocity_rx_srv(vptr, budget / 2); | 2179 | rx_done = velocity_rx_srv(vptr, budget); |
| 2181 | velocity_tx_srv(vptr); | 2180 | spin_lock_irqsave(&vptr->lock, flags); |
| 2182 | rx_done += velocity_rx_srv(vptr, budget - rx_done); | ||
| 2183 | velocity_tx_srv(vptr); | 2181 | velocity_tx_srv(vptr); |
| 2184 | |||
| 2185 | /* If budget not fully consumed, exit the polling mode */ | 2182 | /* If budget not fully consumed, exit the polling mode */ |
| 2186 | if (rx_done < budget) { | 2183 | if (rx_done < budget) { |
| 2187 | napi_complete(napi); | 2184 | napi_complete(napi); |
| @@ -2342,6 +2339,8 @@ static int velocity_change_mtu(struct net_device *dev, int new_mtu) | |||
| 2342 | if (ret < 0) | 2339 | if (ret < 0) |
| 2343 | goto out_free_tmp_vptr_1; | 2340 | goto out_free_tmp_vptr_1; |
| 2344 | 2341 | ||
| 2342 | napi_disable(&vptr->napi); | ||
| 2343 | |||
| 2345 | spin_lock_irqsave(&vptr->lock, flags); | 2344 | spin_lock_irqsave(&vptr->lock, flags); |
| 2346 | 2345 | ||
| 2347 | netif_stop_queue(dev); | 2346 | netif_stop_queue(dev); |
| @@ -2362,6 +2361,8 @@ static int velocity_change_mtu(struct net_device *dev, int new_mtu) | |||
| 2362 | 2361 | ||
| 2363 | velocity_give_many_rx_descs(vptr); | 2362 | velocity_give_many_rx_descs(vptr); |
| 2364 | 2363 | ||
| 2364 | napi_enable(&vptr->napi); | ||
| 2365 | |||
| 2365 | mac_enable_int(vptr->mac_regs); | 2366 | mac_enable_int(vptr->mac_regs); |
| 2366 | netif_start_queue(dev); | 2367 | netif_start_queue(dev); |
| 2367 | 2368 | ||
diff --git a/drivers/net/ethernet/xilinx/ll_temac_main.c b/drivers/net/ethernet/xilinx/ll_temac_main.c index 1f2364126323..2166e879a096 100644 --- a/drivers/net/ethernet/xilinx/ll_temac_main.c +++ b/drivers/net/ethernet/xilinx/ll_temac_main.c | |||
| @@ -1017,7 +1017,7 @@ static int temac_of_probe(struct platform_device *op) | |||
| 1017 | platform_set_drvdata(op, ndev); | 1017 | platform_set_drvdata(op, ndev); |
| 1018 | SET_NETDEV_DEV(ndev, &op->dev); | 1018 | SET_NETDEV_DEV(ndev, &op->dev); |
| 1019 | ndev->flags &= ~IFF_MULTICAST; /* clear multicast */ | 1019 | ndev->flags &= ~IFF_MULTICAST; /* clear multicast */ |
| 1020 | ndev->features = NETIF_F_SG | NETIF_F_FRAGLIST; | 1020 | ndev->features = NETIF_F_SG; |
| 1021 | ndev->netdev_ops = &temac_netdev_ops; | 1021 | ndev->netdev_ops = &temac_netdev_ops; |
| 1022 | ndev->ethtool_ops = &temac_ethtool_ops; | 1022 | ndev->ethtool_ops = &temac_ethtool_ops; |
| 1023 | #if 0 | 1023 | #if 0 |
diff --git a/drivers/net/ethernet/xilinx/xilinx_axienet_main.c b/drivers/net/ethernet/xilinx/xilinx_axienet_main.c index b2ff038d6d20..f9293da19e26 100644 --- a/drivers/net/ethernet/xilinx/xilinx_axienet_main.c +++ b/drivers/net/ethernet/xilinx/xilinx_axienet_main.c | |||
| @@ -1486,7 +1486,7 @@ static int axienet_of_probe(struct platform_device *op) | |||
| 1486 | 1486 | ||
| 1487 | SET_NETDEV_DEV(ndev, &op->dev); | 1487 | SET_NETDEV_DEV(ndev, &op->dev); |
| 1488 | ndev->flags &= ~IFF_MULTICAST; /* clear multicast */ | 1488 | ndev->flags &= ~IFF_MULTICAST; /* clear multicast */ |
| 1489 | ndev->features = NETIF_F_SG | NETIF_F_FRAGLIST; | 1489 | ndev->features = NETIF_F_SG; |
| 1490 | ndev->netdev_ops = &axienet_netdev_ops; | 1490 | ndev->netdev_ops = &axienet_netdev_ops; |
| 1491 | ndev->ethtool_ops = &axienet_ethtool_ops; | 1491 | ndev->ethtool_ops = &axienet_ethtool_ops; |
| 1492 | 1492 | ||
diff --git a/drivers/net/ethernet/xilinx/xilinx_emaclite.c b/drivers/net/ethernet/xilinx/xilinx_emaclite.c index 74234a51c851..fefb8cd5eb65 100644 --- a/drivers/net/ethernet/xilinx/xilinx_emaclite.c +++ b/drivers/net/ethernet/xilinx/xilinx_emaclite.c | |||
| @@ -163,26 +163,9 @@ static void xemaclite_enable_interrupts(struct net_local *drvdata) | |||
| 163 | __raw_writel(reg_data | XEL_TSR_XMIT_IE_MASK, | 163 | __raw_writel(reg_data | XEL_TSR_XMIT_IE_MASK, |
| 164 | drvdata->base_addr + XEL_TSR_OFFSET); | 164 | drvdata->base_addr + XEL_TSR_OFFSET); |
| 165 | 165 | ||
| 166 | /* Enable the Tx interrupts for the second Buffer if | ||
| 167 | * configured in HW */ | ||
| 168 | if (drvdata->tx_ping_pong != 0) { | ||
| 169 | reg_data = __raw_readl(drvdata->base_addr + | ||
| 170 | XEL_BUFFER_OFFSET + XEL_TSR_OFFSET); | ||
| 171 | __raw_writel(reg_data | XEL_TSR_XMIT_IE_MASK, | ||
| 172 | drvdata->base_addr + XEL_BUFFER_OFFSET + | ||
| 173 | XEL_TSR_OFFSET); | ||
| 174 | } | ||
| 175 | |||
| 176 | /* Enable the Rx interrupts for the first buffer */ | 166 | /* Enable the Rx interrupts for the first buffer */ |
| 177 | __raw_writel(XEL_RSR_RECV_IE_MASK, drvdata->base_addr + XEL_RSR_OFFSET); | 167 | __raw_writel(XEL_RSR_RECV_IE_MASK, drvdata->base_addr + XEL_RSR_OFFSET); |
| 178 | 168 | ||
| 179 | /* Enable the Rx interrupts for the second Buffer if | ||
| 180 | * configured in HW */ | ||
| 181 | if (drvdata->rx_ping_pong != 0) { | ||
| 182 | __raw_writel(XEL_RSR_RECV_IE_MASK, drvdata->base_addr + | ||
| 183 | XEL_BUFFER_OFFSET + XEL_RSR_OFFSET); | ||
| 184 | } | ||
| 185 | |||
| 186 | /* Enable the Global Interrupt Enable */ | 169 | /* Enable the Global Interrupt Enable */ |
| 187 | __raw_writel(XEL_GIER_GIE_MASK, drvdata->base_addr + XEL_GIER_OFFSET); | 170 | __raw_writel(XEL_GIER_GIE_MASK, drvdata->base_addr + XEL_GIER_OFFSET); |
| 188 | } | 171 | } |
| @@ -206,31 +189,10 @@ static void xemaclite_disable_interrupts(struct net_local *drvdata) | |||
| 206 | __raw_writel(reg_data & (~XEL_TSR_XMIT_IE_MASK), | 189 | __raw_writel(reg_data & (~XEL_TSR_XMIT_IE_MASK), |
| 207 | drvdata->base_addr + XEL_TSR_OFFSET); | 190 | drvdata->base_addr + XEL_TSR_OFFSET); |
| 208 | 191 | ||
| 209 | /* Disable the Tx interrupts for the second Buffer | ||
| 210 | * if configured in HW */ | ||
| 211 | if (drvdata->tx_ping_pong != 0) { | ||
| 212 | reg_data = __raw_readl(drvdata->base_addr + XEL_BUFFER_OFFSET + | ||
| 213 | XEL_TSR_OFFSET); | ||
| 214 | __raw_writel(reg_data & (~XEL_TSR_XMIT_IE_MASK), | ||
| 215 | drvdata->base_addr + XEL_BUFFER_OFFSET + | ||
| 216 | XEL_TSR_OFFSET); | ||
| 217 | } | ||
| 218 | |||
| 219 | /* Disable the Rx interrupts for the first buffer */ | 192 | /* Disable the Rx interrupts for the first buffer */ |
| 220 | reg_data = __raw_readl(drvdata->base_addr + XEL_RSR_OFFSET); | 193 | reg_data = __raw_readl(drvdata->base_addr + XEL_RSR_OFFSET); |
| 221 | __raw_writel(reg_data & (~XEL_RSR_RECV_IE_MASK), | 194 | __raw_writel(reg_data & (~XEL_RSR_RECV_IE_MASK), |
| 222 | drvdata->base_addr + XEL_RSR_OFFSET); | 195 | drvdata->base_addr + XEL_RSR_OFFSET); |
| 223 | |||
| 224 | /* Disable the Rx interrupts for the second buffer | ||
| 225 | * if configured in HW */ | ||
| 226 | if (drvdata->rx_ping_pong != 0) { | ||
| 227 | |||
| 228 | reg_data = __raw_readl(drvdata->base_addr + XEL_BUFFER_OFFSET + | ||
| 229 | XEL_RSR_OFFSET); | ||
| 230 | __raw_writel(reg_data & (~XEL_RSR_RECV_IE_MASK), | ||
| 231 | drvdata->base_addr + XEL_BUFFER_OFFSET + | ||
| 232 | XEL_RSR_OFFSET); | ||
| 233 | } | ||
| 234 | } | 196 | } |
| 235 | 197 | ||
| 236 | /** | 198 | /** |
| @@ -258,6 +220,13 @@ static void xemaclite_aligned_write(void *src_ptr, u32 *dest_ptr, | |||
| 258 | *to_u16_ptr++ = *from_u16_ptr++; | 220 | *to_u16_ptr++ = *from_u16_ptr++; |
| 259 | *to_u16_ptr++ = *from_u16_ptr++; | 221 | *to_u16_ptr++ = *from_u16_ptr++; |
| 260 | 222 | ||
| 223 | /* This barrier resolves occasional issues seen around | ||
| 224 | * cases where the data is not properly flushed out | ||
| 225 | * from the processor store buffers to the destination | ||
| 226 | * memory locations. | ||
| 227 | */ | ||
| 228 | wmb(); | ||
| 229 | |||
| 261 | /* Output a word */ | 230 | /* Output a word */ |
| 262 | *to_u32_ptr++ = align_buffer; | 231 | *to_u32_ptr++ = align_buffer; |
| 263 | } | 232 | } |
| @@ -273,6 +242,12 @@ static void xemaclite_aligned_write(void *src_ptr, u32 *dest_ptr, | |||
| 273 | for (; length > 0; length--) | 242 | for (; length > 0; length--) |
| 274 | *to_u8_ptr++ = *from_u8_ptr++; | 243 | *to_u8_ptr++ = *from_u8_ptr++; |
| 275 | 244 | ||
| 245 | /* This barrier resolves occasional issues seen around | ||
| 246 | * cases where the data is not properly flushed out | ||
| 247 | * from the processor store buffers to the destination | ||
| 248 | * memory locations. | ||
| 249 | */ | ||
| 250 | wmb(); | ||
| 276 | *to_u32_ptr = align_buffer; | 251 | *to_u32_ptr = align_buffer; |
| 277 | } | 252 | } |
| 278 | } | 253 | } |
diff --git a/drivers/net/macvtap.c b/drivers/net/macvtap.c index dc76670c2f2a..2a89da080317 100644 --- a/drivers/net/macvtap.c +++ b/drivers/net/macvtap.c | |||
| @@ -744,7 +744,7 @@ err: | |||
| 744 | rcu_read_lock(); | 744 | rcu_read_lock(); |
| 745 | vlan = rcu_dereference(q->vlan); | 745 | vlan = rcu_dereference(q->vlan); |
| 746 | if (vlan) | 746 | if (vlan) |
| 747 | vlan->dev->stats.tx_dropped++; | 747 | this_cpu_inc(vlan->pcpu_stats->tx_dropped); |
| 748 | rcu_read_unlock(); | 748 | rcu_read_unlock(); |
| 749 | 749 | ||
| 750 | return err; | 750 | return err; |
| @@ -767,11 +767,10 @@ static ssize_t macvtap_put_user(struct macvtap_queue *q, | |||
| 767 | const struct sk_buff *skb, | 767 | const struct sk_buff *skb, |
| 768 | const struct iovec *iv, int len) | 768 | const struct iovec *iv, int len) |
| 769 | { | 769 | { |
| 770 | struct macvlan_dev *vlan; | ||
| 771 | int ret; | 770 | int ret; |
| 772 | int vnet_hdr_len = 0; | 771 | int vnet_hdr_len = 0; |
| 773 | int vlan_offset = 0; | 772 | int vlan_offset = 0; |
| 774 | int copied; | 773 | int copied, total; |
| 775 | 774 | ||
| 776 | if (q->flags & IFF_VNET_HDR) { | 775 | if (q->flags & IFF_VNET_HDR) { |
| 777 | struct virtio_net_hdr vnet_hdr; | 776 | struct virtio_net_hdr vnet_hdr; |
| @@ -786,7 +785,8 @@ static ssize_t macvtap_put_user(struct macvtap_queue *q, | |||
| 786 | if (memcpy_toiovecend(iv, (void *)&vnet_hdr, 0, sizeof(vnet_hdr))) | 785 | if (memcpy_toiovecend(iv, (void *)&vnet_hdr, 0, sizeof(vnet_hdr))) |
| 787 | return -EFAULT; | 786 | return -EFAULT; |
| 788 | } | 787 | } |
| 789 | copied = vnet_hdr_len; | 788 | total = copied = vnet_hdr_len; |
| 789 | total += skb->len; | ||
| 790 | 790 | ||
| 791 | if (!vlan_tx_tag_present(skb)) | 791 | if (!vlan_tx_tag_present(skb)) |
| 792 | len = min_t(int, skb->len, len); | 792 | len = min_t(int, skb->len, len); |
| @@ -801,6 +801,7 @@ static ssize_t macvtap_put_user(struct macvtap_queue *q, | |||
| 801 | 801 | ||
| 802 | vlan_offset = offsetof(struct vlan_ethhdr, h_vlan_proto); | 802 | vlan_offset = offsetof(struct vlan_ethhdr, h_vlan_proto); |
| 803 | len = min_t(int, skb->len + VLAN_HLEN, len); | 803 | len = min_t(int, skb->len + VLAN_HLEN, len); |
| 804 | total += VLAN_HLEN; | ||
| 804 | 805 | ||
| 805 | copy = min_t(int, vlan_offset, len); | 806 | copy = min_t(int, vlan_offset, len); |
| 806 | ret = skb_copy_datagram_const_iovec(skb, 0, iv, copied, copy); | 807 | ret = skb_copy_datagram_const_iovec(skb, 0, iv, copied, copy); |
| @@ -818,19 +819,9 @@ static ssize_t macvtap_put_user(struct macvtap_queue *q, | |||
| 818 | } | 819 | } |
| 819 | 820 | ||
| 820 | ret = skb_copy_datagram_const_iovec(skb, vlan_offset, iv, copied, len); | 821 | ret = skb_copy_datagram_const_iovec(skb, vlan_offset, iv, copied, len); |
| 821 | copied += len; | ||
| 822 | 822 | ||
| 823 | done: | 823 | done: |
| 824 | rcu_read_lock(); | 824 | return ret ? ret : total; |
| 825 | vlan = rcu_dereference(q->vlan); | ||
| 826 | if (vlan) { | ||
| 827 | preempt_disable(); | ||
| 828 | macvlan_count_rx(vlan, copied - vnet_hdr_len, ret == 0, 0); | ||
| 829 | preempt_enable(); | ||
| 830 | } | ||
| 831 | rcu_read_unlock(); | ||
| 832 | |||
| 833 | return ret ? ret : copied; | ||
| 834 | } | 825 | } |
| 835 | 826 | ||
| 836 | static ssize_t macvtap_do_read(struct macvtap_queue *q, struct kiocb *iocb, | 827 | static ssize_t macvtap_do_read(struct macvtap_queue *q, struct kiocb *iocb, |
| @@ -885,7 +876,9 @@ static ssize_t macvtap_aio_read(struct kiocb *iocb, const struct iovec *iv, | |||
| 885 | } | 876 | } |
| 886 | 877 | ||
| 887 | ret = macvtap_do_read(q, iocb, iv, len, file->f_flags & O_NONBLOCK); | 878 | ret = macvtap_do_read(q, iocb, iv, len, file->f_flags & O_NONBLOCK); |
| 888 | ret = min_t(ssize_t, ret, len); /* XXX copied from tun.c. Why? */ | 879 | ret = min_t(ssize_t, ret, len); |
| 880 | if (ret > 0) | ||
| 881 | iocb->ki_pos = ret; | ||
| 889 | out: | 882 | out: |
| 890 | return ret; | 883 | return ret; |
| 891 | } | 884 | } |
diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c index 3ae28f420868..26fa05a472b4 100644 --- a/drivers/net/phy/micrel.c +++ b/drivers/net/phy/micrel.c | |||
| @@ -336,6 +336,21 @@ static struct phy_driver ksphy_driver[] = { | |||
| 336 | .resume = genphy_resume, | 336 | .resume = genphy_resume, |
| 337 | .driver = { .owner = THIS_MODULE,}, | 337 | .driver = { .owner = THIS_MODULE,}, |
| 338 | }, { | 338 | }, { |
| 339 | .phy_id = PHY_ID_KSZ8041RNLI, | ||
| 340 | .phy_id_mask = 0x00fffff0, | ||
| 341 | .name = "Micrel KSZ8041RNLI", | ||
| 342 | .features = PHY_BASIC_FEATURES | | ||
| 343 | SUPPORTED_Pause | SUPPORTED_Asym_Pause, | ||
| 344 | .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT, | ||
| 345 | .config_init = kszphy_config_init, | ||
| 346 | .config_aneg = genphy_config_aneg, | ||
| 347 | .read_status = genphy_read_status, | ||
| 348 | .ack_interrupt = kszphy_ack_interrupt, | ||
| 349 | .config_intr = kszphy_config_intr, | ||
| 350 | .suspend = genphy_suspend, | ||
| 351 | .resume = genphy_resume, | ||
| 352 | .driver = { .owner = THIS_MODULE,}, | ||
| 353 | }, { | ||
| 339 | .phy_id = PHY_ID_KSZ8051, | 354 | .phy_id = PHY_ID_KSZ8051, |
| 340 | .phy_id_mask = 0x00fffff0, | 355 | .phy_id_mask = 0x00fffff0, |
| 341 | .name = "Micrel KSZ8051", | 356 | .name = "Micrel KSZ8051", |
diff --git a/drivers/net/phy/vitesse.c b/drivers/net/phy/vitesse.c index 508e4359338b..14372c65a7e8 100644 --- a/drivers/net/phy/vitesse.c +++ b/drivers/net/phy/vitesse.c | |||
| @@ -64,6 +64,7 @@ | |||
| 64 | 64 | ||
| 65 | #define PHY_ID_VSC8234 0x000fc620 | 65 | #define PHY_ID_VSC8234 0x000fc620 |
| 66 | #define PHY_ID_VSC8244 0x000fc6c0 | 66 | #define PHY_ID_VSC8244 0x000fc6c0 |
| 67 | #define PHY_ID_VSC8514 0x00070670 | ||
| 67 | #define PHY_ID_VSC8574 0x000704a0 | 68 | #define PHY_ID_VSC8574 0x000704a0 |
| 68 | #define PHY_ID_VSC8662 0x00070660 | 69 | #define PHY_ID_VSC8662 0x00070660 |
| 69 | #define PHY_ID_VSC8221 0x000fc550 | 70 | #define PHY_ID_VSC8221 0x000fc550 |
| @@ -131,6 +132,7 @@ static int vsc82xx_config_intr(struct phy_device *phydev) | |||
| 131 | err = phy_write(phydev, MII_VSC8244_IMASK, | 132 | err = phy_write(phydev, MII_VSC8244_IMASK, |
| 132 | (phydev->drv->phy_id == PHY_ID_VSC8234 || | 133 | (phydev->drv->phy_id == PHY_ID_VSC8234 || |
| 133 | phydev->drv->phy_id == PHY_ID_VSC8244 || | 134 | phydev->drv->phy_id == PHY_ID_VSC8244 || |
| 135 | phydev->drv->phy_id == PHY_ID_VSC8514 || | ||
| 134 | phydev->drv->phy_id == PHY_ID_VSC8574) ? | 136 | phydev->drv->phy_id == PHY_ID_VSC8574) ? |
| 135 | MII_VSC8244_IMASK_MASK : | 137 | MII_VSC8244_IMASK_MASK : |
| 136 | MII_VSC8221_IMASK_MASK); | 138 | MII_VSC8221_IMASK_MASK); |
| @@ -246,6 +248,18 @@ static struct phy_driver vsc82xx_driver[] = { | |||
| 246 | .config_intr = &vsc82xx_config_intr, | 248 | .config_intr = &vsc82xx_config_intr, |
| 247 | .driver = { .owner = THIS_MODULE,}, | 249 | .driver = { .owner = THIS_MODULE,}, |
| 248 | }, { | 250 | }, { |
| 251 | .phy_id = PHY_ID_VSC8514, | ||
| 252 | .name = "Vitesse VSC8514", | ||
| 253 | .phy_id_mask = 0x000ffff0, | ||
| 254 | .features = PHY_GBIT_FEATURES, | ||
| 255 | .flags = PHY_HAS_INTERRUPT, | ||
| 256 | .config_init = &vsc824x_config_init, | ||
| 257 | .config_aneg = &vsc82x4_config_aneg, | ||
| 258 | .read_status = &genphy_read_status, | ||
| 259 | .ack_interrupt = &vsc824x_ack_interrupt, | ||
| 260 | .config_intr = &vsc82xx_config_intr, | ||
| 261 | .driver = { .owner = THIS_MODULE,}, | ||
| 262 | }, { | ||
| 249 | .phy_id = PHY_ID_VSC8574, | 263 | .phy_id = PHY_ID_VSC8574, |
| 250 | .name = "Vitesse VSC8574", | 264 | .name = "Vitesse VSC8574", |
| 251 | .phy_id_mask = 0x000ffff0, | 265 | .phy_id_mask = 0x000ffff0, |
| @@ -315,6 +329,7 @@ module_exit(vsc82xx_exit); | |||
| 315 | static struct mdio_device_id __maybe_unused vitesse_tbl[] = { | 329 | static struct mdio_device_id __maybe_unused vitesse_tbl[] = { |
| 316 | { PHY_ID_VSC8234, 0x000ffff0 }, | 330 | { PHY_ID_VSC8234, 0x000ffff0 }, |
| 317 | { PHY_ID_VSC8244, 0x000fffc0 }, | 331 | { PHY_ID_VSC8244, 0x000fffc0 }, |
| 332 | { PHY_ID_VSC8514, 0x000ffff0 }, | ||
| 318 | { PHY_ID_VSC8574, 0x000ffff0 }, | 333 | { PHY_ID_VSC8574, 0x000ffff0 }, |
| 319 | { PHY_ID_VSC8662, 0x000ffff0 }, | 334 | { PHY_ID_VSC8662, 0x000ffff0 }, |
| 320 | { PHY_ID_VSC8221, 0x000ffff0 }, | 335 | { PHY_ID_VSC8221, 0x000ffff0 }, |
diff --git a/drivers/net/team/team.c b/drivers/net/team/team.c index 34b0de09d881..736050d6b451 100644 --- a/drivers/net/team/team.c +++ b/drivers/net/team/team.c | |||
| @@ -1366,6 +1366,8 @@ static int team_user_linkup_option_get(struct team *team, | |||
| 1366 | return 0; | 1366 | return 0; |
| 1367 | } | 1367 | } |
| 1368 | 1368 | ||
| 1369 | static void __team_carrier_check(struct team *team); | ||
| 1370 | |||
| 1369 | static int team_user_linkup_option_set(struct team *team, | 1371 | static int team_user_linkup_option_set(struct team *team, |
| 1370 | struct team_gsetter_ctx *ctx) | 1372 | struct team_gsetter_ctx *ctx) |
| 1371 | { | 1373 | { |
| @@ -1373,6 +1375,7 @@ static int team_user_linkup_option_set(struct team *team, | |||
| 1373 | 1375 | ||
| 1374 | port->user.linkup = ctx->data.bool_val; | 1376 | port->user.linkup = ctx->data.bool_val; |
| 1375 | team_refresh_port_linkup(port); | 1377 | team_refresh_port_linkup(port); |
| 1378 | __team_carrier_check(port->team); | ||
| 1376 | return 0; | 1379 | return 0; |
| 1377 | } | 1380 | } |
| 1378 | 1381 | ||
| @@ -1392,6 +1395,7 @@ static int team_user_linkup_en_option_set(struct team *team, | |||
| 1392 | 1395 | ||
| 1393 | port->user.linkup_enabled = ctx->data.bool_val; | 1396 | port->user.linkup_enabled = ctx->data.bool_val; |
| 1394 | team_refresh_port_linkup(port); | 1397 | team_refresh_port_linkup(port); |
| 1398 | __team_carrier_check(port->team); | ||
| 1395 | return 0; | 1399 | return 0; |
| 1396 | } | 1400 | } |
| 1397 | 1401 | ||
diff --git a/drivers/net/tun.c b/drivers/net/tun.c index 782e38bfc1ee..7c8343a4f918 100644 --- a/drivers/net/tun.c +++ b/drivers/net/tun.c | |||
| @@ -1184,7 +1184,7 @@ static ssize_t tun_put_user(struct tun_struct *tun, | |||
| 1184 | { | 1184 | { |
| 1185 | struct tun_pi pi = { 0, skb->protocol }; | 1185 | struct tun_pi pi = { 0, skb->protocol }; |
| 1186 | ssize_t total = 0; | 1186 | ssize_t total = 0; |
| 1187 | int vlan_offset = 0; | 1187 | int vlan_offset = 0, copied; |
| 1188 | 1188 | ||
| 1189 | if (!(tun->flags & TUN_NO_PI)) { | 1189 | if (!(tun->flags & TUN_NO_PI)) { |
| 1190 | if ((len -= sizeof(pi)) < 0) | 1190 | if ((len -= sizeof(pi)) < 0) |
| @@ -1248,6 +1248,8 @@ static ssize_t tun_put_user(struct tun_struct *tun, | |||
| 1248 | total += tun->vnet_hdr_sz; | 1248 | total += tun->vnet_hdr_sz; |
| 1249 | } | 1249 | } |
| 1250 | 1250 | ||
| 1251 | copied = total; | ||
| 1252 | total += skb->len; | ||
| 1251 | if (!vlan_tx_tag_present(skb)) { | 1253 | if (!vlan_tx_tag_present(skb)) { |
| 1252 | len = min_t(int, skb->len, len); | 1254 | len = min_t(int, skb->len, len); |
| 1253 | } else { | 1255 | } else { |
| @@ -1262,24 +1264,24 @@ static ssize_t tun_put_user(struct tun_struct *tun, | |||
| 1262 | 1264 | ||
| 1263 | vlan_offset = offsetof(struct vlan_ethhdr, h_vlan_proto); | 1265 | vlan_offset = offsetof(struct vlan_ethhdr, h_vlan_proto); |
| 1264 | len = min_t(int, skb->len + VLAN_HLEN, len); | 1266 | len = min_t(int, skb->len + VLAN_HLEN, len); |
| 1267 | total += VLAN_HLEN; | ||
| 1265 | 1268 | ||
| 1266 | copy = min_t(int, vlan_offset, len); | 1269 | copy = min_t(int, vlan_offset, len); |
| 1267 | ret = skb_copy_datagram_const_iovec(skb, 0, iv, total, copy); | 1270 | ret = skb_copy_datagram_const_iovec(skb, 0, iv, copied, copy); |
| 1268 | len -= copy; | 1271 | len -= copy; |
| 1269 | total += copy; | 1272 | copied += copy; |
| 1270 | if (ret || !len) | 1273 | if (ret || !len) |
| 1271 | goto done; | 1274 | goto done; |
| 1272 | 1275 | ||
| 1273 | copy = min_t(int, sizeof(veth), len); | 1276 | copy = min_t(int, sizeof(veth), len); |
| 1274 | ret = memcpy_toiovecend(iv, (void *)&veth, total, copy); | 1277 | ret = memcpy_toiovecend(iv, (void *)&veth, copied, copy); |
| 1275 | len -= copy; | 1278 | len -= copy; |
| 1276 | total += copy; | 1279 | copied += copy; |
| 1277 | if (ret || !len) | 1280 | if (ret || !len) |
| 1278 | goto done; | 1281 | goto done; |
| 1279 | } | 1282 | } |
| 1280 | 1283 | ||
| 1281 | skb_copy_datagram_const_iovec(skb, vlan_offset, iv, total, len); | 1284 | skb_copy_datagram_const_iovec(skb, vlan_offset, iv, copied, len); |
| 1282 | total += len; | ||
| 1283 | 1285 | ||
| 1284 | done: | 1286 | done: |
| 1285 | tun->dev->stats.tx_packets++; | 1287 | tun->dev->stats.tx_packets++; |
| @@ -1356,6 +1358,8 @@ static ssize_t tun_chr_aio_read(struct kiocb *iocb, const struct iovec *iv, | |||
| 1356 | ret = tun_do_read(tun, tfile, iocb, iv, len, | 1358 | ret = tun_do_read(tun, tfile, iocb, iv, len, |
| 1357 | file->f_flags & O_NONBLOCK); | 1359 | file->f_flags & O_NONBLOCK); |
| 1358 | ret = min_t(ssize_t, ret, len); | 1360 | ret = min_t(ssize_t, ret, len); |
| 1361 | if (ret > 0) | ||
| 1362 | iocb->ki_pos = ret; | ||
| 1359 | out: | 1363 | out: |
| 1360 | tun_put(tun); | 1364 | tun_put(tun); |
| 1361 | return ret; | 1365 | return ret; |
diff --git a/drivers/net/virtio_net.c b/drivers/net/virtio_net.c index 7bab4de658a9..d208f8604981 100644 --- a/drivers/net/virtio_net.c +++ b/drivers/net/virtio_net.c | |||
| @@ -299,35 +299,76 @@ static struct sk_buff *page_to_skb(struct receive_queue *rq, | |||
| 299 | return skb; | 299 | return skb; |
| 300 | } | 300 | } |
| 301 | 301 | ||
| 302 | static int receive_mergeable(struct receive_queue *rq, struct sk_buff *head_skb) | 302 | static struct sk_buff *receive_small(void *buf, unsigned int len) |
| 303 | { | 303 | { |
| 304 | struct skb_vnet_hdr *hdr = skb_vnet_hdr(head_skb); | 304 | struct sk_buff * skb = buf; |
| 305 | |||
| 306 | len -= sizeof(struct virtio_net_hdr); | ||
| 307 | skb_trim(skb, len); | ||
| 308 | |||
| 309 | return skb; | ||
| 310 | } | ||
| 311 | |||
| 312 | static struct sk_buff *receive_big(struct net_device *dev, | ||
| 313 | struct receive_queue *rq, | ||
| 314 | void *buf, | ||
| 315 | unsigned int len) | ||
| 316 | { | ||
| 317 | struct page *page = buf; | ||
| 318 | struct sk_buff *skb = page_to_skb(rq, page, 0, len, PAGE_SIZE); | ||
| 319 | |||
| 320 | if (unlikely(!skb)) | ||
| 321 | goto err; | ||
| 322 | |||
| 323 | return skb; | ||
| 324 | |||
| 325 | err: | ||
| 326 | dev->stats.rx_dropped++; | ||
| 327 | give_pages(rq, page); | ||
| 328 | return NULL; | ||
| 329 | } | ||
| 330 | |||
| 331 | static struct sk_buff *receive_mergeable(struct net_device *dev, | ||
| 332 | struct receive_queue *rq, | ||
| 333 | void *buf, | ||
| 334 | unsigned int len) | ||
| 335 | { | ||
| 336 | struct skb_vnet_hdr *hdr = buf; | ||
| 337 | int num_buf = hdr->mhdr.num_buffers; | ||
| 338 | struct page *page = virt_to_head_page(buf); | ||
| 339 | int offset = buf - page_address(page); | ||
| 340 | struct sk_buff *head_skb = page_to_skb(rq, page, offset, len, | ||
| 341 | MERGE_BUFFER_LEN); | ||
| 305 | struct sk_buff *curr_skb = head_skb; | 342 | struct sk_buff *curr_skb = head_skb; |
| 306 | char *buf; | ||
| 307 | struct page *page; | ||
| 308 | int num_buf, len, offset; | ||
| 309 | 343 | ||
| 310 | num_buf = hdr->mhdr.num_buffers; | 344 | if (unlikely(!curr_skb)) |
| 345 | goto err_skb; | ||
| 346 | |||
| 311 | while (--num_buf) { | 347 | while (--num_buf) { |
| 312 | int num_skb_frags = skb_shinfo(curr_skb)->nr_frags; | 348 | int num_skb_frags; |
| 349 | |||
| 313 | buf = virtqueue_get_buf(rq->vq, &len); | 350 | buf = virtqueue_get_buf(rq->vq, &len); |
| 314 | if (unlikely(!buf)) { | 351 | if (unlikely(!buf)) { |
| 315 | pr_debug("%s: rx error: %d buffers missing\n", | 352 | pr_debug("%s: rx error: %d buffers out of %d missing\n", |
| 316 | head_skb->dev->name, hdr->mhdr.num_buffers); | 353 | dev->name, num_buf, hdr->mhdr.num_buffers); |
| 317 | head_skb->dev->stats.rx_length_errors++; | 354 | dev->stats.rx_length_errors++; |
| 318 | return -EINVAL; | 355 | goto err_buf; |
| 319 | } | 356 | } |
| 320 | if (unlikely(len > MERGE_BUFFER_LEN)) { | 357 | if (unlikely(len > MERGE_BUFFER_LEN)) { |
| 321 | pr_debug("%s: rx error: merge buffer too long\n", | 358 | pr_debug("%s: rx error: merge buffer too long\n", |
| 322 | head_skb->dev->name); | 359 | dev->name); |
| 323 | len = MERGE_BUFFER_LEN; | 360 | len = MERGE_BUFFER_LEN; |
| 324 | } | 361 | } |
| 362 | |||
| 363 | page = virt_to_head_page(buf); | ||
| 364 | --rq->num; | ||
| 365 | |||
| 366 | num_skb_frags = skb_shinfo(curr_skb)->nr_frags; | ||
| 325 | if (unlikely(num_skb_frags == MAX_SKB_FRAGS)) { | 367 | if (unlikely(num_skb_frags == MAX_SKB_FRAGS)) { |
| 326 | struct sk_buff *nskb = alloc_skb(0, GFP_ATOMIC); | 368 | struct sk_buff *nskb = alloc_skb(0, GFP_ATOMIC); |
| 327 | if (unlikely(!nskb)) { | 369 | |
| 328 | head_skb->dev->stats.rx_dropped++; | 370 | if (unlikely(!nskb)) |
| 329 | return -ENOMEM; | 371 | goto err_skb; |
| 330 | } | ||
| 331 | if (curr_skb == head_skb) | 372 | if (curr_skb == head_skb) |
| 332 | skb_shinfo(curr_skb)->frag_list = nskb; | 373 | skb_shinfo(curr_skb)->frag_list = nskb; |
| 333 | else | 374 | else |
| @@ -341,8 +382,7 @@ static int receive_mergeable(struct receive_queue *rq, struct sk_buff *head_skb) | |||
| 341 | head_skb->len += len; | 382 | head_skb->len += len; |
| 342 | head_skb->truesize += MERGE_BUFFER_LEN; | 383 | head_skb->truesize += MERGE_BUFFER_LEN; |
| 343 | } | 384 | } |
| 344 | page = virt_to_head_page(buf); | 385 | offset = buf - page_address(page); |
| 345 | offset = buf - (char *)page_address(page); | ||
| 346 | if (skb_can_coalesce(curr_skb, num_skb_frags, page, offset)) { | 386 | if (skb_can_coalesce(curr_skb, num_skb_frags, page, offset)) { |
| 347 | put_page(page); | 387 | put_page(page); |
| 348 | skb_coalesce_rx_frag(curr_skb, num_skb_frags - 1, | 388 | skb_coalesce_rx_frag(curr_skb, num_skb_frags - 1, |
| @@ -351,9 +391,28 @@ static int receive_mergeable(struct receive_queue *rq, struct sk_buff *head_skb) | |||
| 351 | skb_add_rx_frag(curr_skb, num_skb_frags, page, | 391 | skb_add_rx_frag(curr_skb, num_skb_frags, page, |
| 352 | offset, len, MERGE_BUFFER_LEN); | 392 | offset, len, MERGE_BUFFER_LEN); |
| 353 | } | 393 | } |
| 394 | } | ||
| 395 | |||
| 396 | return head_skb; | ||
| 397 | |||
| 398 | err_skb: | ||
| 399 | put_page(page); | ||
| 400 | while (--num_buf) { | ||
| 401 | buf = virtqueue_get_buf(rq->vq, &len); | ||
| 402 | if (unlikely(!buf)) { | ||
| 403 | pr_debug("%s: rx error: %d buffers missing\n", | ||
| 404 | dev->name, num_buf); | ||
| 405 | dev->stats.rx_length_errors++; | ||
| 406 | break; | ||
| 407 | } | ||
| 408 | page = virt_to_head_page(buf); | ||
| 409 | put_page(page); | ||
| 354 | --rq->num; | 410 | --rq->num; |
| 355 | } | 411 | } |
| 356 | return 0; | 412 | err_buf: |
| 413 | dev->stats.rx_dropped++; | ||
| 414 | dev_kfree_skb(head_skb); | ||
| 415 | return NULL; | ||
| 357 | } | 416 | } |
| 358 | 417 | ||
| 359 | static void receive_buf(struct receive_queue *rq, void *buf, unsigned int len) | 418 | static void receive_buf(struct receive_queue *rq, void *buf, unsigned int len) |
| @@ -362,48 +421,29 @@ static void receive_buf(struct receive_queue *rq, void *buf, unsigned int len) | |||
| 362 | struct net_device *dev = vi->dev; | 421 | struct net_device *dev = vi->dev; |
| 363 | struct virtnet_stats *stats = this_cpu_ptr(vi->stats); | 422 | struct virtnet_stats *stats = this_cpu_ptr(vi->stats); |
| 364 | struct sk_buff *skb; | 423 | struct sk_buff *skb; |
| 365 | struct page *page; | ||
| 366 | struct skb_vnet_hdr *hdr; | 424 | struct skb_vnet_hdr *hdr; |
| 367 | 425 | ||
| 368 | if (unlikely(len < sizeof(struct virtio_net_hdr) + ETH_HLEN)) { | 426 | if (unlikely(len < sizeof(struct virtio_net_hdr) + ETH_HLEN)) { |
| 369 | pr_debug("%s: short packet %i\n", dev->name, len); | 427 | pr_debug("%s: short packet %i\n", dev->name, len); |
| 370 | dev->stats.rx_length_errors++; | 428 | dev->stats.rx_length_errors++; |
| 371 | if (vi->big_packets) | 429 | if (vi->mergeable_rx_bufs) |
| 372 | give_pages(rq, buf); | ||
| 373 | else if (vi->mergeable_rx_bufs) | ||
| 374 | put_page(virt_to_head_page(buf)); | 430 | put_page(virt_to_head_page(buf)); |
| 431 | else if (vi->big_packets) | ||
| 432 | give_pages(rq, buf); | ||
| 375 | else | 433 | else |
| 376 | dev_kfree_skb(buf); | 434 | dev_kfree_skb(buf); |
| 377 | return; | 435 | return; |
| 378 | } | 436 | } |
| 379 | 437 | ||
| 380 | if (!vi->mergeable_rx_bufs && !vi->big_packets) { | 438 | if (vi->mergeable_rx_bufs) |
| 381 | skb = buf; | 439 | skb = receive_mergeable(dev, rq, buf, len); |
| 382 | len -= sizeof(struct virtio_net_hdr); | 440 | else if (vi->big_packets) |
| 383 | skb_trim(skb, len); | 441 | skb = receive_big(dev, rq, buf, len); |
| 384 | } else if (vi->mergeable_rx_bufs) { | 442 | else |
| 385 | struct page *page = virt_to_head_page(buf); | 443 | skb = receive_small(buf, len); |
| 386 | skb = page_to_skb(rq, page, | 444 | |
| 387 | (char *)buf - (char *)page_address(page), | 445 | if (unlikely(!skb)) |
| 388 | len, MERGE_BUFFER_LEN); | 446 | return; |
| 389 | if (unlikely(!skb)) { | ||
| 390 | dev->stats.rx_dropped++; | ||
| 391 | put_page(page); | ||
| 392 | return; | ||
| 393 | } | ||
| 394 | if (receive_mergeable(rq, skb)) { | ||
| 395 | dev_kfree_skb(skb); | ||
| 396 | return; | ||
| 397 | } | ||
| 398 | } else { | ||
| 399 | page = buf; | ||
| 400 | skb = page_to_skb(rq, page, 0, len, PAGE_SIZE); | ||
| 401 | if (unlikely(!skb)) { | ||
| 402 | dev->stats.rx_dropped++; | ||
| 403 | give_pages(rq, page); | ||
| 404 | return; | ||
| 405 | } | ||
| 406 | } | ||
| 407 | 447 | ||
| 408 | hdr = skb_vnet_hdr(skb); | 448 | hdr = skb_vnet_hdr(skb); |
| 409 | 449 | ||
| @@ -1084,7 +1124,7 @@ static void virtnet_set_rx_mode(struct net_device *dev) | |||
| 1084 | if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_MAC, | 1124 | if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_MAC, |
| 1085 | VIRTIO_NET_CTRL_MAC_TABLE_SET, | 1125 | VIRTIO_NET_CTRL_MAC_TABLE_SET, |
| 1086 | sg, NULL)) | 1126 | sg, NULL)) |
| 1087 | dev_warn(&dev->dev, "Failed to set MAC fitler table.\n"); | 1127 | dev_warn(&dev->dev, "Failed to set MAC filter table.\n"); |
| 1088 | 1128 | ||
| 1089 | kfree(buf); | 1129 | kfree(buf); |
| 1090 | } | 1130 | } |
| @@ -1327,6 +1367,11 @@ static void virtnet_config_changed(struct virtio_device *vdev) | |||
| 1327 | 1367 | ||
| 1328 | static void virtnet_free_queues(struct virtnet_info *vi) | 1368 | static void virtnet_free_queues(struct virtnet_info *vi) |
| 1329 | { | 1369 | { |
| 1370 | int i; | ||
| 1371 | |||
| 1372 | for (i = 0; i < vi->max_queue_pairs; i++) | ||
| 1373 | netif_napi_del(&vi->rq[i].napi); | ||
| 1374 | |||
| 1330 | kfree(vi->rq); | 1375 | kfree(vi->rq); |
| 1331 | kfree(vi->sq); | 1376 | kfree(vi->sq); |
| 1332 | } | 1377 | } |
| @@ -1356,10 +1401,10 @@ static void free_unused_bufs(struct virtnet_info *vi) | |||
| 1356 | struct virtqueue *vq = vi->rq[i].vq; | 1401 | struct virtqueue *vq = vi->rq[i].vq; |
| 1357 | 1402 | ||
| 1358 | while ((buf = virtqueue_detach_unused_buf(vq)) != NULL) { | 1403 | while ((buf = virtqueue_detach_unused_buf(vq)) != NULL) { |
| 1359 | if (vi->big_packets) | 1404 | if (vi->mergeable_rx_bufs) |
| 1360 | give_pages(&vi->rq[i], buf); | ||
| 1361 | else if (vi->mergeable_rx_bufs) | ||
| 1362 | put_page(virt_to_head_page(buf)); | 1405 | put_page(virt_to_head_page(buf)); |
| 1406 | else if (vi->big_packets) | ||
| 1407 | give_pages(&vi->rq[i], buf); | ||
| 1363 | else | 1408 | else |
| 1364 | dev_kfree_skb(buf); | 1409 | dev_kfree_skb(buf); |
| 1365 | --vi->rq[i].num; | 1410 | --vi->rq[i].num; |
diff --git a/drivers/net/vxlan.c b/drivers/net/vxlan.c index 0358c07f7669..249e01c5600c 100644 --- a/drivers/net/vxlan.c +++ b/drivers/net/vxlan.c | |||
| @@ -1668,7 +1668,7 @@ static void vxlan_xmit_one(struct sk_buff *skb, struct net_device *dev, | |||
| 1668 | netdev_dbg(dev, "circular route to %pI4\n", | 1668 | netdev_dbg(dev, "circular route to %pI4\n", |
| 1669 | &dst->sin.sin_addr.s_addr); | 1669 | &dst->sin.sin_addr.s_addr); |
| 1670 | dev->stats.collisions++; | 1670 | dev->stats.collisions++; |
| 1671 | goto tx_error; | 1671 | goto rt_tx_error; |
| 1672 | } | 1672 | } |
| 1673 | 1673 | ||
| 1674 | /* Bypass encapsulation if the destination is local */ | 1674 | /* Bypass encapsulation if the destination is local */ |
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_eeprom.c b/drivers/net/wireless/ath/ath9k/ar9003_eeprom.c index 1ec52356b5a1..130657db5c43 100644 --- a/drivers/net/wireless/ath/ath9k/ar9003_eeprom.c +++ b/drivers/net/wireless/ath/ath9k/ar9003_eeprom.c | |||
| @@ -3984,18 +3984,20 @@ static void ar9003_hw_quick_drop_apply(struct ath_hw *ah, u16 freq) | |||
| 3984 | int quick_drop; | 3984 | int quick_drop; |
| 3985 | s32 t[3], f[3] = {5180, 5500, 5785}; | 3985 | s32 t[3], f[3] = {5180, 5500, 5785}; |
| 3986 | 3986 | ||
| 3987 | if (!(pBase->miscConfiguration & BIT(1))) | 3987 | if (!(pBase->miscConfiguration & BIT(4))) |
| 3988 | return; | 3988 | return; |
| 3989 | 3989 | ||
| 3990 | if (freq < 4000) | 3990 | if (AR_SREV_9300(ah) || AR_SREV_9580(ah) || AR_SREV_9340(ah)) { |
| 3991 | quick_drop = eep->modalHeader2G.quick_drop; | 3991 | if (freq < 4000) { |
| 3992 | else { | 3992 | quick_drop = eep->modalHeader2G.quick_drop; |
| 3993 | t[0] = eep->base_ext1.quick_drop_low; | 3993 | } else { |
| 3994 | t[1] = eep->modalHeader5G.quick_drop; | 3994 | t[0] = eep->base_ext1.quick_drop_low; |
| 3995 | t[2] = eep->base_ext1.quick_drop_high; | 3995 | t[1] = eep->modalHeader5G.quick_drop; |
| 3996 | quick_drop = ar9003_hw_power_interpolate(freq, f, t, 3); | 3996 | t[2] = eep->base_ext1.quick_drop_high; |
| 3997 | quick_drop = ar9003_hw_power_interpolate(freq, f, t, 3); | ||
| 3998 | } | ||
| 3999 | REG_RMW_FIELD(ah, AR_PHY_AGC, AR_PHY_AGC_QUICK_DROP, quick_drop); | ||
| 3997 | } | 4000 | } |
| 3998 | REG_RMW_FIELD(ah, AR_PHY_AGC, AR_PHY_AGC_QUICK_DROP, quick_drop); | ||
| 3999 | } | 4001 | } |
| 4000 | 4002 | ||
| 4001 | static void ar9003_hw_txend_to_xpa_off_apply(struct ath_hw *ah, bool is2ghz) | 4003 | static void ar9003_hw_txend_to_xpa_off_apply(struct ath_hw *ah, bool is2ghz) |
| @@ -4035,7 +4037,7 @@ static void ar9003_hw_xlna_bias_strength_apply(struct ath_hw *ah, bool is2ghz) | |||
| 4035 | struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep; | 4037 | struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep; |
| 4036 | u8 bias; | 4038 | u8 bias; |
| 4037 | 4039 | ||
| 4038 | if (!(eep->baseEepHeader.featureEnable & 0x40)) | 4040 | if (!(eep->baseEepHeader.miscConfiguration & 0x40)) |
| 4039 | return; | 4041 | return; |
| 4040 | 4042 | ||
| 4041 | if (!AR_SREV_9300(ah)) | 4043 | if (!AR_SREV_9300(ah)) |
diff --git a/drivers/net/wireless/ath/ath9k/hw.c b/drivers/net/wireless/ath/ath9k/hw.c index 54b04155e43b..8918035da3a3 100644 --- a/drivers/net/wireless/ath/ath9k/hw.c +++ b/drivers/net/wireless/ath/ath9k/hw.c | |||
| @@ -146,10 +146,9 @@ static void ath9k_hw_set_clockrate(struct ath_hw *ah) | |||
| 146 | else | 146 | else |
| 147 | clockrate = ATH9K_CLOCK_RATE_5GHZ_OFDM; | 147 | clockrate = ATH9K_CLOCK_RATE_5GHZ_OFDM; |
| 148 | 148 | ||
| 149 | if (IS_CHAN_HT40(chan)) | 149 | if (chan) { |
| 150 | clockrate *= 2; | 150 | if (IS_CHAN_HT40(chan)) |
| 151 | 151 | clockrate *= 2; | |
| 152 | if (ah->curchan) { | ||
| 153 | if (IS_CHAN_HALF_RATE(chan)) | 152 | if (IS_CHAN_HALF_RATE(chan)) |
| 154 | clockrate /= 2; | 153 | clockrate /= 2; |
| 155 | if (IS_CHAN_QUARTER_RATE(chan)) | 154 | if (IS_CHAN_QUARTER_RATE(chan)) |
diff --git a/drivers/net/wireless/ath/ath9k/xmit.c b/drivers/net/wireless/ath/ath9k/xmit.c index 09cdbcd09739..b5a19e098f2d 100644 --- a/drivers/net/wireless/ath/ath9k/xmit.c +++ b/drivers/net/wireless/ath/ath9k/xmit.c | |||
| @@ -1276,6 +1276,10 @@ static void ath_tx_fill_desc(struct ath_softc *sc, struct ath_buf *bf, | |||
| 1276 | if (!rts_thresh || (len > rts_thresh)) | 1276 | if (!rts_thresh || (len > rts_thresh)) |
| 1277 | rts = true; | 1277 | rts = true; |
| 1278 | } | 1278 | } |
| 1279 | |||
| 1280 | if (!aggr) | ||
| 1281 | len = fi->framelen; | ||
| 1282 | |||
| 1279 | ath_buf_set_rate(sc, bf, &info, len, rts); | 1283 | ath_buf_set_rate(sc, bf, &info, len, rts); |
| 1280 | } | 1284 | } |
| 1281 | 1285 | ||
diff --git a/drivers/net/wireless/ath/wcn36xx/smd.c b/drivers/net/wireless/ath/wcn36xx/smd.c index de9eb2cfbf4b..366339421d4f 100644 --- a/drivers/net/wireless/ath/wcn36xx/smd.c +++ b/drivers/net/wireless/ath/wcn36xx/smd.c | |||
| @@ -2041,13 +2041,20 @@ static void wcn36xx_smd_rsp_process(struct wcn36xx *wcn, void *buf, size_t len) | |||
| 2041 | case WCN36XX_HAL_DELETE_STA_CONTEXT_IND: | 2041 | case WCN36XX_HAL_DELETE_STA_CONTEXT_IND: |
| 2042 | mutex_lock(&wcn->hal_ind_mutex); | 2042 | mutex_lock(&wcn->hal_ind_mutex); |
| 2043 | msg_ind = kmalloc(sizeof(*msg_ind), GFP_KERNEL); | 2043 | msg_ind = kmalloc(sizeof(*msg_ind), GFP_KERNEL); |
| 2044 | msg_ind->msg_len = len; | 2044 | if (msg_ind) { |
| 2045 | msg_ind->msg = kmalloc(len, GFP_KERNEL); | 2045 | msg_ind->msg_len = len; |
| 2046 | memcpy(msg_ind->msg, buf, len); | 2046 | msg_ind->msg = kmalloc(len, GFP_KERNEL); |
| 2047 | list_add_tail(&msg_ind->list, &wcn->hal_ind_queue); | 2047 | memcpy(msg_ind->msg, buf, len); |
| 2048 | queue_work(wcn->hal_ind_wq, &wcn->hal_ind_work); | 2048 | list_add_tail(&msg_ind->list, &wcn->hal_ind_queue); |
| 2049 | wcn36xx_dbg(WCN36XX_DBG_HAL, "indication arrived\n"); | 2049 | queue_work(wcn->hal_ind_wq, &wcn->hal_ind_work); |
| 2050 | wcn36xx_dbg(WCN36XX_DBG_HAL, "indication arrived\n"); | ||
| 2051 | } | ||
| 2050 | mutex_unlock(&wcn->hal_ind_mutex); | 2052 | mutex_unlock(&wcn->hal_ind_mutex); |
| 2053 | if (msg_ind) | ||
| 2054 | break; | ||
| 2055 | /* FIXME: Do something smarter then just printing an error. */ | ||
| 2056 | wcn36xx_err("Run out of memory while handling SMD_EVENT (%d)\n", | ||
| 2057 | msg_header->msg_type); | ||
| 2051 | break; | 2058 | break; |
| 2052 | default: | 2059 | default: |
| 2053 | wcn36xx_err("SMD_EVENT (%d) not supported\n", | 2060 | wcn36xx_err("SMD_EVENT (%d) not supported\n", |
diff --git a/drivers/net/wireless/brcm80211/Kconfig b/drivers/net/wireless/brcm80211/Kconfig index b00a7e92225f..54e36fcb3954 100644 --- a/drivers/net/wireless/brcm80211/Kconfig +++ b/drivers/net/wireless/brcm80211/Kconfig | |||
| @@ -5,6 +5,8 @@ config BRCMSMAC | |||
| 5 | tristate "Broadcom IEEE802.11n PCIe SoftMAC WLAN driver" | 5 | tristate "Broadcom IEEE802.11n PCIe SoftMAC WLAN driver" |
| 6 | depends on MAC80211 | 6 | depends on MAC80211 |
| 7 | depends on BCMA | 7 | depends on BCMA |
| 8 | select NEW_LEDS if BCMA_DRIVER_GPIO | ||
| 9 | select LEDS_CLASS if BCMA_DRIVER_GPIO | ||
| 8 | select BRCMUTIL | 10 | select BRCMUTIL |
| 9 | select FW_LOADER | 11 | select FW_LOADER |
| 10 | select CRC_CCITT | 12 | select CRC_CCITT |
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/bcmsdh_sdmmc.c b/drivers/net/wireless/brcm80211/brcmfmac/bcmsdh_sdmmc.c index 905704e335d7..abc9ceca70f3 100644 --- a/drivers/net/wireless/brcm80211/brcmfmac/bcmsdh_sdmmc.c +++ b/drivers/net/wireless/brcm80211/brcmfmac/bcmsdh_sdmmc.c | |||
| @@ -109,6 +109,8 @@ static inline int brcmf_sdioh_f0_write_byte(struct brcmf_sdio_dev *sdiodev, | |||
| 109 | brcmf_err("Disable F2 failed:%d\n", | 109 | brcmf_err("Disable F2 failed:%d\n", |
| 110 | err_ret); | 110 | err_ret); |
| 111 | } | 111 | } |
| 112 | } else { | ||
| 113 | err_ret = -ENOENT; | ||
| 112 | } | 114 | } |
| 113 | } else if ((regaddr == SDIO_CCCR_ABORT) || | 115 | } else if ((regaddr == SDIO_CCCR_ABORT) || |
| 114 | (regaddr == SDIO_CCCR_IENx)) { | 116 | (regaddr == SDIO_CCCR_IENx)) { |
diff --git a/drivers/net/wireless/iwlwifi/iwl-7000.c b/drivers/net/wireless/iwlwifi/iwl-7000.c index 85879dbaa402..3c34a72a5d64 100644 --- a/drivers/net/wireless/iwlwifi/iwl-7000.c +++ b/drivers/net/wireless/iwlwifi/iwl-7000.c | |||
| @@ -67,8 +67,8 @@ | |||
| 67 | #include "iwl-agn-hw.h" | 67 | #include "iwl-agn-hw.h" |
| 68 | 68 | ||
| 69 | /* Highest firmware API version supported */ | 69 | /* Highest firmware API version supported */ |
| 70 | #define IWL7260_UCODE_API_MAX 7 | 70 | #define IWL7260_UCODE_API_MAX 8 |
| 71 | #define IWL3160_UCODE_API_MAX 7 | 71 | #define IWL3160_UCODE_API_MAX 8 |
| 72 | 72 | ||
| 73 | /* Oldest version we won't warn about */ | 73 | /* Oldest version we won't warn about */ |
| 74 | #define IWL7260_UCODE_API_OK 7 | 74 | #define IWL7260_UCODE_API_OK 7 |
| @@ -130,6 +130,7 @@ const struct iwl_cfg iwl7260_2ac_cfg = { | |||
| 130 | .ht_params = &iwl7000_ht_params, | 130 | .ht_params = &iwl7000_ht_params, |
| 131 | .nvm_ver = IWL7260_NVM_VERSION, | 131 | .nvm_ver = IWL7260_NVM_VERSION, |
| 132 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, | 132 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, |
| 133 | .host_interrupt_operation_mode = true, | ||
| 133 | }; | 134 | }; |
| 134 | 135 | ||
| 135 | const struct iwl_cfg iwl7260_2ac_cfg_high_temp = { | 136 | const struct iwl_cfg iwl7260_2ac_cfg_high_temp = { |
| @@ -140,6 +141,7 @@ const struct iwl_cfg iwl7260_2ac_cfg_high_temp = { | |||
| 140 | .nvm_ver = IWL7260_NVM_VERSION, | 141 | .nvm_ver = IWL7260_NVM_VERSION, |
| 141 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, | 142 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, |
| 142 | .high_temp = true, | 143 | .high_temp = true, |
| 144 | .host_interrupt_operation_mode = true, | ||
| 143 | }; | 145 | }; |
| 144 | 146 | ||
| 145 | const struct iwl_cfg iwl7260_2n_cfg = { | 147 | const struct iwl_cfg iwl7260_2n_cfg = { |
| @@ -149,6 +151,7 @@ const struct iwl_cfg iwl7260_2n_cfg = { | |||
| 149 | .ht_params = &iwl7000_ht_params, | 151 | .ht_params = &iwl7000_ht_params, |
| 150 | .nvm_ver = IWL7260_NVM_VERSION, | 152 | .nvm_ver = IWL7260_NVM_VERSION, |
| 151 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, | 153 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, |
| 154 | .host_interrupt_operation_mode = true, | ||
| 152 | }; | 155 | }; |
| 153 | 156 | ||
| 154 | const struct iwl_cfg iwl7260_n_cfg = { | 157 | const struct iwl_cfg iwl7260_n_cfg = { |
| @@ -158,6 +161,7 @@ const struct iwl_cfg iwl7260_n_cfg = { | |||
| 158 | .ht_params = &iwl7000_ht_params, | 161 | .ht_params = &iwl7000_ht_params, |
| 159 | .nvm_ver = IWL7260_NVM_VERSION, | 162 | .nvm_ver = IWL7260_NVM_VERSION, |
| 160 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, | 163 | .nvm_calib_ver = IWL7260_TX_POWER_VERSION, |
| 164 | .host_interrupt_operation_mode = true, | ||
| 161 | }; | 165 | }; |
| 162 | 166 | ||
| 163 | const struct iwl_cfg iwl3160_2ac_cfg = { | 167 | const struct iwl_cfg iwl3160_2ac_cfg = { |
| @@ -167,6 +171,7 @@ const struct iwl_cfg iwl3160_2ac_cfg = { | |||
| 167 | .ht_params = &iwl7000_ht_params, | 171 | .ht_params = &iwl7000_ht_params, |
| 168 | .nvm_ver = IWL3160_NVM_VERSION, | 172 | .nvm_ver = IWL3160_NVM_VERSION, |
| 169 | .nvm_calib_ver = IWL3160_TX_POWER_VERSION, | 173 | .nvm_calib_ver = IWL3160_TX_POWER_VERSION, |
| 174 | .host_interrupt_operation_mode = true, | ||
| 170 | }; | 175 | }; |
| 171 | 176 | ||
| 172 | const struct iwl_cfg iwl3160_2n_cfg = { | 177 | const struct iwl_cfg iwl3160_2n_cfg = { |
| @@ -176,6 +181,7 @@ const struct iwl_cfg iwl3160_2n_cfg = { | |||
| 176 | .ht_params = &iwl7000_ht_params, | 181 | .ht_params = &iwl7000_ht_params, |
| 177 | .nvm_ver = IWL3160_NVM_VERSION, | 182 | .nvm_ver = IWL3160_NVM_VERSION, |
| 178 | .nvm_calib_ver = IWL3160_TX_POWER_VERSION, | 183 | .nvm_calib_ver = IWL3160_TX_POWER_VERSION, |
| 184 | .host_interrupt_operation_mode = true, | ||
| 179 | }; | 185 | }; |
| 180 | 186 | ||
| 181 | const struct iwl_cfg iwl3160_n_cfg = { | 187 | const struct iwl_cfg iwl3160_n_cfg = { |
| @@ -185,6 +191,7 @@ const struct iwl_cfg iwl3160_n_cfg = { | |||
| 185 | .ht_params = &iwl7000_ht_params, | 191 | .ht_params = &iwl7000_ht_params, |
| 186 | .nvm_ver = IWL3160_NVM_VERSION, | 192 | .nvm_ver = IWL3160_NVM_VERSION, |
| 187 | .nvm_calib_ver = IWL3160_TX_POWER_VERSION, | 193 | .nvm_calib_ver = IWL3160_TX_POWER_VERSION, |
| 194 | .host_interrupt_operation_mode = true, | ||
| 188 | }; | 195 | }; |
| 189 | 196 | ||
| 190 | const struct iwl_cfg iwl7265_2ac_cfg = { | 197 | const struct iwl_cfg iwl7265_2ac_cfg = { |
| @@ -196,5 +203,23 @@ const struct iwl_cfg iwl7265_2ac_cfg = { | |||
| 196 | .nvm_calib_ver = IWL7265_TX_POWER_VERSION, | 203 | .nvm_calib_ver = IWL7265_TX_POWER_VERSION, |
| 197 | }; | 204 | }; |
| 198 | 205 | ||
| 206 | const struct iwl_cfg iwl7265_2n_cfg = { | ||
| 207 | .name = "Intel(R) Dual Band Wireless N 7265", | ||
| 208 | .fw_name_pre = IWL7265_FW_PRE, | ||
| 209 | IWL_DEVICE_7000, | ||
| 210 | .ht_params = &iwl7000_ht_params, | ||
| 211 | .nvm_ver = IWL7265_NVM_VERSION, | ||
| 212 | .nvm_calib_ver = IWL7265_TX_POWER_VERSION, | ||
| 213 | }; | ||
| 214 | |||
| 215 | const struct iwl_cfg iwl7265_n_cfg = { | ||
| 216 | .name = "Intel(R) Wireless N 7265", | ||
| 217 | .fw_name_pre = IWL7265_FW_PRE, | ||
| 218 | IWL_DEVICE_7000, | ||
| 219 | .ht_params = &iwl7000_ht_params, | ||
| 220 | .nvm_ver = IWL7265_NVM_VERSION, | ||
| 221 | .nvm_calib_ver = IWL7265_TX_POWER_VERSION, | ||
| 222 | }; | ||
| 223 | |||
| 199 | MODULE_FIRMWARE(IWL7260_MODULE_FIRMWARE(IWL7260_UCODE_API_OK)); | 224 | MODULE_FIRMWARE(IWL7260_MODULE_FIRMWARE(IWL7260_UCODE_API_OK)); |
| 200 | MODULE_FIRMWARE(IWL3160_MODULE_FIRMWARE(IWL3160_UCODE_API_OK)); | 225 | MODULE_FIRMWARE(IWL3160_MODULE_FIRMWARE(IWL3160_UCODE_API_OK)); |
diff --git a/drivers/net/wireless/iwlwifi/iwl-config.h b/drivers/net/wireless/iwlwifi/iwl-config.h index 18f232e8e812..03fd9aa8bfda 100644 --- a/drivers/net/wireless/iwlwifi/iwl-config.h +++ b/drivers/net/wireless/iwlwifi/iwl-config.h | |||
| @@ -207,6 +207,8 @@ struct iwl_eeprom_params { | |||
| 207 | * @rx_with_siso_diversity: 1x1 device with rx antenna diversity | 207 | * @rx_with_siso_diversity: 1x1 device with rx antenna diversity |
| 208 | * @internal_wimax_coex: internal wifi/wimax combo device | 208 | * @internal_wimax_coex: internal wifi/wimax combo device |
| 209 | * @high_temp: Is this NIC is designated to be in high temperature. | 209 | * @high_temp: Is this NIC is designated to be in high temperature. |
| 210 | * @host_interrupt_operation_mode: device needs host interrupt operation | ||
| 211 | * mode set | ||
| 210 | * | 212 | * |
| 211 | * We enable the driver to be backward compatible wrt. hardware features. | 213 | * We enable the driver to be backward compatible wrt. hardware features. |
| 212 | * API differences in uCode shouldn't be handled here but through TLVs | 214 | * API differences in uCode shouldn't be handled here but through TLVs |
| @@ -235,6 +237,7 @@ struct iwl_cfg { | |||
| 235 | enum iwl_led_mode led_mode; | 237 | enum iwl_led_mode led_mode; |
| 236 | const bool rx_with_siso_diversity; | 238 | const bool rx_with_siso_diversity; |
| 237 | const bool internal_wimax_coex; | 239 | const bool internal_wimax_coex; |
| 240 | const bool host_interrupt_operation_mode; | ||
| 238 | bool high_temp; | 241 | bool high_temp; |
| 239 | }; | 242 | }; |
| 240 | 243 | ||
| @@ -294,6 +297,8 @@ extern const struct iwl_cfg iwl3160_2ac_cfg; | |||
| 294 | extern const struct iwl_cfg iwl3160_2n_cfg; | 297 | extern const struct iwl_cfg iwl3160_2n_cfg; |
| 295 | extern const struct iwl_cfg iwl3160_n_cfg; | 298 | extern const struct iwl_cfg iwl3160_n_cfg; |
| 296 | extern const struct iwl_cfg iwl7265_2ac_cfg; | 299 | extern const struct iwl_cfg iwl7265_2ac_cfg; |
| 300 | extern const struct iwl_cfg iwl7265_2n_cfg; | ||
| 301 | extern const struct iwl_cfg iwl7265_n_cfg; | ||
| 297 | #endif /* CONFIG_IWLMVM */ | 302 | #endif /* CONFIG_IWLMVM */ |
| 298 | 303 | ||
| 299 | #endif /* __IWL_CONFIG_H__ */ | 304 | #endif /* __IWL_CONFIG_H__ */ |
diff --git a/drivers/net/wireless/iwlwifi/iwl-csr.h b/drivers/net/wireless/iwlwifi/iwl-csr.h index 54a4fdc631b7..da4eca8b3007 100644 --- a/drivers/net/wireless/iwlwifi/iwl-csr.h +++ b/drivers/net/wireless/iwlwifi/iwl-csr.h | |||
| @@ -495,14 +495,11 @@ enum secure_load_status_reg { | |||
| 495 | * the CSR_INT_COALESCING is an 8 bit register in 32-usec unit | 495 | * the CSR_INT_COALESCING is an 8 bit register in 32-usec unit |
| 496 | * | 496 | * |
| 497 | * default interrupt coalescing timer is 64 x 32 = 2048 usecs | 497 | * default interrupt coalescing timer is 64 x 32 = 2048 usecs |
| 498 | * default interrupt coalescing calibration timer is 16 x 32 = 512 usecs | ||
| 499 | */ | 498 | */ |
| 500 | #define IWL_HOST_INT_TIMEOUT_MAX (0xFF) | 499 | #define IWL_HOST_INT_TIMEOUT_MAX (0xFF) |
| 501 | #define IWL_HOST_INT_TIMEOUT_DEF (0x40) | 500 | #define IWL_HOST_INT_TIMEOUT_DEF (0x40) |
| 502 | #define IWL_HOST_INT_TIMEOUT_MIN (0x0) | 501 | #define IWL_HOST_INT_TIMEOUT_MIN (0x0) |
| 503 | #define IWL_HOST_INT_CALIB_TIMEOUT_MAX (0xFF) | 502 | #define IWL_HOST_INT_OPER_MODE BIT(31) |
| 504 | #define IWL_HOST_INT_CALIB_TIMEOUT_DEF (0x10) | ||
| 505 | #define IWL_HOST_INT_CALIB_TIMEOUT_MIN (0x0) | ||
| 506 | 503 | ||
| 507 | /***************************************************************************** | 504 | /***************************************************************************** |
| 508 | * 7000/3000 series SHR DTS addresses * | 505 | * 7000/3000 series SHR DTS addresses * |
diff --git a/drivers/net/wireless/iwlwifi/mvm/bt-coex.c b/drivers/net/wireless/iwlwifi/mvm/bt-coex.c index 5d066cbc5ac7..75b72a956552 100644 --- a/drivers/net/wireless/iwlwifi/mvm/bt-coex.c +++ b/drivers/net/wireless/iwlwifi/mvm/bt-coex.c | |||
| @@ -391,7 +391,6 @@ int iwl_send_bt_init_conf(struct iwl_mvm *mvm) | |||
| 391 | BT_VALID_LUT | | 391 | BT_VALID_LUT | |
| 392 | BT_VALID_WIFI_RX_SW_PRIO_BOOST | | 392 | BT_VALID_WIFI_RX_SW_PRIO_BOOST | |
| 393 | BT_VALID_WIFI_TX_SW_PRIO_BOOST | | 393 | BT_VALID_WIFI_TX_SW_PRIO_BOOST | |
| 394 | BT_VALID_MULTI_PRIO_LUT | | ||
| 395 | BT_VALID_CORUN_LUT_20 | | 394 | BT_VALID_CORUN_LUT_20 | |
| 396 | BT_VALID_CORUN_LUT_40 | | 395 | BT_VALID_CORUN_LUT_40 | |
| 397 | BT_VALID_ANT_ISOLATION | | 396 | BT_VALID_ANT_ISOLATION | |
| @@ -842,6 +841,11 @@ static void iwl_mvm_bt_rssi_iterator(void *_data, u8 *mac, | |||
| 842 | 841 | ||
| 843 | sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[mvmvif->ap_sta_id], | 842 | sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[mvmvif->ap_sta_id], |
| 844 | lockdep_is_held(&mvm->mutex)); | 843 | lockdep_is_held(&mvm->mutex)); |
| 844 | |||
| 845 | /* This can happen if the station has been removed right now */ | ||
| 846 | if (IS_ERR_OR_NULL(sta)) | ||
| 847 | return; | ||
| 848 | |||
| 845 | mvmsta = (void *)sta->drv_priv; | 849 | mvmsta = (void *)sta->drv_priv; |
| 846 | 850 | ||
| 847 | data->num_bss_ifaces++; | 851 | data->num_bss_ifaces++; |
diff --git a/drivers/net/wireless/iwlwifi/mvm/d3.c b/drivers/net/wireless/iwlwifi/mvm/d3.c index 6f45966817bb..b9b81e881dd0 100644 --- a/drivers/net/wireless/iwlwifi/mvm/d3.c +++ b/drivers/net/wireless/iwlwifi/mvm/d3.c | |||
| @@ -895,7 +895,7 @@ static int iwl_mvm_get_last_nonqos_seq(struct iwl_mvm *mvm, | |||
| 895 | /* new API returns next, not last-used seqno */ | 895 | /* new API returns next, not last-used seqno */ |
| 896 | if (mvm->fw->ucode_capa.flags & | 896 | if (mvm->fw->ucode_capa.flags & |
| 897 | IWL_UCODE_TLV_FLAGS_D3_CONTINUITY_API) | 897 | IWL_UCODE_TLV_FLAGS_D3_CONTINUITY_API) |
| 898 | err -= 0x10; | 898 | err = (u16) (err - 0x10); |
| 899 | } | 899 | } |
| 900 | 900 | ||
| 901 | iwl_free_resp(&cmd); | 901 | iwl_free_resp(&cmd); |
| @@ -1549,7 +1549,7 @@ static bool iwl_mvm_setup_connection_keep(struct iwl_mvm *mvm, | |||
| 1549 | if (gtkdata.unhandled_cipher) | 1549 | if (gtkdata.unhandled_cipher) |
| 1550 | return false; | 1550 | return false; |
| 1551 | if (!gtkdata.num_keys) | 1551 | if (!gtkdata.num_keys) |
| 1552 | return true; | 1552 | goto out; |
| 1553 | if (!gtkdata.last_gtk) | 1553 | if (!gtkdata.last_gtk) |
| 1554 | return false; | 1554 | return false; |
| 1555 | 1555 | ||
| @@ -1600,6 +1600,7 @@ static bool iwl_mvm_setup_connection_keep(struct iwl_mvm *mvm, | |||
| 1600 | (void *)&replay_ctr, GFP_KERNEL); | 1600 | (void *)&replay_ctr, GFP_KERNEL); |
| 1601 | } | 1601 | } |
| 1602 | 1602 | ||
| 1603 | out: | ||
| 1603 | mvmvif->seqno_valid = true; | 1604 | mvmvif->seqno_valid = true; |
| 1604 | /* +0x10 because the set API expects next-to-use, not last-used */ | 1605 | /* +0x10 because the set API expects next-to-use, not last-used */ |
| 1605 | mvmvif->seqno = le16_to_cpu(status->non_qos_seq_ctr) + 0x10; | 1606 | mvmvif->seqno = le16_to_cpu(status->non_qos_seq_ctr) + 0x10; |
diff --git a/drivers/net/wireless/iwlwifi/mvm/debugfs.c b/drivers/net/wireless/iwlwifi/mvm/debugfs.c index 9864d713eb2c..a8fe6b41f9a3 100644 --- a/drivers/net/wireless/iwlwifi/mvm/debugfs.c +++ b/drivers/net/wireless/iwlwifi/mvm/debugfs.c | |||
| @@ -119,6 +119,10 @@ static ssize_t iwl_dbgfs_sta_drain_write(struct file *file, | |||
| 119 | 119 | ||
| 120 | if (sscanf(buf, "%d %d", &sta_id, &drain) != 2) | 120 | if (sscanf(buf, "%d %d", &sta_id, &drain) != 2) |
| 121 | return -EINVAL; | 121 | return -EINVAL; |
| 122 | if (sta_id < 0 || sta_id >= IWL_MVM_STATION_COUNT) | ||
| 123 | return -EINVAL; | ||
| 124 | if (drain < 0 || drain > 1) | ||
| 125 | return -EINVAL; | ||
| 122 | 126 | ||
| 123 | mutex_lock(&mvm->mutex); | 127 | mutex_lock(&mvm->mutex); |
| 124 | 128 | ||
diff --git a/drivers/net/wireless/iwlwifi/mvm/time-event.c b/drivers/net/wireless/iwlwifi/mvm/time-event.c index 33cf56fdfc41..95ce4b601fef 100644 --- a/drivers/net/wireless/iwlwifi/mvm/time-event.c +++ b/drivers/net/wireless/iwlwifi/mvm/time-event.c | |||
| @@ -176,8 +176,11 @@ static void iwl_mvm_te_handle_notif(struct iwl_mvm *mvm, | |||
| 176 | * P2P Device discoveribility, while there are other higher priority | 176 | * P2P Device discoveribility, while there are other higher priority |
| 177 | * events in the system). | 177 | * events in the system). |
| 178 | */ | 178 | */ |
| 179 | if (WARN_ONCE(!le32_to_cpu(notif->status), | 179 | if (!le32_to_cpu(notif->status)) { |
| 180 | "Failed to schedule time event\n")) { | 180 | bool start = le32_to_cpu(notif->action) & |
| 181 | TE_V2_NOTIF_HOST_EVENT_START; | ||
| 182 | IWL_WARN(mvm, "Time Event %s notification failure\n", | ||
| 183 | start ? "start" : "end"); | ||
| 181 | if (iwl_mvm_te_check_disconnect(mvm, te_data->vif, NULL)) { | 184 | if (iwl_mvm_te_check_disconnect(mvm, te_data->vif, NULL)) { |
| 182 | iwl_mvm_te_clear_data(mvm, te_data); | 185 | iwl_mvm_te_clear_data(mvm, te_data); |
| 183 | return; | 186 | return; |
diff --git a/drivers/net/wireless/iwlwifi/pcie/drv.c b/drivers/net/wireless/iwlwifi/pcie/drv.c index 941c0c88f982..86605027c41d 100644 --- a/drivers/net/wireless/iwlwifi/pcie/drv.c +++ b/drivers/net/wireless/iwlwifi/pcie/drv.c | |||
| @@ -353,6 +353,27 @@ static DEFINE_PCI_DEVICE_TABLE(iwl_hw_card_ids) = { | |||
| 353 | 353 | ||
| 354 | /* 7265 Series */ | 354 | /* 7265 Series */ |
| 355 | {IWL_PCI_DEVICE(0x095A, 0x5010, iwl7265_2ac_cfg)}, | 355 | {IWL_PCI_DEVICE(0x095A, 0x5010, iwl7265_2ac_cfg)}, |
| 356 | {IWL_PCI_DEVICE(0x095A, 0x5110, iwl7265_2ac_cfg)}, | ||
| 357 | {IWL_PCI_DEVICE(0x095B, 0x5310, iwl7265_2ac_cfg)}, | ||
| 358 | {IWL_PCI_DEVICE(0x095B, 0x5302, iwl7265_2ac_cfg)}, | ||
| 359 | {IWL_PCI_DEVICE(0x095B, 0x5210, iwl7265_2ac_cfg)}, | ||
| 360 | {IWL_PCI_DEVICE(0x095B, 0x5012, iwl7265_2ac_cfg)}, | ||
| 361 | {IWL_PCI_DEVICE(0x095B, 0x500A, iwl7265_2ac_cfg)}, | ||
| 362 | {IWL_PCI_DEVICE(0x095A, 0x5410, iwl7265_2ac_cfg)}, | ||
| 363 | {IWL_PCI_DEVICE(0x095A, 0x1010, iwl7265_2ac_cfg)}, | ||
| 364 | {IWL_PCI_DEVICE(0x095A, 0x5000, iwl7265_2n_cfg)}, | ||
| 365 | {IWL_PCI_DEVICE(0x095B, 0x5200, iwl7265_2n_cfg)}, | ||
| 366 | {IWL_PCI_DEVICE(0x095A, 0x5002, iwl7265_n_cfg)}, | ||
| 367 | {IWL_PCI_DEVICE(0x095B, 0x5202, iwl7265_n_cfg)}, | ||
| 368 | {IWL_PCI_DEVICE(0x095A, 0x9010, iwl7265_2ac_cfg)}, | ||
| 369 | {IWL_PCI_DEVICE(0x095A, 0x9210, iwl7265_2ac_cfg)}, | ||
| 370 | {IWL_PCI_DEVICE(0x095A, 0x9410, iwl7265_2ac_cfg)}, | ||
| 371 | {IWL_PCI_DEVICE(0x095A, 0x5020, iwl7265_2n_cfg)}, | ||
| 372 | {IWL_PCI_DEVICE(0x095A, 0x502A, iwl7265_2n_cfg)}, | ||
| 373 | {IWL_PCI_DEVICE(0x095A, 0x5420, iwl7265_2n_cfg)}, | ||
| 374 | {IWL_PCI_DEVICE(0x095A, 0x5090, iwl7265_2ac_cfg)}, | ||
| 375 | {IWL_PCI_DEVICE(0x095B, 0x5290, iwl7265_2ac_cfg)}, | ||
| 376 | {IWL_PCI_DEVICE(0x095A, 0x5490, iwl7265_2ac_cfg)}, | ||
| 356 | #endif /* CONFIG_IWLMVM */ | 377 | #endif /* CONFIG_IWLMVM */ |
| 357 | 378 | ||
| 358 | {0} | 379 | {0} |
diff --git a/drivers/net/wireless/iwlwifi/pcie/internal.h b/drivers/net/wireless/iwlwifi/pcie/internal.h index fa22639b63c9..051268c037b1 100644 --- a/drivers/net/wireless/iwlwifi/pcie/internal.h +++ b/drivers/net/wireless/iwlwifi/pcie/internal.h | |||
| @@ -477,4 +477,12 @@ static inline bool iwl_is_rfkill_set(struct iwl_trans *trans) | |||
| 477 | CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW); | 477 | CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW); |
| 478 | } | 478 | } |
| 479 | 479 | ||
| 480 | static inline void iwl_nic_error(struct iwl_trans *trans) | ||
| 481 | { | ||
| 482 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); | ||
| 483 | |||
| 484 | set_bit(STATUS_FW_ERROR, &trans_pcie->status); | ||
| 485 | iwl_op_mode_nic_error(trans->op_mode); | ||
| 486 | } | ||
| 487 | |||
| 480 | #endif /* __iwl_trans_int_pcie_h__ */ | 488 | #endif /* __iwl_trans_int_pcie_h__ */ |
diff --git a/drivers/net/wireless/iwlwifi/pcie/rx.c b/drivers/net/wireless/iwlwifi/pcie/rx.c index 3f237b42eb36..be3995afa9d0 100644 --- a/drivers/net/wireless/iwlwifi/pcie/rx.c +++ b/drivers/net/wireless/iwlwifi/pcie/rx.c | |||
| @@ -489,6 +489,10 @@ static void iwl_pcie_rx_hw_init(struct iwl_trans *trans, struct iwl_rxq *rxq) | |||
| 489 | 489 | ||
| 490 | /* Set interrupt coalescing timer to default (2048 usecs) */ | 490 | /* Set interrupt coalescing timer to default (2048 usecs) */ |
| 491 | iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_TIMEOUT_DEF); | 491 | iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_TIMEOUT_DEF); |
| 492 | |||
| 493 | /* W/A for interrupt coalescing bug in 7260 and 3160 */ | ||
| 494 | if (trans->cfg->host_interrupt_operation_mode) | ||
| 495 | iwl_set_bit(trans, CSR_INT_COALESCING, IWL_HOST_INT_OPER_MODE); | ||
| 492 | } | 496 | } |
| 493 | 497 | ||
| 494 | static void iwl_pcie_rx_init_rxb_lists(struct iwl_rxq *rxq) | 498 | static void iwl_pcie_rx_init_rxb_lists(struct iwl_rxq *rxq) |
| @@ -796,12 +800,13 @@ static void iwl_pcie_irq_handle_error(struct iwl_trans *trans) | |||
| 796 | iwl_pcie_dump_csr(trans); | 800 | iwl_pcie_dump_csr(trans); |
| 797 | iwl_dump_fh(trans, NULL); | 801 | iwl_dump_fh(trans, NULL); |
| 798 | 802 | ||
| 803 | /* set the ERROR bit before we wake up the caller */ | ||
| 799 | set_bit(STATUS_FW_ERROR, &trans_pcie->status); | 804 | set_bit(STATUS_FW_ERROR, &trans_pcie->status); |
| 800 | clear_bit(STATUS_HCMD_ACTIVE, &trans_pcie->status); | 805 | clear_bit(STATUS_HCMD_ACTIVE, &trans_pcie->status); |
| 801 | wake_up(&trans_pcie->wait_command_queue); | 806 | wake_up(&trans_pcie->wait_command_queue); |
| 802 | 807 | ||
| 803 | local_bh_disable(); | 808 | local_bh_disable(); |
| 804 | iwl_op_mode_nic_error(trans->op_mode); | 809 | iwl_nic_error(trans); |
| 805 | local_bh_enable(); | 810 | local_bh_enable(); |
| 806 | } | 811 | } |
| 807 | 812 | ||
diff --git a/drivers/net/wireless/iwlwifi/pcie/trans.c b/drivers/net/wireless/iwlwifi/pcie/trans.c index 5d9337bec67a..cde9c16f6e4f 100644 --- a/drivers/net/wireless/iwlwifi/pcie/trans.c +++ b/drivers/net/wireless/iwlwifi/pcie/trans.c | |||
| @@ -279,9 +279,6 @@ static int iwl_pcie_nic_init(struct iwl_trans *trans) | |||
| 279 | spin_lock_irqsave(&trans_pcie->irq_lock, flags); | 279 | spin_lock_irqsave(&trans_pcie->irq_lock, flags); |
| 280 | iwl_pcie_apm_init(trans); | 280 | iwl_pcie_apm_init(trans); |
| 281 | 281 | ||
| 282 | /* Set interrupt coalescing calibration timer to default (512 usecs) */ | ||
| 283 | iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_CALIB_TIMEOUT_DEF); | ||
| 284 | |||
| 285 | spin_unlock_irqrestore(&trans_pcie->irq_lock, flags); | 282 | spin_unlock_irqrestore(&trans_pcie->irq_lock, flags); |
| 286 | 283 | ||
| 287 | iwl_pcie_set_pwr(trans, false); | 284 | iwl_pcie_set_pwr(trans, false); |
diff --git a/drivers/net/wireless/iwlwifi/pcie/tx.c b/drivers/net/wireless/iwlwifi/pcie/tx.c index 059c5acad3a0..0adde919a258 100644 --- a/drivers/net/wireless/iwlwifi/pcie/tx.c +++ b/drivers/net/wireless/iwlwifi/pcie/tx.c | |||
| @@ -207,7 +207,7 @@ static void iwl_pcie_txq_stuck_timer(unsigned long data) | |||
| 207 | IWL_ERR(trans, "scratch %d = 0x%08x\n", i, | 207 | IWL_ERR(trans, "scratch %d = 0x%08x\n", i, |
| 208 | le32_to_cpu(txq->scratchbufs[i].scratch)); | 208 | le32_to_cpu(txq->scratchbufs[i].scratch)); |
| 209 | 209 | ||
| 210 | iwl_op_mode_nic_error(trans->op_mode); | 210 | iwl_nic_error(trans); |
| 211 | } | 211 | } |
| 212 | 212 | ||
| 213 | /* | 213 | /* |
| @@ -1023,7 +1023,7 @@ static void iwl_pcie_cmdq_reclaim(struct iwl_trans *trans, int txq_id, int idx) | |||
| 1023 | if (nfreed++ > 0) { | 1023 | if (nfreed++ > 0) { |
| 1024 | IWL_ERR(trans, "HCMD skipped: index (%d) %d %d\n", | 1024 | IWL_ERR(trans, "HCMD skipped: index (%d) %d %d\n", |
| 1025 | idx, q->write_ptr, q->read_ptr); | 1025 | idx, q->write_ptr, q->read_ptr); |
| 1026 | iwl_op_mode_nic_error(trans->op_mode); | 1026 | iwl_nic_error(trans); |
| 1027 | } | 1027 | } |
| 1028 | } | 1028 | } |
| 1029 | 1029 | ||
| @@ -1562,7 +1562,7 @@ static int iwl_pcie_send_hcmd_sync(struct iwl_trans *trans, | |||
| 1562 | get_cmd_string(trans_pcie, cmd->id)); | 1562 | get_cmd_string(trans_pcie, cmd->id)); |
| 1563 | ret = -ETIMEDOUT; | 1563 | ret = -ETIMEDOUT; |
| 1564 | 1564 | ||
| 1565 | iwl_op_mode_nic_error(trans->op_mode); | 1565 | iwl_nic_error(trans); |
| 1566 | 1566 | ||
| 1567 | goto cancel; | 1567 | goto cancel; |
| 1568 | } | 1568 | } |
diff --git a/drivers/net/wireless/mac80211_hwsim.c b/drivers/net/wireless/mac80211_hwsim.c index 9df7bc91a26f..c72438bb2faf 100644 --- a/drivers/net/wireless/mac80211_hwsim.c +++ b/drivers/net/wireless/mac80211_hwsim.c | |||
| @@ -383,6 +383,14 @@ struct hwsim_radiotap_hdr { | |||
| 383 | __le16 rt_chbitmask; | 383 | __le16 rt_chbitmask; |
| 384 | } __packed; | 384 | } __packed; |
| 385 | 385 | ||
| 386 | struct hwsim_radiotap_ack_hdr { | ||
| 387 | struct ieee80211_radiotap_header hdr; | ||
| 388 | u8 rt_flags; | ||
| 389 | u8 pad; | ||
| 390 | __le16 rt_channel; | ||
| 391 | __le16 rt_chbitmask; | ||
| 392 | } __packed; | ||
| 393 | |||
| 386 | /* MAC80211_HWSIM netlinf family */ | 394 | /* MAC80211_HWSIM netlinf family */ |
| 387 | static struct genl_family hwsim_genl_family = { | 395 | static struct genl_family hwsim_genl_family = { |
| 388 | .id = GENL_ID_GENERATE, | 396 | .id = GENL_ID_GENERATE, |
| @@ -500,7 +508,7 @@ static void mac80211_hwsim_monitor_ack(struct ieee80211_channel *chan, | |||
| 500 | const u8 *addr) | 508 | const u8 *addr) |
| 501 | { | 509 | { |
| 502 | struct sk_buff *skb; | 510 | struct sk_buff *skb; |
| 503 | struct hwsim_radiotap_hdr *hdr; | 511 | struct hwsim_radiotap_ack_hdr *hdr; |
| 504 | u16 flags; | 512 | u16 flags; |
| 505 | struct ieee80211_hdr *hdr11; | 513 | struct ieee80211_hdr *hdr11; |
| 506 | 514 | ||
| @@ -511,14 +519,14 @@ static void mac80211_hwsim_monitor_ack(struct ieee80211_channel *chan, | |||
| 511 | if (skb == NULL) | 519 | if (skb == NULL) |
| 512 | return; | 520 | return; |
| 513 | 521 | ||
| 514 | hdr = (struct hwsim_radiotap_hdr *) skb_put(skb, sizeof(*hdr)); | 522 | hdr = (struct hwsim_radiotap_ack_hdr *) skb_put(skb, sizeof(*hdr)); |
| 515 | hdr->hdr.it_version = PKTHDR_RADIOTAP_VERSION; | 523 | hdr->hdr.it_version = PKTHDR_RADIOTAP_VERSION; |
| 516 | hdr->hdr.it_pad = 0; | 524 | hdr->hdr.it_pad = 0; |
| 517 | hdr->hdr.it_len = cpu_to_le16(sizeof(*hdr)); | 525 | hdr->hdr.it_len = cpu_to_le16(sizeof(*hdr)); |
| 518 | hdr->hdr.it_present = cpu_to_le32((1 << IEEE80211_RADIOTAP_FLAGS) | | 526 | hdr->hdr.it_present = cpu_to_le32((1 << IEEE80211_RADIOTAP_FLAGS) | |
| 519 | (1 << IEEE80211_RADIOTAP_CHANNEL)); | 527 | (1 << IEEE80211_RADIOTAP_CHANNEL)); |
| 520 | hdr->rt_flags = 0; | 528 | hdr->rt_flags = 0; |
| 521 | hdr->rt_rate = 0; | 529 | hdr->pad = 0; |
| 522 | hdr->rt_channel = cpu_to_le16(chan->center_freq); | 530 | hdr->rt_channel = cpu_to_le16(chan->center_freq); |
| 523 | flags = IEEE80211_CHAN_2GHZ; | 531 | flags = IEEE80211_CHAN_2GHZ; |
| 524 | hdr->rt_chbitmask = cpu_to_le16(flags); | 532 | hdr->rt_chbitmask = cpu_to_le16(flags); |
| @@ -1230,7 +1238,7 @@ static void mac80211_hwsim_bss_info_changed(struct ieee80211_hw *hw, | |||
| 1230 | HRTIMER_MODE_REL); | 1238 | HRTIMER_MODE_REL); |
| 1231 | } else if (!info->enable_beacon) { | 1239 | } else if (!info->enable_beacon) { |
| 1232 | unsigned int count = 0; | 1240 | unsigned int count = 0; |
| 1233 | ieee80211_iterate_active_interfaces( | 1241 | ieee80211_iterate_active_interfaces_atomic( |
| 1234 | data->hw, IEEE80211_IFACE_ITER_NORMAL, | 1242 | data->hw, IEEE80211_IFACE_ITER_NORMAL, |
| 1235 | mac80211_hwsim_bcn_en_iter, &count); | 1243 | mac80211_hwsim_bcn_en_iter, &count); |
| 1236 | wiphy_debug(hw->wiphy, " beaconing vifs remaining: %u", | 1244 | wiphy_debug(hw->wiphy, " beaconing vifs remaining: %u", |
diff --git a/drivers/net/wireless/mwifiex/sta_ioctl.c b/drivers/net/wireless/mwifiex/sta_ioctl.c index c8e029df770e..a09398fe9e2a 100644 --- a/drivers/net/wireless/mwifiex/sta_ioctl.c +++ b/drivers/net/wireless/mwifiex/sta_ioctl.c | |||
| @@ -319,8 +319,8 @@ int mwifiex_bss_start(struct mwifiex_private *priv, struct cfg80211_bss *bss, | |||
| 319 | if (bss_desc && bss_desc->ssid.ssid_len && | 319 | if (bss_desc && bss_desc->ssid.ssid_len && |
| 320 | (!mwifiex_ssid_cmp(&priv->curr_bss_params.bss_descriptor. | 320 | (!mwifiex_ssid_cmp(&priv->curr_bss_params.bss_descriptor. |
| 321 | ssid, &bss_desc->ssid))) { | 321 | ssid, &bss_desc->ssid))) { |
| 322 | kfree(bss_desc); | 322 | ret = 0; |
| 323 | return 0; | 323 | goto done; |
| 324 | } | 324 | } |
| 325 | 325 | ||
| 326 | /* Exit Adhoc mode first */ | 326 | /* Exit Adhoc mode first */ |
diff --git a/drivers/net/xen-netback/interface.c b/drivers/net/xen-netback/interface.c index 2329cccf1fa6..870f1fa58370 100644 --- a/drivers/net/xen-netback/interface.c +++ b/drivers/net/xen-netback/interface.c | |||
| @@ -368,11 +368,11 @@ int xenvif_connect(struct xenvif *vif, unsigned long tx_ring_ref, | |||
| 368 | unsigned long rx_ring_ref, unsigned int tx_evtchn, | 368 | unsigned long rx_ring_ref, unsigned int tx_evtchn, |
| 369 | unsigned int rx_evtchn) | 369 | unsigned int rx_evtchn) |
| 370 | { | 370 | { |
| 371 | struct task_struct *task; | ||
| 371 | int err = -ENOMEM; | 372 | int err = -ENOMEM; |
| 372 | 373 | ||
| 373 | /* Already connected through? */ | 374 | BUG_ON(vif->tx_irq); |
| 374 | if (vif->tx_irq) | 375 | BUG_ON(vif->task); |
| 375 | return 0; | ||
| 376 | 376 | ||
| 377 | err = xenvif_map_frontend_rings(vif, tx_ring_ref, rx_ring_ref); | 377 | err = xenvif_map_frontend_rings(vif, tx_ring_ref, rx_ring_ref); |
| 378 | if (err < 0) | 378 | if (err < 0) |
| @@ -411,14 +411,16 @@ int xenvif_connect(struct xenvif *vif, unsigned long tx_ring_ref, | |||
| 411 | } | 411 | } |
| 412 | 412 | ||
| 413 | init_waitqueue_head(&vif->wq); | 413 | init_waitqueue_head(&vif->wq); |
| 414 | vif->task = kthread_create(xenvif_kthread, | 414 | task = kthread_create(xenvif_kthread, |
| 415 | (void *)vif, "%s", vif->dev->name); | 415 | (void *)vif, "%s", vif->dev->name); |
| 416 | if (IS_ERR(vif->task)) { | 416 | if (IS_ERR(task)) { |
| 417 | pr_warn("Could not allocate kthread for %s\n", vif->dev->name); | 417 | pr_warn("Could not allocate kthread for %s\n", vif->dev->name); |
| 418 | err = PTR_ERR(vif->task); | 418 | err = PTR_ERR(task); |
| 419 | goto err_rx_unbind; | 419 | goto err_rx_unbind; |
| 420 | } | 420 | } |
| 421 | 421 | ||
| 422 | vif->task = task; | ||
| 423 | |||
| 422 | rtnl_lock(); | 424 | rtnl_lock(); |
| 423 | if (!vif->can_sg && vif->dev->mtu > ETH_DATA_LEN) | 425 | if (!vif->can_sg && vif->dev->mtu > ETH_DATA_LEN) |
| 424 | dev_set_mtu(vif->dev, ETH_DATA_LEN); | 426 | dev_set_mtu(vif->dev, ETH_DATA_LEN); |
| @@ -461,8 +463,10 @@ void xenvif_disconnect(struct xenvif *vif) | |||
| 461 | if (netif_carrier_ok(vif->dev)) | 463 | if (netif_carrier_ok(vif->dev)) |
| 462 | xenvif_carrier_off(vif); | 464 | xenvif_carrier_off(vif); |
| 463 | 465 | ||
| 464 | if (vif->task) | 466 | if (vif->task) { |
| 465 | kthread_stop(vif->task); | 467 | kthread_stop(vif->task); |
| 468 | vif->task = NULL; | ||
| 469 | } | ||
| 466 | 470 | ||
| 467 | if (vif->tx_irq) { | 471 | if (vif->tx_irq) { |
| 468 | if (vif->tx_irq == vif->rx_irq) | 472 | if (vif->tx_irq == vif->rx_irq) |
diff --git a/drivers/net/xen-netback/netback.c b/drivers/net/xen-netback/netback.c index 919b6509455c..e884ee1fe7ed 100644 --- a/drivers/net/xen-netback/netback.c +++ b/drivers/net/xen-netback/netback.c | |||
| @@ -39,6 +39,7 @@ | |||
| 39 | #include <linux/udp.h> | 39 | #include <linux/udp.h> |
| 40 | 40 | ||
| 41 | #include <net/tcp.h> | 41 | #include <net/tcp.h> |
| 42 | #include <net/ip6_checksum.h> | ||
| 42 | 43 | ||
| 43 | #include <xen/xen.h> | 44 | #include <xen/xen.h> |
| 44 | #include <xen/events.h> | 45 | #include <xen/events.h> |
| @@ -451,7 +452,7 @@ static int xenvif_gop_skb(struct sk_buff *skb, | |||
| 451 | } | 452 | } |
| 452 | 453 | ||
| 453 | /* Set up a GSO prefix descriptor, if necessary */ | 454 | /* Set up a GSO prefix descriptor, if necessary */ |
| 454 | if ((1 << skb_shinfo(skb)->gso_type) & vif->gso_prefix_mask) { | 455 | if ((1 << gso_type) & vif->gso_prefix_mask) { |
| 455 | req = RING_GET_REQUEST(&vif->rx, vif->rx.req_cons++); | 456 | req = RING_GET_REQUEST(&vif->rx, vif->rx.req_cons++); |
| 456 | meta = npo->meta + npo->meta_prod++; | 457 | meta = npo->meta + npo->meta_prod++; |
| 457 | meta->gso_type = gso_type; | 458 | meta->gso_type = gso_type; |
| @@ -1148,75 +1149,92 @@ static int xenvif_set_skb_gso(struct xenvif *vif, | |||
| 1148 | return 0; | 1149 | return 0; |
| 1149 | } | 1150 | } |
| 1150 | 1151 | ||
| 1151 | static inline void maybe_pull_tail(struct sk_buff *skb, unsigned int len) | 1152 | static inline int maybe_pull_tail(struct sk_buff *skb, unsigned int len, |
| 1153 | unsigned int max) | ||
| 1152 | { | 1154 | { |
| 1153 | if (skb_is_nonlinear(skb) && skb_headlen(skb) < len) { | 1155 | if (skb_headlen(skb) >= len) |
| 1154 | /* If we need to pullup then pullup to the max, so we | 1156 | return 0; |
| 1155 | * won't need to do it again. | 1157 | |
| 1156 | */ | 1158 | /* If we need to pullup then pullup to the max, so we |
| 1157 | int target = min_t(int, skb->len, MAX_TCP_HEADER); | 1159 | * won't need to do it again. |
| 1158 | __pskb_pull_tail(skb, target - skb_headlen(skb)); | 1160 | */ |
| 1159 | } | 1161 | if (max > skb->len) |
| 1162 | max = skb->len; | ||
| 1163 | |||
| 1164 | if (__pskb_pull_tail(skb, max - skb_headlen(skb)) == NULL) | ||
| 1165 | return -ENOMEM; | ||
| 1166 | |||
| 1167 | if (skb_headlen(skb) < len) | ||
| 1168 | return -EPROTO; | ||
| 1169 | |||
| 1170 | return 0; | ||
| 1160 | } | 1171 | } |
| 1161 | 1172 | ||
| 1173 | /* This value should be large enough to cover a tagged ethernet header plus | ||
| 1174 | * maximally sized IP and TCP or UDP headers. | ||
| 1175 | */ | ||
| 1176 | #define MAX_IP_HDR_LEN 128 | ||
| 1177 | |||
| 1162 | static int checksum_setup_ip(struct xenvif *vif, struct sk_buff *skb, | 1178 | static int checksum_setup_ip(struct xenvif *vif, struct sk_buff *skb, |
| 1163 | int recalculate_partial_csum) | 1179 | int recalculate_partial_csum) |
| 1164 | { | 1180 | { |
| 1165 | struct iphdr *iph = (void *)skb->data; | ||
| 1166 | unsigned int header_size; | ||
| 1167 | unsigned int off; | 1181 | unsigned int off; |
| 1168 | int err = -EPROTO; | 1182 | bool fragment; |
| 1183 | int err; | ||
| 1169 | 1184 | ||
| 1170 | off = sizeof(struct iphdr); | 1185 | fragment = false; |
| 1171 | 1186 | ||
| 1172 | header_size = skb->network_header + off + MAX_IPOPTLEN; | 1187 | err = maybe_pull_tail(skb, |
| 1173 | maybe_pull_tail(skb, header_size); | 1188 | sizeof(struct iphdr), |
| 1189 | MAX_IP_HDR_LEN); | ||
| 1190 | if (err < 0) | ||
| 1191 | goto out; | ||
| 1174 | 1192 | ||
| 1175 | off = iph->ihl * 4; | 1193 | if (ip_hdr(skb)->frag_off & htons(IP_OFFSET | IP_MF)) |
| 1194 | fragment = true; | ||
| 1176 | 1195 | ||
| 1177 | switch (iph->protocol) { | 1196 | off = ip_hdrlen(skb); |
| 1197 | |||
| 1198 | err = -EPROTO; | ||
| 1199 | |||
| 1200 | switch (ip_hdr(skb)->protocol) { | ||
| 1178 | case IPPROTO_TCP: | 1201 | case IPPROTO_TCP: |
| 1202 | err = maybe_pull_tail(skb, | ||
| 1203 | off + sizeof(struct tcphdr), | ||
| 1204 | MAX_IP_HDR_LEN); | ||
| 1205 | if (err < 0) | ||
| 1206 | goto out; | ||
| 1207 | |||
| 1179 | if (!skb_partial_csum_set(skb, off, | 1208 | if (!skb_partial_csum_set(skb, off, |
| 1180 | offsetof(struct tcphdr, check))) | 1209 | offsetof(struct tcphdr, check))) |
| 1181 | goto out; | 1210 | goto out; |
| 1182 | 1211 | ||
| 1183 | if (recalculate_partial_csum) { | 1212 | if (recalculate_partial_csum) |
| 1184 | struct tcphdr *tcph = tcp_hdr(skb); | 1213 | tcp_hdr(skb)->check = |
| 1185 | 1214 | ~csum_tcpudp_magic(ip_hdr(skb)->saddr, | |
| 1186 | header_size = skb->network_header + | 1215 | ip_hdr(skb)->daddr, |
| 1187 | off + | 1216 | skb->len - off, |
| 1188 | sizeof(struct tcphdr); | 1217 | IPPROTO_TCP, 0); |
| 1189 | maybe_pull_tail(skb, header_size); | ||
| 1190 | |||
| 1191 | tcph->check = ~csum_tcpudp_magic(iph->saddr, iph->daddr, | ||
| 1192 | skb->len - off, | ||
| 1193 | IPPROTO_TCP, 0); | ||
| 1194 | } | ||
| 1195 | break; | 1218 | break; |
| 1196 | case IPPROTO_UDP: | 1219 | case IPPROTO_UDP: |
| 1220 | err = maybe_pull_tail(skb, | ||
| 1221 | off + sizeof(struct udphdr), | ||
| 1222 | MAX_IP_HDR_LEN); | ||
| 1223 | if (err < 0) | ||
| 1224 | goto out; | ||
| 1225 | |||
| 1197 | if (!skb_partial_csum_set(skb, off, | 1226 | if (!skb_partial_csum_set(skb, off, |
| 1198 | offsetof(struct udphdr, check))) | 1227 | offsetof(struct udphdr, check))) |
| 1199 | goto out; | 1228 | goto out; |
| 1200 | 1229 | ||
| 1201 | if (recalculate_partial_csum) { | 1230 | if (recalculate_partial_csum) |
| 1202 | struct udphdr *udph = udp_hdr(skb); | 1231 | udp_hdr(skb)->check = |
| 1203 | 1232 | ~csum_tcpudp_magic(ip_hdr(skb)->saddr, | |
| 1204 | header_size = skb->network_header + | 1233 | ip_hdr(skb)->daddr, |
| 1205 | off + | 1234 | skb->len - off, |
| 1206 | sizeof(struct udphdr); | 1235 | IPPROTO_UDP, 0); |
| 1207 | maybe_pull_tail(skb, header_size); | ||
| 1208 | |||
| 1209 | udph->check = ~csum_tcpudp_magic(iph->saddr, iph->daddr, | ||
| 1210 | skb->len - off, | ||
| 1211 | IPPROTO_UDP, 0); | ||
| 1212 | } | ||
| 1213 | break; | 1236 | break; |
| 1214 | default: | 1237 | default: |
| 1215 | if (net_ratelimit()) | ||
| 1216 | netdev_err(vif->dev, | ||
| 1217 | "Attempting to checksum a non-TCP/UDP packet, " | ||
| 1218 | "dropping a protocol %d packet\n", | ||
| 1219 | iph->protocol); | ||
| 1220 | goto out; | 1238 | goto out; |
| 1221 | } | 1239 | } |
| 1222 | 1240 | ||
| @@ -1226,121 +1244,138 @@ out: | |||
| 1226 | return err; | 1244 | return err; |
| 1227 | } | 1245 | } |
| 1228 | 1246 | ||
| 1247 | /* This value should be large enough to cover a tagged ethernet header plus | ||
| 1248 | * an IPv6 header, all options, and a maximal TCP or UDP header. | ||
| 1249 | */ | ||
| 1250 | #define MAX_IPV6_HDR_LEN 256 | ||
| 1251 | |||
| 1252 | #define OPT_HDR(type, skb, off) \ | ||
| 1253 | (type *)(skb_network_header(skb) + (off)) | ||
| 1254 | |||
| 1229 | static int checksum_setup_ipv6(struct xenvif *vif, struct sk_buff *skb, | 1255 | static int checksum_setup_ipv6(struct xenvif *vif, struct sk_buff *skb, |
| 1230 | int recalculate_partial_csum) | 1256 | int recalculate_partial_csum) |
| 1231 | { | 1257 | { |
| 1232 | int err = -EPROTO; | 1258 | int err; |
| 1233 | struct ipv6hdr *ipv6h = (void *)skb->data; | ||
| 1234 | u8 nexthdr; | 1259 | u8 nexthdr; |
| 1235 | unsigned int header_size; | ||
| 1236 | unsigned int off; | 1260 | unsigned int off; |
| 1261 | unsigned int len; | ||
| 1237 | bool fragment; | 1262 | bool fragment; |
| 1238 | bool done; | 1263 | bool done; |
| 1239 | 1264 | ||
| 1265 | fragment = false; | ||
| 1240 | done = false; | 1266 | done = false; |
| 1241 | 1267 | ||
| 1242 | off = sizeof(struct ipv6hdr); | 1268 | off = sizeof(struct ipv6hdr); |
| 1243 | 1269 | ||
| 1244 | header_size = skb->network_header + off; | 1270 | err = maybe_pull_tail(skb, off, MAX_IPV6_HDR_LEN); |
| 1245 | maybe_pull_tail(skb, header_size); | 1271 | if (err < 0) |
| 1272 | goto out; | ||
| 1246 | 1273 | ||
| 1247 | nexthdr = ipv6h->nexthdr; | 1274 | nexthdr = ipv6_hdr(skb)->nexthdr; |
| 1248 | 1275 | ||
| 1249 | while ((off <= sizeof(struct ipv6hdr) + ntohs(ipv6h->payload_len)) && | 1276 | len = sizeof(struct ipv6hdr) + ntohs(ipv6_hdr(skb)->payload_len); |
| 1250 | !done) { | 1277 | while (off <= len && !done) { |
| 1251 | switch (nexthdr) { | 1278 | switch (nexthdr) { |
| 1252 | case IPPROTO_DSTOPTS: | 1279 | case IPPROTO_DSTOPTS: |
| 1253 | case IPPROTO_HOPOPTS: | 1280 | case IPPROTO_HOPOPTS: |
| 1254 | case IPPROTO_ROUTING: { | 1281 | case IPPROTO_ROUTING: { |
| 1255 | struct ipv6_opt_hdr *hp = (void *)(skb->data + off); | 1282 | struct ipv6_opt_hdr *hp; |
| 1256 | 1283 | ||
| 1257 | header_size = skb->network_header + | 1284 | err = maybe_pull_tail(skb, |
| 1258 | off + | 1285 | off + |
| 1259 | sizeof(struct ipv6_opt_hdr); | 1286 | sizeof(struct ipv6_opt_hdr), |
| 1260 | maybe_pull_tail(skb, header_size); | 1287 | MAX_IPV6_HDR_LEN); |
| 1288 | if (err < 0) | ||
| 1289 | goto out; | ||
| 1261 | 1290 | ||
| 1291 | hp = OPT_HDR(struct ipv6_opt_hdr, skb, off); | ||
| 1262 | nexthdr = hp->nexthdr; | 1292 | nexthdr = hp->nexthdr; |
| 1263 | off += ipv6_optlen(hp); | 1293 | off += ipv6_optlen(hp); |
| 1264 | break; | 1294 | break; |
| 1265 | } | 1295 | } |
| 1266 | case IPPROTO_AH: { | 1296 | case IPPROTO_AH: { |
| 1267 | struct ip_auth_hdr *hp = (void *)(skb->data + off); | 1297 | struct ip_auth_hdr *hp; |
| 1268 | 1298 | ||
| 1269 | header_size = skb->network_header + | 1299 | err = maybe_pull_tail(skb, |
| 1270 | off + | 1300 | off + |
| 1271 | sizeof(struct ip_auth_hdr); | 1301 | sizeof(struct ip_auth_hdr), |
| 1272 | maybe_pull_tail(skb, header_size); | 1302 | MAX_IPV6_HDR_LEN); |
| 1303 | if (err < 0) | ||
| 1304 | goto out; | ||
| 1273 | 1305 | ||
| 1306 | hp = OPT_HDR(struct ip_auth_hdr, skb, off); | ||
| 1274 | nexthdr = hp->nexthdr; | 1307 | nexthdr = hp->nexthdr; |
| 1275 | off += (hp->hdrlen+2)<<2; | 1308 | off += ipv6_authlen(hp); |
| 1309 | break; | ||
| 1310 | } | ||
| 1311 | case IPPROTO_FRAGMENT: { | ||
| 1312 | struct frag_hdr *hp; | ||
| 1313 | |||
| 1314 | err = maybe_pull_tail(skb, | ||
| 1315 | off + | ||
| 1316 | sizeof(struct frag_hdr), | ||
| 1317 | MAX_IPV6_HDR_LEN); | ||
| 1318 | if (err < 0) | ||
| 1319 | goto out; | ||
| 1320 | |||
| 1321 | hp = OPT_HDR(struct frag_hdr, skb, off); | ||
| 1322 | |||
| 1323 | if (hp->frag_off & htons(IP6_OFFSET | IP6_MF)) | ||
| 1324 | fragment = true; | ||
| 1325 | |||
| 1326 | nexthdr = hp->nexthdr; | ||
| 1327 | off += sizeof(struct frag_hdr); | ||
| 1276 | break; | 1328 | break; |
| 1277 | } | 1329 | } |
| 1278 | case IPPROTO_FRAGMENT: | ||
| 1279 | fragment = true; | ||
| 1280 | /* fall through */ | ||
| 1281 | default: | 1330 | default: |
| 1282 | done = true; | 1331 | done = true; |
| 1283 | break; | 1332 | break; |
| 1284 | } | 1333 | } |
| 1285 | } | 1334 | } |
| 1286 | 1335 | ||
| 1287 | if (!done) { | 1336 | err = -EPROTO; |
| 1288 | if (net_ratelimit()) | ||
| 1289 | netdev_err(vif->dev, "Failed to parse packet header\n"); | ||
| 1290 | goto out; | ||
| 1291 | } | ||
| 1292 | 1337 | ||
| 1293 | if (fragment) { | 1338 | if (!done || fragment) |
| 1294 | if (net_ratelimit()) | ||
| 1295 | netdev_err(vif->dev, "Packet is a fragment!\n"); | ||
| 1296 | goto out; | 1339 | goto out; |
| 1297 | } | ||
| 1298 | 1340 | ||
| 1299 | switch (nexthdr) { | 1341 | switch (nexthdr) { |
| 1300 | case IPPROTO_TCP: | 1342 | case IPPROTO_TCP: |
| 1343 | err = maybe_pull_tail(skb, | ||
| 1344 | off + sizeof(struct tcphdr), | ||
| 1345 | MAX_IPV6_HDR_LEN); | ||
| 1346 | if (err < 0) | ||
| 1347 | goto out; | ||
| 1348 | |||
| 1301 | if (!skb_partial_csum_set(skb, off, | 1349 | if (!skb_partial_csum_set(skb, off, |
| 1302 | offsetof(struct tcphdr, check))) | 1350 | offsetof(struct tcphdr, check))) |
| 1303 | goto out; | 1351 | goto out; |
| 1304 | 1352 | ||
| 1305 | if (recalculate_partial_csum) { | 1353 | if (recalculate_partial_csum) |
| 1306 | struct tcphdr *tcph = tcp_hdr(skb); | 1354 | tcp_hdr(skb)->check = |
| 1307 | 1355 | ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr, | |
| 1308 | header_size = skb->network_header + | 1356 | &ipv6_hdr(skb)->daddr, |
| 1309 | off + | 1357 | skb->len - off, |
| 1310 | sizeof(struct tcphdr); | 1358 | IPPROTO_TCP, 0); |
| 1311 | maybe_pull_tail(skb, header_size); | ||
| 1312 | |||
| 1313 | tcph->check = ~csum_ipv6_magic(&ipv6h->saddr, | ||
| 1314 | &ipv6h->daddr, | ||
| 1315 | skb->len - off, | ||
| 1316 | IPPROTO_TCP, 0); | ||
| 1317 | } | ||
| 1318 | break; | 1359 | break; |
| 1319 | case IPPROTO_UDP: | 1360 | case IPPROTO_UDP: |
| 1361 | err = maybe_pull_tail(skb, | ||
| 1362 | off + sizeof(struct udphdr), | ||
| 1363 | MAX_IPV6_HDR_LEN); | ||
| 1364 | if (err < 0) | ||
| 1365 | goto out; | ||
| 1366 | |||
| 1320 | if (!skb_partial_csum_set(skb, off, | 1367 | if (!skb_partial_csum_set(skb, off, |
| 1321 | offsetof(struct udphdr, check))) | 1368 | offsetof(struct udphdr, check))) |
| 1322 | goto out; | 1369 | goto out; |
| 1323 | 1370 | ||
| 1324 | if (recalculate_partial_csum) { | 1371 | if (recalculate_partial_csum) |
| 1325 | struct udphdr *udph = udp_hdr(skb); | 1372 | udp_hdr(skb)->check = |
| 1326 | 1373 | ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr, | |
| 1327 | header_size = skb->network_header + | 1374 | &ipv6_hdr(skb)->daddr, |
| 1328 | off + | 1375 | skb->len - off, |
| 1329 | sizeof(struct udphdr); | 1376 | IPPROTO_UDP, 0); |
| 1330 | maybe_pull_tail(skb, header_size); | ||
| 1331 | |||
| 1332 | udph->check = ~csum_ipv6_magic(&ipv6h->saddr, | ||
| 1333 | &ipv6h->daddr, | ||
| 1334 | skb->len - off, | ||
| 1335 | IPPROTO_UDP, 0); | ||
| 1336 | } | ||
| 1337 | break; | 1377 | break; |
| 1338 | default: | 1378 | default: |
| 1339 | if (net_ratelimit()) | ||
| 1340 | netdev_err(vif->dev, | ||
| 1341 | "Attempting to checksum a non-TCP/UDP packet, " | ||
| 1342 | "dropping a protocol %d packet\n", | ||
| 1343 | nexthdr); | ||
| 1344 | goto out; | 1379 | goto out; |
| 1345 | } | 1380 | } |
| 1346 | 1381 | ||
| @@ -1410,14 +1445,15 @@ static bool tx_credit_exceeded(struct xenvif *vif, unsigned size) | |||
| 1410 | return false; | 1445 | return false; |
| 1411 | } | 1446 | } |
| 1412 | 1447 | ||
| 1413 | static unsigned xenvif_tx_build_gops(struct xenvif *vif) | 1448 | static unsigned xenvif_tx_build_gops(struct xenvif *vif, int budget) |
| 1414 | { | 1449 | { |
| 1415 | struct gnttab_copy *gop = vif->tx_copy_ops, *request_gop; | 1450 | struct gnttab_copy *gop = vif->tx_copy_ops, *request_gop; |
| 1416 | struct sk_buff *skb; | 1451 | struct sk_buff *skb; |
| 1417 | int ret; | 1452 | int ret; |
| 1418 | 1453 | ||
| 1419 | while ((nr_pending_reqs(vif) + XEN_NETBK_LEGACY_SLOTS_MAX | 1454 | while ((nr_pending_reqs(vif) + XEN_NETBK_LEGACY_SLOTS_MAX |
| 1420 | < MAX_PENDING_REQS)) { | 1455 | < MAX_PENDING_REQS) && |
| 1456 | (skb_queue_len(&vif->tx_queue) < budget)) { | ||
| 1421 | struct xen_netif_tx_request txreq; | 1457 | struct xen_netif_tx_request txreq; |
| 1422 | struct xen_netif_tx_request txfrags[XEN_NETBK_LEGACY_SLOTS_MAX]; | 1458 | struct xen_netif_tx_request txfrags[XEN_NETBK_LEGACY_SLOTS_MAX]; |
| 1423 | struct page *page; | 1459 | struct page *page; |
| @@ -1439,7 +1475,7 @@ static unsigned xenvif_tx_build_gops(struct xenvif *vif) | |||
| 1439 | continue; | 1475 | continue; |
| 1440 | } | 1476 | } |
| 1441 | 1477 | ||
| 1442 | RING_FINAL_CHECK_FOR_REQUESTS(&vif->tx, work_to_do); | 1478 | work_to_do = RING_HAS_UNCONSUMED_REQUESTS(&vif->tx); |
| 1443 | if (!work_to_do) | 1479 | if (!work_to_do) |
| 1444 | break; | 1480 | break; |
| 1445 | 1481 | ||
| @@ -1579,14 +1615,13 @@ static unsigned xenvif_tx_build_gops(struct xenvif *vif) | |||
| 1579 | } | 1615 | } |
| 1580 | 1616 | ||
| 1581 | 1617 | ||
| 1582 | static int xenvif_tx_submit(struct xenvif *vif, int budget) | 1618 | static int xenvif_tx_submit(struct xenvif *vif) |
| 1583 | { | 1619 | { |
| 1584 | struct gnttab_copy *gop = vif->tx_copy_ops; | 1620 | struct gnttab_copy *gop = vif->tx_copy_ops; |
| 1585 | struct sk_buff *skb; | 1621 | struct sk_buff *skb; |
| 1586 | int work_done = 0; | 1622 | int work_done = 0; |
| 1587 | 1623 | ||
| 1588 | while (work_done < budget && | 1624 | while ((skb = __skb_dequeue(&vif->tx_queue)) != NULL) { |
| 1589 | (skb = __skb_dequeue(&vif->tx_queue)) != NULL) { | ||
| 1590 | struct xen_netif_tx_request *txp; | 1625 | struct xen_netif_tx_request *txp; |
| 1591 | u16 pending_idx; | 1626 | u16 pending_idx; |
| 1592 | unsigned data_len; | 1627 | unsigned data_len; |
| @@ -1661,14 +1696,14 @@ int xenvif_tx_action(struct xenvif *vif, int budget) | |||
| 1661 | if (unlikely(!tx_work_todo(vif))) | 1696 | if (unlikely(!tx_work_todo(vif))) |
| 1662 | return 0; | 1697 | return 0; |
| 1663 | 1698 | ||
| 1664 | nr_gops = xenvif_tx_build_gops(vif); | 1699 | nr_gops = xenvif_tx_build_gops(vif, budget); |
| 1665 | 1700 | ||
| 1666 | if (nr_gops == 0) | 1701 | if (nr_gops == 0) |
| 1667 | return 0; | 1702 | return 0; |
| 1668 | 1703 | ||
| 1669 | gnttab_batch_copy(vif->tx_copy_ops, nr_gops); | 1704 | gnttab_batch_copy(vif->tx_copy_ops, nr_gops); |
| 1670 | 1705 | ||
| 1671 | work_done = xenvif_tx_submit(vif, nr_gops); | 1706 | work_done = xenvif_tx_submit(vif); |
| 1672 | 1707 | ||
| 1673 | return work_done; | 1708 | return work_done; |
| 1674 | } | 1709 | } |
diff --git a/drivers/ntb/ntb_hw.c b/drivers/ntb/ntb_hw.c index 1cb6e51e6bda..170e8e60cdb7 100644 --- a/drivers/ntb/ntb_hw.c +++ b/drivers/ntb/ntb_hw.c | |||
| @@ -141,6 +141,24 @@ void ntb_unregister_event_callback(struct ntb_device *ndev) | |||
| 141 | ndev->event_cb = NULL; | 141 | ndev->event_cb = NULL; |
| 142 | } | 142 | } |
| 143 | 143 | ||
| 144 | static void ntb_irq_work(unsigned long data) | ||
| 145 | { | ||
| 146 | struct ntb_db_cb *db_cb = (struct ntb_db_cb *)data; | ||
| 147 | int rc; | ||
| 148 | |||
| 149 | rc = db_cb->callback(db_cb->data, db_cb->db_num); | ||
| 150 | if (rc) | ||
| 151 | tasklet_schedule(&db_cb->irq_work); | ||
| 152 | else { | ||
| 153 | struct ntb_device *ndev = db_cb->ndev; | ||
| 154 | unsigned long mask; | ||
| 155 | |||
| 156 | mask = readw(ndev->reg_ofs.ldb_mask); | ||
| 157 | clear_bit(db_cb->db_num * ndev->bits_per_vector, &mask); | ||
| 158 | writew(mask, ndev->reg_ofs.ldb_mask); | ||
| 159 | } | ||
| 160 | } | ||
| 161 | |||
| 144 | /** | 162 | /** |
| 145 | * ntb_register_db_callback() - register a callback for doorbell interrupt | 163 | * ntb_register_db_callback() - register a callback for doorbell interrupt |
| 146 | * @ndev: pointer to ntb_device instance | 164 | * @ndev: pointer to ntb_device instance |
| @@ -155,7 +173,7 @@ void ntb_unregister_event_callback(struct ntb_device *ndev) | |||
| 155 | * RETURNS: An appropriate -ERRNO error value on error, or zero for success. | 173 | * RETURNS: An appropriate -ERRNO error value on error, or zero for success. |
| 156 | */ | 174 | */ |
| 157 | int ntb_register_db_callback(struct ntb_device *ndev, unsigned int idx, | 175 | int ntb_register_db_callback(struct ntb_device *ndev, unsigned int idx, |
| 158 | void *data, void (*func)(void *data, int db_num)) | 176 | void *data, int (*func)(void *data, int db_num)) |
| 159 | { | 177 | { |
| 160 | unsigned long mask; | 178 | unsigned long mask; |
| 161 | 179 | ||
| @@ -166,6 +184,10 @@ int ntb_register_db_callback(struct ntb_device *ndev, unsigned int idx, | |||
| 166 | 184 | ||
| 167 | ndev->db_cb[idx].callback = func; | 185 | ndev->db_cb[idx].callback = func; |
| 168 | ndev->db_cb[idx].data = data; | 186 | ndev->db_cb[idx].data = data; |
| 187 | ndev->db_cb[idx].ndev = ndev; | ||
| 188 | |||
| 189 | tasklet_init(&ndev->db_cb[idx].irq_work, ntb_irq_work, | ||
| 190 | (unsigned long) &ndev->db_cb[idx]); | ||
| 169 | 191 | ||
| 170 | /* unmask interrupt */ | 192 | /* unmask interrupt */ |
| 171 | mask = readw(ndev->reg_ofs.ldb_mask); | 193 | mask = readw(ndev->reg_ofs.ldb_mask); |
| @@ -194,6 +216,8 @@ void ntb_unregister_db_callback(struct ntb_device *ndev, unsigned int idx) | |||
| 194 | set_bit(idx * ndev->bits_per_vector, &mask); | 216 | set_bit(idx * ndev->bits_per_vector, &mask); |
| 195 | writew(mask, ndev->reg_ofs.ldb_mask); | 217 | writew(mask, ndev->reg_ofs.ldb_mask); |
| 196 | 218 | ||
| 219 | tasklet_disable(&ndev->db_cb[idx].irq_work); | ||
| 220 | |||
| 197 | ndev->db_cb[idx].callback = NULL; | 221 | ndev->db_cb[idx].callback = NULL; |
| 198 | } | 222 | } |
| 199 | 223 | ||
| @@ -678,6 +702,7 @@ static int ntb_xeon_setup(struct ntb_device *ndev) | |||
| 678 | return -EINVAL; | 702 | return -EINVAL; |
| 679 | 703 | ||
| 680 | ndev->limits.max_mw = SNB_ERRATA_MAX_MW; | 704 | ndev->limits.max_mw = SNB_ERRATA_MAX_MW; |
| 705 | ndev->limits.max_db_bits = SNB_MAX_DB_BITS; | ||
| 681 | ndev->reg_ofs.spad_write = ndev->mw[1].vbase + | 706 | ndev->reg_ofs.spad_write = ndev->mw[1].vbase + |
| 682 | SNB_SPAD_OFFSET; | 707 | SNB_SPAD_OFFSET; |
| 683 | ndev->reg_ofs.rdb = ndev->mw[1].vbase + | 708 | ndev->reg_ofs.rdb = ndev->mw[1].vbase + |
| @@ -688,8 +713,21 @@ static int ntb_xeon_setup(struct ntb_device *ndev) | |||
| 688 | */ | 713 | */ |
| 689 | writeq(ndev->mw[1].bar_sz + 0x1000, ndev->reg_base + | 714 | writeq(ndev->mw[1].bar_sz + 0x1000, ndev->reg_base + |
| 690 | SNB_PBAR4LMT_OFFSET); | 715 | SNB_PBAR4LMT_OFFSET); |
| 716 | /* HW errata on the Limit registers. They can only be | ||
| 717 | * written when the base register is 4GB aligned and | ||
| 718 | * < 32bit. This should already be the case based on the | ||
| 719 | * driver defaults, but write the Limit registers first | ||
| 720 | * just in case. | ||
| 721 | */ | ||
| 691 | } else { | 722 | } else { |
| 692 | ndev->limits.max_mw = SNB_MAX_MW; | 723 | ndev->limits.max_mw = SNB_MAX_MW; |
| 724 | |||
| 725 | /* HW Errata on bit 14 of b2bdoorbell register. Writes | ||
| 726 | * will not be mirrored to the remote system. Shrink | ||
| 727 | * the number of bits by one, since bit 14 is the last | ||
| 728 | * bit. | ||
| 729 | */ | ||
| 730 | ndev->limits.max_db_bits = SNB_MAX_DB_BITS - 1; | ||
| 693 | ndev->reg_ofs.spad_write = ndev->reg_base + | 731 | ndev->reg_ofs.spad_write = ndev->reg_base + |
| 694 | SNB_B2B_SPAD_OFFSET; | 732 | SNB_B2B_SPAD_OFFSET; |
| 695 | ndev->reg_ofs.rdb = ndev->reg_base + | 733 | ndev->reg_ofs.rdb = ndev->reg_base + |
| @@ -699,6 +737,12 @@ static int ntb_xeon_setup(struct ntb_device *ndev) | |||
| 699 | * something silly | 737 | * something silly |
| 700 | */ | 738 | */ |
| 701 | writeq(0, ndev->reg_base + SNB_PBAR4LMT_OFFSET); | 739 | writeq(0, ndev->reg_base + SNB_PBAR4LMT_OFFSET); |
| 740 | /* HW errata on the Limit registers. They can only be | ||
| 741 | * written when the base register is 4GB aligned and | ||
| 742 | * < 32bit. This should already be the case based on the | ||
| 743 | * driver defaults, but write the Limit registers first | ||
| 744 | * just in case. | ||
| 745 | */ | ||
| 702 | } | 746 | } |
| 703 | 747 | ||
| 704 | /* The Xeon errata workaround requires setting SBAR Base | 748 | /* The Xeon errata workaround requires setting SBAR Base |
| @@ -769,6 +813,7 @@ static int ntb_xeon_setup(struct ntb_device *ndev) | |||
| 769 | * have an equal amount. | 813 | * have an equal amount. |
| 770 | */ | 814 | */ |
| 771 | ndev->limits.max_spads = SNB_MAX_COMPAT_SPADS / 2; | 815 | ndev->limits.max_spads = SNB_MAX_COMPAT_SPADS / 2; |
| 816 | ndev->limits.max_db_bits = SNB_MAX_DB_BITS; | ||
| 772 | /* Note: The SDOORBELL is the cause of the errata. You REALLY | 817 | /* Note: The SDOORBELL is the cause of the errata. You REALLY |
| 773 | * don't want to touch it. | 818 | * don't want to touch it. |
| 774 | */ | 819 | */ |
| @@ -793,6 +838,7 @@ static int ntb_xeon_setup(struct ntb_device *ndev) | |||
| 793 | * have an equal amount. | 838 | * have an equal amount. |
| 794 | */ | 839 | */ |
| 795 | ndev->limits.max_spads = SNB_MAX_COMPAT_SPADS / 2; | 840 | ndev->limits.max_spads = SNB_MAX_COMPAT_SPADS / 2; |
| 841 | ndev->limits.max_db_bits = SNB_MAX_DB_BITS; | ||
| 796 | ndev->reg_ofs.rdb = ndev->reg_base + SNB_PDOORBELL_OFFSET; | 842 | ndev->reg_ofs.rdb = ndev->reg_base + SNB_PDOORBELL_OFFSET; |
| 797 | ndev->reg_ofs.ldb = ndev->reg_base + SNB_SDOORBELL_OFFSET; | 843 | ndev->reg_ofs.ldb = ndev->reg_base + SNB_SDOORBELL_OFFSET; |
| 798 | ndev->reg_ofs.ldb_mask = ndev->reg_base + SNB_SDBMSK_OFFSET; | 844 | ndev->reg_ofs.ldb_mask = ndev->reg_base + SNB_SDBMSK_OFFSET; |
| @@ -819,7 +865,6 @@ static int ntb_xeon_setup(struct ntb_device *ndev) | |||
| 819 | ndev->reg_ofs.lnk_stat = ndev->reg_base + SNB_SLINK_STATUS_OFFSET; | 865 | ndev->reg_ofs.lnk_stat = ndev->reg_base + SNB_SLINK_STATUS_OFFSET; |
| 820 | ndev->reg_ofs.spci_cmd = ndev->reg_base + SNB_PCICMD_OFFSET; | 866 | ndev->reg_ofs.spci_cmd = ndev->reg_base + SNB_PCICMD_OFFSET; |
| 821 | 867 | ||
| 822 | ndev->limits.max_db_bits = SNB_MAX_DB_BITS; | ||
| 823 | ndev->limits.msix_cnt = SNB_MSIX_CNT; | 868 | ndev->limits.msix_cnt = SNB_MSIX_CNT; |
| 824 | ndev->bits_per_vector = SNB_DB_BITS_PER_VEC; | 869 | ndev->bits_per_vector = SNB_DB_BITS_PER_VEC; |
| 825 | 870 | ||
| @@ -934,12 +979,16 @@ static irqreturn_t bwd_callback_msix_irq(int irq, void *data) | |||
| 934 | { | 979 | { |
| 935 | struct ntb_db_cb *db_cb = data; | 980 | struct ntb_db_cb *db_cb = data; |
| 936 | struct ntb_device *ndev = db_cb->ndev; | 981 | struct ntb_device *ndev = db_cb->ndev; |
| 982 | unsigned long mask; | ||
| 937 | 983 | ||
| 938 | dev_dbg(&ndev->pdev->dev, "MSI-X irq %d received for DB %d\n", irq, | 984 | dev_dbg(&ndev->pdev->dev, "MSI-X irq %d received for DB %d\n", irq, |
| 939 | db_cb->db_num); | 985 | db_cb->db_num); |
| 940 | 986 | ||
| 941 | if (db_cb->callback) | 987 | mask = readw(ndev->reg_ofs.ldb_mask); |
| 942 | db_cb->callback(db_cb->data, db_cb->db_num); | 988 | set_bit(db_cb->db_num * ndev->bits_per_vector, &mask); |
| 989 | writew(mask, ndev->reg_ofs.ldb_mask); | ||
| 990 | |||
| 991 | tasklet_schedule(&db_cb->irq_work); | ||
| 943 | 992 | ||
| 944 | /* No need to check for the specific HB irq, any interrupt means | 993 | /* No need to check for the specific HB irq, any interrupt means |
| 945 | * we're connected. | 994 | * we're connected. |
| @@ -955,12 +1004,16 @@ static irqreturn_t xeon_callback_msix_irq(int irq, void *data) | |||
| 955 | { | 1004 | { |
| 956 | struct ntb_db_cb *db_cb = data; | 1005 | struct ntb_db_cb *db_cb = data; |
| 957 | struct ntb_device *ndev = db_cb->ndev; | 1006 | struct ntb_device *ndev = db_cb->ndev; |
| 1007 | unsigned long mask; | ||
| 958 | 1008 | ||
| 959 | dev_dbg(&ndev->pdev->dev, "MSI-X irq %d received for DB %d\n", irq, | 1009 | dev_dbg(&ndev->pdev->dev, "MSI-X irq %d received for DB %d\n", irq, |
| 960 | db_cb->db_num); | 1010 | db_cb->db_num); |
| 961 | 1011 | ||
| 962 | if (db_cb->callback) | 1012 | mask = readw(ndev->reg_ofs.ldb_mask); |
| 963 | db_cb->callback(db_cb->data, db_cb->db_num); | 1013 | set_bit(db_cb->db_num * ndev->bits_per_vector, &mask); |
| 1014 | writew(mask, ndev->reg_ofs.ldb_mask); | ||
| 1015 | |||
| 1016 | tasklet_schedule(&db_cb->irq_work); | ||
| 964 | 1017 | ||
| 965 | /* On Sandybridge, there are 16 bits in the interrupt register | 1018 | /* On Sandybridge, there are 16 bits in the interrupt register |
| 966 | * but only 4 vectors. So, 5 bits are assigned to the first 3 | 1019 | * but only 4 vectors. So, 5 bits are assigned to the first 3 |
| @@ -986,7 +1039,7 @@ static irqreturn_t xeon_event_msix_irq(int irq, void *dev) | |||
| 986 | dev_err(&ndev->pdev->dev, "Error determining link status\n"); | 1039 | dev_err(&ndev->pdev->dev, "Error determining link status\n"); |
| 987 | 1040 | ||
| 988 | /* bit 15 is always the link bit */ | 1041 | /* bit 15 is always the link bit */ |
| 989 | writew(1 << ndev->limits.max_db_bits, ndev->reg_ofs.ldb); | 1042 | writew(1 << SNB_LINK_DB, ndev->reg_ofs.ldb); |
| 990 | 1043 | ||
| 991 | return IRQ_HANDLED; | 1044 | return IRQ_HANDLED; |
| 992 | } | 1045 | } |
| @@ -1075,6 +1128,10 @@ static int ntb_setup_msix(struct ntb_device *ndev) | |||
| 1075 | "Only %d MSI-X vectors. Limiting the number of queues to that number.\n", | 1128 | "Only %d MSI-X vectors. Limiting the number of queues to that number.\n", |
| 1076 | rc); | 1129 | rc); |
| 1077 | msix_entries = rc; | 1130 | msix_entries = rc; |
| 1131 | |||
| 1132 | rc = pci_enable_msix(pdev, ndev->msix_entries, msix_entries); | ||
| 1133 | if (rc) | ||
| 1134 | goto err1; | ||
| 1078 | } | 1135 | } |
| 1079 | 1136 | ||
| 1080 | for (i = 0; i < msix_entries; i++) { | 1137 | for (i = 0; i < msix_entries; i++) { |
| @@ -1176,9 +1233,10 @@ static int ntb_setup_interrupts(struct ntb_device *ndev) | |||
| 1176 | */ | 1233 | */ |
| 1177 | if (ndev->hw_type == BWD_HW) | 1234 | if (ndev->hw_type == BWD_HW) |
| 1178 | writeq(~0, ndev->reg_ofs.ldb_mask); | 1235 | writeq(~0, ndev->reg_ofs.ldb_mask); |
| 1179 | else | 1236 | else { |
| 1180 | writew(~(1 << ndev->limits.max_db_bits), | 1237 | u16 var = 1 << SNB_LINK_DB; |
| 1181 | ndev->reg_ofs.ldb_mask); | 1238 | writew(~var, ndev->reg_ofs.ldb_mask); |
| 1239 | } | ||
| 1182 | 1240 | ||
| 1183 | rc = ntb_setup_msix(ndev); | 1241 | rc = ntb_setup_msix(ndev); |
| 1184 | if (!rc) | 1242 | if (!rc) |
| @@ -1286,6 +1344,39 @@ static void ntb_free_debugfs(struct ntb_device *ndev) | |||
| 1286 | } | 1344 | } |
| 1287 | } | 1345 | } |
| 1288 | 1346 | ||
| 1347 | static void ntb_hw_link_up(struct ntb_device *ndev) | ||
| 1348 | { | ||
| 1349 | if (ndev->conn_type == NTB_CONN_TRANSPARENT) | ||
| 1350 | ntb_link_event(ndev, NTB_LINK_UP); | ||
| 1351 | else { | ||
| 1352 | u32 ntb_cntl; | ||
| 1353 | |||
| 1354 | /* Let's bring the NTB link up */ | ||
| 1355 | ntb_cntl = readl(ndev->reg_ofs.lnk_cntl); | ||
| 1356 | ntb_cntl &= ~(NTB_CNTL_LINK_DISABLE | NTB_CNTL_CFG_LOCK); | ||
| 1357 | ntb_cntl |= NTB_CNTL_P2S_BAR23_SNOOP | NTB_CNTL_S2P_BAR23_SNOOP; | ||
| 1358 | ntb_cntl |= NTB_CNTL_P2S_BAR45_SNOOP | NTB_CNTL_S2P_BAR45_SNOOP; | ||
| 1359 | writel(ntb_cntl, ndev->reg_ofs.lnk_cntl); | ||
| 1360 | } | ||
| 1361 | } | ||
| 1362 | |||
| 1363 | static void ntb_hw_link_down(struct ntb_device *ndev) | ||
| 1364 | { | ||
| 1365 | u32 ntb_cntl; | ||
| 1366 | |||
| 1367 | if (ndev->conn_type == NTB_CONN_TRANSPARENT) { | ||
| 1368 | ntb_link_event(ndev, NTB_LINK_DOWN); | ||
| 1369 | return; | ||
| 1370 | } | ||
| 1371 | |||
| 1372 | /* Bring NTB link down */ | ||
| 1373 | ntb_cntl = readl(ndev->reg_ofs.lnk_cntl); | ||
| 1374 | ntb_cntl &= ~(NTB_CNTL_P2S_BAR23_SNOOP | NTB_CNTL_S2P_BAR23_SNOOP); | ||
| 1375 | ntb_cntl &= ~(NTB_CNTL_P2S_BAR45_SNOOP | NTB_CNTL_S2P_BAR45_SNOOP); | ||
| 1376 | ntb_cntl |= NTB_CNTL_LINK_DISABLE | NTB_CNTL_CFG_LOCK; | ||
| 1377 | writel(ntb_cntl, ndev->reg_ofs.lnk_cntl); | ||
| 1378 | } | ||
| 1379 | |||
| 1289 | static int ntb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) | 1380 | static int ntb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) |
| 1290 | { | 1381 | { |
| 1291 | struct ntb_device *ndev; | 1382 | struct ntb_device *ndev; |
| @@ -1374,9 +1465,7 @@ static int ntb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) | |||
| 1374 | if (rc) | 1465 | if (rc) |
| 1375 | goto err6; | 1466 | goto err6; |
| 1376 | 1467 | ||
| 1377 | /* Let's bring the NTB link up */ | 1468 | ntb_hw_link_up(ndev); |
| 1378 | writel(NTB_CNTL_BAR23_SNOOP | NTB_CNTL_BAR45_SNOOP, | ||
| 1379 | ndev->reg_ofs.lnk_cntl); | ||
| 1380 | 1469 | ||
| 1381 | return 0; | 1470 | return 0; |
| 1382 | 1471 | ||
| @@ -1406,12 +1495,8 @@ static void ntb_pci_remove(struct pci_dev *pdev) | |||
| 1406 | { | 1495 | { |
| 1407 | struct ntb_device *ndev = pci_get_drvdata(pdev); | 1496 | struct ntb_device *ndev = pci_get_drvdata(pdev); |
| 1408 | int i; | 1497 | int i; |
| 1409 | u32 ntb_cntl; | ||
| 1410 | 1498 | ||
| 1411 | /* Bring NTB link down */ | 1499 | ntb_hw_link_down(ndev); |
| 1412 | ntb_cntl = readl(ndev->reg_ofs.lnk_cntl); | ||
| 1413 | ntb_cntl |= NTB_CNTL_LINK_DISABLE; | ||
| 1414 | writel(ntb_cntl, ndev->reg_ofs.lnk_cntl); | ||
| 1415 | 1500 | ||
| 1416 | ntb_transport_free(ndev->ntb_transport); | 1501 | ntb_transport_free(ndev->ntb_transport); |
| 1417 | 1502 | ||
diff --git a/drivers/ntb/ntb_hw.h b/drivers/ntb/ntb_hw.h index 0a31cedae7d4..bbdb7edca10c 100644 --- a/drivers/ntb/ntb_hw.h +++ b/drivers/ntb/ntb_hw.h | |||
| @@ -106,10 +106,11 @@ struct ntb_mw { | |||
| 106 | }; | 106 | }; |
| 107 | 107 | ||
| 108 | struct ntb_db_cb { | 108 | struct ntb_db_cb { |
| 109 | void (*callback) (void *data, int db_num); | 109 | int (*callback)(void *data, int db_num); |
| 110 | unsigned int db_num; | 110 | unsigned int db_num; |
| 111 | void *data; | 111 | void *data; |
| 112 | struct ntb_device *ndev; | 112 | struct ntb_device *ndev; |
| 113 | struct tasklet_struct irq_work; | ||
| 113 | }; | 114 | }; |
| 114 | 115 | ||
| 115 | struct ntb_device { | 116 | struct ntb_device { |
| @@ -228,8 +229,8 @@ struct ntb_device *ntb_register_transport(struct pci_dev *pdev, | |||
| 228 | void ntb_unregister_transport(struct ntb_device *ndev); | 229 | void ntb_unregister_transport(struct ntb_device *ndev); |
| 229 | void ntb_set_mw_addr(struct ntb_device *ndev, unsigned int mw, u64 addr); | 230 | void ntb_set_mw_addr(struct ntb_device *ndev, unsigned int mw, u64 addr); |
| 230 | int ntb_register_db_callback(struct ntb_device *ndev, unsigned int idx, | 231 | int ntb_register_db_callback(struct ntb_device *ndev, unsigned int idx, |
| 231 | void *data, void (*db_cb_func) (void *data, | 232 | void *data, int (*db_cb_func)(void *data, |
| 232 | int db_num)); | 233 | int db_num)); |
| 233 | void ntb_unregister_db_callback(struct ntb_device *ndev, unsigned int idx); | 234 | void ntb_unregister_db_callback(struct ntb_device *ndev, unsigned int idx); |
| 234 | int ntb_register_event_callback(struct ntb_device *ndev, | 235 | int ntb_register_event_callback(struct ntb_device *ndev, |
| 235 | void (*event_cb_func) (void *handle, | 236 | void (*event_cb_func) (void *handle, |
diff --git a/drivers/ntb/ntb_regs.h b/drivers/ntb/ntb_regs.h index aa4bdd393c58..9774506419d7 100644 --- a/drivers/ntb/ntb_regs.h +++ b/drivers/ntb/ntb_regs.h | |||
| @@ -55,6 +55,7 @@ | |||
| 55 | #define SNB_MAX_COMPAT_SPADS 16 | 55 | #define SNB_MAX_COMPAT_SPADS 16 |
| 56 | /* Reserve the uppermost bit for link interrupt */ | 56 | /* Reserve the uppermost bit for link interrupt */ |
| 57 | #define SNB_MAX_DB_BITS 15 | 57 | #define SNB_MAX_DB_BITS 15 |
| 58 | #define SNB_LINK_DB 15 | ||
| 58 | #define SNB_DB_BITS_PER_VEC 5 | 59 | #define SNB_DB_BITS_PER_VEC 5 |
| 59 | #define SNB_MAX_MW 2 | 60 | #define SNB_MAX_MW 2 |
| 60 | #define SNB_ERRATA_MAX_MW 1 | 61 | #define SNB_ERRATA_MAX_MW 1 |
| @@ -75,9 +76,6 @@ | |||
| 75 | #define SNB_SBAR2XLAT_OFFSET 0x0030 | 76 | #define SNB_SBAR2XLAT_OFFSET 0x0030 |
| 76 | #define SNB_SBAR4XLAT_OFFSET 0x0038 | 77 | #define SNB_SBAR4XLAT_OFFSET 0x0038 |
| 77 | #define SNB_SBAR0BASE_OFFSET 0x0040 | 78 | #define SNB_SBAR0BASE_OFFSET 0x0040 |
| 78 | #define SNB_SBAR0BASE_OFFSET 0x0040 | ||
| 79 | #define SNB_SBAR2BASE_OFFSET 0x0048 | ||
| 80 | #define SNB_SBAR4BASE_OFFSET 0x0050 | ||
| 81 | #define SNB_SBAR2BASE_OFFSET 0x0048 | 79 | #define SNB_SBAR2BASE_OFFSET 0x0048 |
| 82 | #define SNB_SBAR4BASE_OFFSET 0x0050 | 80 | #define SNB_SBAR4BASE_OFFSET 0x0050 |
| 83 | #define SNB_NTBCNTL_OFFSET 0x0058 | 81 | #define SNB_NTBCNTL_OFFSET 0x0058 |
| @@ -145,11 +143,13 @@ | |||
| 145 | #define BWD_LTSSMSTATEJMP_FORCEDETECT (1 << 2) | 143 | #define BWD_LTSSMSTATEJMP_FORCEDETECT (1 << 2) |
| 146 | #define BWD_IBIST_ERR_OFLOW 0x7FFF7FFF | 144 | #define BWD_IBIST_ERR_OFLOW 0x7FFF7FFF |
| 147 | 145 | ||
| 148 | #define NTB_CNTL_CFG_LOCK (1 << 0) | 146 | #define NTB_CNTL_CFG_LOCK (1 << 0) |
| 149 | #define NTB_CNTL_LINK_DISABLE (1 << 1) | 147 | #define NTB_CNTL_LINK_DISABLE (1 << 1) |
| 150 | #define NTB_CNTL_BAR23_SNOOP (1 << 2) | 148 | #define NTB_CNTL_S2P_BAR23_SNOOP (1 << 2) |
| 151 | #define NTB_CNTL_BAR45_SNOOP (1 << 6) | 149 | #define NTB_CNTL_P2S_BAR23_SNOOP (1 << 4) |
| 152 | #define BWD_CNTL_LINK_DOWN (1 << 16) | 150 | #define NTB_CNTL_S2P_BAR45_SNOOP (1 << 6) |
| 151 | #define NTB_CNTL_P2S_BAR45_SNOOP (1 << 8) | ||
| 152 | #define BWD_CNTL_LINK_DOWN (1 << 16) | ||
| 153 | 153 | ||
| 154 | #define NTB_PPD_OFFSET 0x00D4 | 154 | #define NTB_PPD_OFFSET 0x00D4 |
| 155 | #define SNB_PPD_CONN_TYPE 0x0003 | 155 | #define SNB_PPD_CONN_TYPE 0x0003 |
diff --git a/drivers/ntb/ntb_transport.c b/drivers/ntb/ntb_transport.c index d0222f13d154..3217f394d45b 100644 --- a/drivers/ntb/ntb_transport.c +++ b/drivers/ntb/ntb_transport.c | |||
| @@ -119,7 +119,6 @@ struct ntb_transport_qp { | |||
| 119 | 119 | ||
| 120 | void (*rx_handler) (struct ntb_transport_qp *qp, void *qp_data, | 120 | void (*rx_handler) (struct ntb_transport_qp *qp, void *qp_data, |
| 121 | void *data, int len); | 121 | void *data, int len); |
| 122 | struct tasklet_struct rx_work; | ||
| 123 | struct list_head rx_pend_q; | 122 | struct list_head rx_pend_q; |
| 124 | struct list_head rx_free_q; | 123 | struct list_head rx_free_q; |
| 125 | spinlock_t ntb_rx_pend_q_lock; | 124 | spinlock_t ntb_rx_pend_q_lock; |
| @@ -584,11 +583,8 @@ static int ntb_set_mw(struct ntb_transport *nt, int num_mw, unsigned int size) | |||
| 584 | return 0; | 583 | return 0; |
| 585 | } | 584 | } |
| 586 | 585 | ||
| 587 | static void ntb_qp_link_cleanup(struct work_struct *work) | 586 | static void ntb_qp_link_cleanup(struct ntb_transport_qp *qp) |
| 588 | { | 587 | { |
| 589 | struct ntb_transport_qp *qp = container_of(work, | ||
| 590 | struct ntb_transport_qp, | ||
| 591 | link_cleanup); | ||
| 592 | struct ntb_transport *nt = qp->transport; | 588 | struct ntb_transport *nt = qp->transport; |
| 593 | struct pci_dev *pdev = ntb_query_pdev(nt->ndev); | 589 | struct pci_dev *pdev = ntb_query_pdev(nt->ndev); |
| 594 | 590 | ||
| @@ -602,6 +598,16 @@ static void ntb_qp_link_cleanup(struct work_struct *work) | |||
| 602 | 598 | ||
| 603 | dev_info(&pdev->dev, "qp %d: Link Down\n", qp->qp_num); | 599 | dev_info(&pdev->dev, "qp %d: Link Down\n", qp->qp_num); |
| 604 | qp->qp_link = NTB_LINK_DOWN; | 600 | qp->qp_link = NTB_LINK_DOWN; |
| 601 | } | ||
| 602 | |||
| 603 | static void ntb_qp_link_cleanup_work(struct work_struct *work) | ||
| 604 | { | ||
| 605 | struct ntb_transport_qp *qp = container_of(work, | ||
| 606 | struct ntb_transport_qp, | ||
| 607 | link_cleanup); | ||
| 608 | struct ntb_transport *nt = qp->transport; | ||
| 609 | |||
| 610 | ntb_qp_link_cleanup(qp); | ||
| 605 | 611 | ||
| 606 | if (nt->transport_link == NTB_LINK_UP) | 612 | if (nt->transport_link == NTB_LINK_UP) |
| 607 | schedule_delayed_work(&qp->link_work, | 613 | schedule_delayed_work(&qp->link_work, |
| @@ -613,22 +619,20 @@ static void ntb_qp_link_down(struct ntb_transport_qp *qp) | |||
| 613 | schedule_work(&qp->link_cleanup); | 619 | schedule_work(&qp->link_cleanup); |
| 614 | } | 620 | } |
| 615 | 621 | ||
| 616 | static void ntb_transport_link_cleanup(struct work_struct *work) | 622 | static void ntb_transport_link_cleanup(struct ntb_transport *nt) |
| 617 | { | 623 | { |
| 618 | struct ntb_transport *nt = container_of(work, struct ntb_transport, | ||
| 619 | link_cleanup); | ||
| 620 | int i; | 624 | int i; |
| 621 | 625 | ||
| 626 | /* Pass along the info to any clients */ | ||
| 627 | for (i = 0; i < nt->max_qps; i++) | ||
| 628 | if (!test_bit(i, &nt->qp_bitmap)) | ||
| 629 | ntb_qp_link_cleanup(&nt->qps[i]); | ||
| 630 | |||
| 622 | if (nt->transport_link == NTB_LINK_DOWN) | 631 | if (nt->transport_link == NTB_LINK_DOWN) |
| 623 | cancel_delayed_work_sync(&nt->link_work); | 632 | cancel_delayed_work_sync(&nt->link_work); |
| 624 | else | 633 | else |
| 625 | nt->transport_link = NTB_LINK_DOWN; | 634 | nt->transport_link = NTB_LINK_DOWN; |
| 626 | 635 | ||
| 627 | /* Pass along the info to any clients */ | ||
| 628 | for (i = 0; i < nt->max_qps; i++) | ||
| 629 | if (!test_bit(i, &nt->qp_bitmap)) | ||
| 630 | ntb_qp_link_down(&nt->qps[i]); | ||
| 631 | |||
| 632 | /* The scratchpad registers keep the values if the remote side | 636 | /* The scratchpad registers keep the values if the remote side |
| 633 | * goes down, blast them now to give them a sane value the next | 637 | * goes down, blast them now to give them a sane value the next |
| 634 | * time they are accessed | 638 | * time they are accessed |
| @@ -637,6 +641,14 @@ static void ntb_transport_link_cleanup(struct work_struct *work) | |||
| 637 | ntb_write_local_spad(nt->ndev, i, 0); | 641 | ntb_write_local_spad(nt->ndev, i, 0); |
| 638 | } | 642 | } |
| 639 | 643 | ||
| 644 | static void ntb_transport_link_cleanup_work(struct work_struct *work) | ||
| 645 | { | ||
| 646 | struct ntb_transport *nt = container_of(work, struct ntb_transport, | ||
| 647 | link_cleanup); | ||
| 648 | |||
| 649 | ntb_transport_link_cleanup(nt); | ||
| 650 | } | ||
| 651 | |||
| 640 | static void ntb_transport_event_callback(void *data, enum ntb_hw_event event) | 652 | static void ntb_transport_event_callback(void *data, enum ntb_hw_event event) |
| 641 | { | 653 | { |
| 642 | struct ntb_transport *nt = data; | 654 | struct ntb_transport *nt = data; |
| @@ -880,7 +892,7 @@ static int ntb_transport_init_queue(struct ntb_transport *nt, | |||
| 880 | } | 892 | } |
| 881 | 893 | ||
| 882 | INIT_DELAYED_WORK(&qp->link_work, ntb_qp_link_work); | 894 | INIT_DELAYED_WORK(&qp->link_work, ntb_qp_link_work); |
| 883 | INIT_WORK(&qp->link_cleanup, ntb_qp_link_cleanup); | 895 | INIT_WORK(&qp->link_cleanup, ntb_qp_link_cleanup_work); |
| 884 | 896 | ||
| 885 | spin_lock_init(&qp->ntb_rx_pend_q_lock); | 897 | spin_lock_init(&qp->ntb_rx_pend_q_lock); |
| 886 | spin_lock_init(&qp->ntb_rx_free_q_lock); | 898 | spin_lock_init(&qp->ntb_rx_free_q_lock); |
| @@ -936,7 +948,7 @@ int ntb_transport_init(struct pci_dev *pdev) | |||
| 936 | } | 948 | } |
| 937 | 949 | ||
| 938 | INIT_DELAYED_WORK(&nt->link_work, ntb_transport_link_work); | 950 | INIT_DELAYED_WORK(&nt->link_work, ntb_transport_link_work); |
| 939 | INIT_WORK(&nt->link_cleanup, ntb_transport_link_cleanup); | 951 | INIT_WORK(&nt->link_cleanup, ntb_transport_link_cleanup_work); |
| 940 | 952 | ||
| 941 | rc = ntb_register_event_callback(nt->ndev, | 953 | rc = ntb_register_event_callback(nt->ndev, |
| 942 | ntb_transport_event_callback); | 954 | ntb_transport_event_callback); |
| @@ -972,7 +984,7 @@ void ntb_transport_free(void *transport) | |||
| 972 | struct ntb_device *ndev = nt->ndev; | 984 | struct ntb_device *ndev = nt->ndev; |
| 973 | int i; | 985 | int i; |
| 974 | 986 | ||
| 975 | nt->transport_link = NTB_LINK_DOWN; | 987 | ntb_transport_link_cleanup(nt); |
| 976 | 988 | ||
| 977 | /* verify that all the qp's are freed */ | 989 | /* verify that all the qp's are freed */ |
| 978 | for (i = 0; i < nt->max_qps; i++) { | 990 | for (i = 0; i < nt->max_qps; i++) { |
| @@ -1188,11 +1200,14 @@ err: | |||
| 1188 | goto out; | 1200 | goto out; |
| 1189 | } | 1201 | } |
| 1190 | 1202 | ||
| 1191 | static void ntb_transport_rx(unsigned long data) | 1203 | static int ntb_transport_rxc_db(void *data, int db_num) |
| 1192 | { | 1204 | { |
| 1193 | struct ntb_transport_qp *qp = (struct ntb_transport_qp *)data; | 1205 | struct ntb_transport_qp *qp = data; |
| 1194 | int rc, i; | 1206 | int rc, i; |
| 1195 | 1207 | ||
| 1208 | dev_dbg(&ntb_query_pdev(qp->ndev)->dev, "%s: doorbell %d received\n", | ||
| 1209 | __func__, db_num); | ||
| 1210 | |||
| 1196 | /* Limit the number of packets processed in a single interrupt to | 1211 | /* Limit the number of packets processed in a single interrupt to |
| 1197 | * provide fairness to others | 1212 | * provide fairness to others |
| 1198 | */ | 1213 | */ |
| @@ -1204,16 +1219,8 @@ static void ntb_transport_rx(unsigned long data) | |||
| 1204 | 1219 | ||
| 1205 | if (qp->dma_chan) | 1220 | if (qp->dma_chan) |
| 1206 | dma_async_issue_pending(qp->dma_chan); | 1221 | dma_async_issue_pending(qp->dma_chan); |
| 1207 | } | ||
| 1208 | |||
| 1209 | static void ntb_transport_rxc_db(void *data, int db_num) | ||
| 1210 | { | ||
| 1211 | struct ntb_transport_qp *qp = data; | ||
| 1212 | |||
| 1213 | dev_dbg(&ntb_query_pdev(qp->ndev)->dev, "%s: doorbell %d received\n", | ||
| 1214 | __func__, db_num); | ||
| 1215 | 1222 | ||
| 1216 | tasklet_schedule(&qp->rx_work); | 1223 | return i; |
| 1217 | } | 1224 | } |
| 1218 | 1225 | ||
| 1219 | static void ntb_tx_copy_callback(void *data) | 1226 | static void ntb_tx_copy_callback(void *data) |
| @@ -1432,11 +1439,12 @@ ntb_transport_create_queue(void *data, struct pci_dev *pdev, | |||
| 1432 | qp->tx_handler = handlers->tx_handler; | 1439 | qp->tx_handler = handlers->tx_handler; |
| 1433 | qp->event_handler = handlers->event_handler; | 1440 | qp->event_handler = handlers->event_handler; |
| 1434 | 1441 | ||
| 1442 | dmaengine_get(); | ||
| 1435 | qp->dma_chan = dma_find_channel(DMA_MEMCPY); | 1443 | qp->dma_chan = dma_find_channel(DMA_MEMCPY); |
| 1436 | if (!qp->dma_chan) | 1444 | if (!qp->dma_chan) { |
| 1445 | dmaengine_put(); | ||
| 1437 | dev_info(&pdev->dev, "Unable to allocate DMA channel, using CPU instead\n"); | 1446 | dev_info(&pdev->dev, "Unable to allocate DMA channel, using CPU instead\n"); |
| 1438 | else | 1447 | } |
| 1439 | dmaengine_get(); | ||
| 1440 | 1448 | ||
| 1441 | for (i = 0; i < NTB_QP_DEF_NUM_ENTRIES; i++) { | 1449 | for (i = 0; i < NTB_QP_DEF_NUM_ENTRIES; i++) { |
| 1442 | entry = kzalloc(sizeof(struct ntb_queue_entry), GFP_ATOMIC); | 1450 | entry = kzalloc(sizeof(struct ntb_queue_entry), GFP_ATOMIC); |
| @@ -1458,25 +1466,23 @@ ntb_transport_create_queue(void *data, struct pci_dev *pdev, | |||
| 1458 | &qp->tx_free_q); | 1466 | &qp->tx_free_q); |
| 1459 | } | 1467 | } |
| 1460 | 1468 | ||
| 1461 | tasklet_init(&qp->rx_work, ntb_transport_rx, (unsigned long) qp); | ||
| 1462 | |||
| 1463 | rc = ntb_register_db_callback(qp->ndev, free_queue, qp, | 1469 | rc = ntb_register_db_callback(qp->ndev, free_queue, qp, |
| 1464 | ntb_transport_rxc_db); | 1470 | ntb_transport_rxc_db); |
| 1465 | if (rc) | 1471 | if (rc) |
| 1466 | goto err3; | 1472 | goto err2; |
| 1467 | 1473 | ||
| 1468 | dev_info(&pdev->dev, "NTB Transport QP %d created\n", qp->qp_num); | 1474 | dev_info(&pdev->dev, "NTB Transport QP %d created\n", qp->qp_num); |
| 1469 | 1475 | ||
| 1470 | return qp; | 1476 | return qp; |
| 1471 | 1477 | ||
| 1472 | err3: | ||
| 1473 | tasklet_disable(&qp->rx_work); | ||
| 1474 | err2: | 1478 | err2: |
| 1475 | while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q))) | 1479 | while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q))) |
| 1476 | kfree(entry); | 1480 | kfree(entry); |
| 1477 | err1: | 1481 | err1: |
| 1478 | while ((entry = ntb_list_rm(&qp->ntb_rx_free_q_lock, &qp->rx_free_q))) | 1482 | while ((entry = ntb_list_rm(&qp->ntb_rx_free_q_lock, &qp->rx_free_q))) |
| 1479 | kfree(entry); | 1483 | kfree(entry); |
| 1484 | if (qp->dma_chan) | ||
| 1485 | dmaengine_put(); | ||
| 1480 | set_bit(free_queue, &nt->qp_bitmap); | 1486 | set_bit(free_queue, &nt->qp_bitmap); |
| 1481 | err: | 1487 | err: |
| 1482 | return NULL; | 1488 | return NULL; |
| @@ -1515,7 +1521,6 @@ void ntb_transport_free_queue(struct ntb_transport_qp *qp) | |||
| 1515 | } | 1521 | } |
| 1516 | 1522 | ||
| 1517 | ntb_unregister_db_callback(qp->ndev, qp->qp_num); | 1523 | ntb_unregister_db_callback(qp->ndev, qp->qp_num); |
| 1518 | tasklet_disable(&qp->rx_work); | ||
| 1519 | 1524 | ||
| 1520 | cancel_delayed_work_sync(&qp->link_work); | 1525 | cancel_delayed_work_sync(&qp->link_work); |
| 1521 | 1526 | ||
diff --git a/drivers/pci/host/pci-mvebu.c b/drivers/pci/host/pci-mvebu.c index c269e430c760..2aa7b77c7c88 100644 --- a/drivers/pci/host/pci-mvebu.c +++ b/drivers/pci/host/pci-mvebu.c | |||
| @@ -447,6 +447,11 @@ static int mvebu_sw_pci_bridge_read(struct mvebu_pcie_port *port, | |||
| 447 | *value = 0; | 447 | *value = 0; |
| 448 | break; | 448 | break; |
| 449 | 449 | ||
| 450 | case PCI_INTERRUPT_LINE: | ||
| 451 | /* LINE PIN MIN_GNT MAX_LAT */ | ||
| 452 | *value = 0; | ||
| 453 | break; | ||
| 454 | |||
| 450 | default: | 455 | default: |
| 451 | *value = 0xffffffff; | 456 | *value = 0xffffffff; |
| 452 | return PCIBIOS_BAD_REGISTER_NUMBER; | 457 | return PCIBIOS_BAD_REGISTER_NUMBER; |
diff --git a/drivers/pci/pci-driver.c b/drivers/pci/pci-driver.c index 9042fdbd7244..25f0bc659164 100644 --- a/drivers/pci/pci-driver.c +++ b/drivers/pci/pci-driver.c | |||
| @@ -19,6 +19,7 @@ | |||
| 19 | #include <linux/cpu.h> | 19 | #include <linux/cpu.h> |
| 20 | #include <linux/pm_runtime.h> | 20 | #include <linux/pm_runtime.h> |
| 21 | #include <linux/suspend.h> | 21 | #include <linux/suspend.h> |
| 22 | #include <linux/kexec.h> | ||
| 22 | #include "pci.h" | 23 | #include "pci.h" |
| 23 | 24 | ||
| 24 | struct pci_dynid { | 25 | struct pci_dynid { |
| @@ -288,12 +289,27 @@ static int pci_call_probe(struct pci_driver *drv, struct pci_dev *dev, | |||
| 288 | int error, node; | 289 | int error, node; |
| 289 | struct drv_dev_and_id ddi = { drv, dev, id }; | 290 | struct drv_dev_and_id ddi = { drv, dev, id }; |
| 290 | 291 | ||
| 291 | /* Execute driver initialization on node where the device's | 292 | /* |
| 292 | bus is attached to. This way the driver likely allocates | 293 | * Execute driver initialization on node where the device is |
| 293 | its local memory on the right node without any need to | 294 | * attached. This way the driver likely allocates its local memory |
| 294 | change it. */ | 295 | * on the right node. |
| 296 | */ | ||
| 295 | node = dev_to_node(&dev->dev); | 297 | node = dev_to_node(&dev->dev); |
| 296 | if (node >= 0) { | 298 | |
| 299 | /* | ||
| 300 | * On NUMA systems, we are likely to call a PF probe function using | ||
| 301 | * work_on_cpu(). If that probe calls pci_enable_sriov() (which | ||
| 302 | * adds the VF devices via pci_bus_add_device()), we may re-enter | ||
| 303 | * this function to call the VF probe function. Calling | ||
| 304 | * work_on_cpu() again will cause a lockdep warning. Since VFs are | ||
| 305 | * always on the same node as the PF, we can work around this by | ||
| 306 | * avoiding work_on_cpu() when we're already on the correct node. | ||
| 307 | * | ||
| 308 | * Preemption is enabled, so it's theoretically unsafe to use | ||
| 309 | * numa_node_id(), but even if we run the probe function on the | ||
| 310 | * wrong node, it should be functionally correct. | ||
| 311 | */ | ||
| 312 | if (node >= 0 && node != numa_node_id()) { | ||
| 297 | int cpu; | 313 | int cpu; |
| 298 | 314 | ||
| 299 | get_online_cpus(); | 315 | get_online_cpus(); |
| @@ -305,6 +321,7 @@ static int pci_call_probe(struct pci_driver *drv, struct pci_dev *dev, | |||
| 305 | put_online_cpus(); | 321 | put_online_cpus(); |
| 306 | } else | 322 | } else |
| 307 | error = local_pci_probe(&ddi); | 323 | error = local_pci_probe(&ddi); |
| 324 | |||
| 308 | return error; | 325 | return error; |
| 309 | } | 326 | } |
| 310 | 327 | ||
| @@ -399,12 +416,17 @@ static void pci_device_shutdown(struct device *dev) | |||
| 399 | pci_msi_shutdown(pci_dev); | 416 | pci_msi_shutdown(pci_dev); |
| 400 | pci_msix_shutdown(pci_dev); | 417 | pci_msix_shutdown(pci_dev); |
| 401 | 418 | ||
| 419 | #ifdef CONFIG_KEXEC | ||
| 402 | /* | 420 | /* |
| 403 | * Turn off Bus Master bit on the device to tell it to not | 421 | * If this is a kexec reboot, turn off Bus Master bit on the |
| 404 | * continue to do DMA. Don't touch devices in D3cold or unknown states. | 422 | * device to tell it to not continue to do DMA. Don't touch |
| 423 | * devices in D3cold or unknown states. | ||
| 424 | * If it is not a kexec reboot, firmware will hit the PCI | ||
| 425 | * devices with big hammer and stop their DMA any way. | ||
| 405 | */ | 426 | */ |
| 406 | if (pci_dev->current_state <= PCI_D3hot) | 427 | if (kexec_in_progress && (pci_dev->current_state <= PCI_D3hot)) |
| 407 | pci_clear_master(pci_dev); | 428 | pci_clear_master(pci_dev); |
| 429 | #endif | ||
| 408 | } | 430 | } |
| 409 | 431 | ||
| 410 | #ifdef CONFIG_PM | 432 | #ifdef CONFIG_PM |
diff --git a/drivers/pci/pci.c b/drivers/pci/pci.c index 33120d156668..07369f32e8bb 100644 --- a/drivers/pci/pci.c +++ b/drivers/pci/pci.c | |||
| @@ -4165,6 +4165,14 @@ int pci_set_vga_state(struct pci_dev *dev, bool decode, | |||
| 4165 | return 0; | 4165 | return 0; |
| 4166 | } | 4166 | } |
| 4167 | 4167 | ||
| 4168 | bool pci_device_is_present(struct pci_dev *pdev) | ||
| 4169 | { | ||
| 4170 | u32 v; | ||
| 4171 | |||
| 4172 | return pci_bus_read_dev_vendor_id(pdev->bus, pdev->devfn, &v, 0); | ||
| 4173 | } | ||
| 4174 | EXPORT_SYMBOL_GPL(pci_device_is_present); | ||
| 4175 | |||
| 4168 | #define RESOURCE_ALIGNMENT_PARAM_SIZE COMMAND_LINE_SIZE | 4176 | #define RESOURCE_ALIGNMENT_PARAM_SIZE COMMAND_LINE_SIZE |
| 4169 | static char resource_alignment_param[RESOURCE_ALIGNMENT_PARAM_SIZE] = {0}; | 4177 | static char resource_alignment_param[RESOURCE_ALIGNMENT_PARAM_SIZE] = {0}; |
| 4170 | static DEFINE_SPINLOCK(resource_alignment_lock); | 4178 | static DEFINE_SPINLOCK(resource_alignment_lock); |
diff --git a/drivers/pci/quirks.c b/drivers/pci/quirks.c index b3b1b9aa8863..3a02717473ad 100644 --- a/drivers/pci/quirks.c +++ b/drivers/pci/quirks.c | |||
| @@ -9,10 +9,6 @@ | |||
| 9 | * | 9 | * |
| 10 | * Init/reset quirks for USB host controllers should be in the | 10 | * Init/reset quirks for USB host controllers should be in the |
| 11 | * USB quirks file, where their drivers can access reuse it. | 11 | * USB quirks file, where their drivers can access reuse it. |
| 12 | * | ||
| 13 | * The bridge optimization stuff has been removed. If you really | ||
| 14 | * have a silly BIOS which is unable to set your host bridge right, | ||
| 15 | * use the PowerTweak utility (see http://powertweak.sourceforge.net). | ||
| 16 | */ | 12 | */ |
| 17 | 13 | ||
| 18 | #include <linux/types.h> | 14 | #include <linux/types.h> |
diff --git a/drivers/pci/remove.c b/drivers/pci/remove.c index 1576851028db..cc9337a71529 100644 --- a/drivers/pci/remove.c +++ b/drivers/pci/remove.c | |||
| @@ -24,7 +24,7 @@ static void pci_stop_dev(struct pci_dev *dev) | |||
| 24 | if (dev->is_added) { | 24 | if (dev->is_added) { |
| 25 | pci_proc_detach_device(dev); | 25 | pci_proc_detach_device(dev); |
| 26 | pci_remove_sysfs_dev_files(dev); | 26 | pci_remove_sysfs_dev_files(dev); |
| 27 | device_del(&dev->dev); | 27 | device_release_driver(&dev->dev); |
| 28 | dev->is_added = 0; | 28 | dev->is_added = 0; |
| 29 | } | 29 | } |
| 30 | 30 | ||
| @@ -34,6 +34,8 @@ static void pci_stop_dev(struct pci_dev *dev) | |||
| 34 | 34 | ||
| 35 | static void pci_destroy_dev(struct pci_dev *dev) | 35 | static void pci_destroy_dev(struct pci_dev *dev) |
| 36 | { | 36 | { |
| 37 | device_del(&dev->dev); | ||
| 38 | |||
| 37 | down_write(&pci_bus_sem); | 39 | down_write(&pci_bus_sem); |
| 38 | list_del(&dev->bus_list); | 40 | list_del(&dev->bus_list); |
| 39 | up_write(&pci_bus_sem); | 41 | up_write(&pci_bus_sem); |
diff --git a/drivers/pinctrl/pinctrl-abx500.c b/drivers/pinctrl/pinctrl-abx500.c index 4780959e11d4..5183e7bb8de3 100644 --- a/drivers/pinctrl/pinctrl-abx500.c +++ b/drivers/pinctrl/pinctrl-abx500.c | |||
| @@ -418,7 +418,7 @@ static int abx500_set_mode(struct pinctrl_dev *pctldev, struct gpio_chip *chip, | |||
| 418 | ret = abx500_gpio_set_bits(chip, | 418 | ret = abx500_gpio_set_bits(chip, |
| 419 | AB8500_GPIO_ALTFUN_REG, | 419 | AB8500_GPIO_ALTFUN_REG, |
| 420 | af.alt_bit1, | 420 | af.alt_bit1, |
| 421 | !!(af.alta_val && BIT(0))); | 421 | !!(af.alta_val & BIT(0))); |
| 422 | if (ret < 0) | 422 | if (ret < 0) |
| 423 | goto out; | 423 | goto out; |
| 424 | 424 | ||
| @@ -439,7 +439,7 @@ static int abx500_set_mode(struct pinctrl_dev *pctldev, struct gpio_chip *chip, | |||
| 439 | goto out; | 439 | goto out; |
| 440 | 440 | ||
| 441 | ret = abx500_gpio_set_bits(chip, AB8500_GPIO_ALTFUN_REG, | 441 | ret = abx500_gpio_set_bits(chip, AB8500_GPIO_ALTFUN_REG, |
| 442 | af.alt_bit1, !!(af.altb_val && BIT(0))); | 442 | af.alt_bit1, !!(af.altb_val & BIT(0))); |
| 443 | if (ret < 0) | 443 | if (ret < 0) |
| 444 | goto out; | 444 | goto out; |
| 445 | 445 | ||
| @@ -462,7 +462,7 @@ static int abx500_set_mode(struct pinctrl_dev *pctldev, struct gpio_chip *chip, | |||
| 462 | goto out; | 462 | goto out; |
| 463 | 463 | ||
| 464 | ret = abx500_gpio_set_bits(chip, AB8500_GPIO_ALTFUN_REG, | 464 | ret = abx500_gpio_set_bits(chip, AB8500_GPIO_ALTFUN_REG, |
| 465 | af.alt_bit2, !!(af.altc_val && BIT(1))); | 465 | af.alt_bit2, !!(af.altc_val & BIT(1))); |
| 466 | break; | 466 | break; |
| 467 | 467 | ||
| 468 | default: | 468 | default: |
diff --git a/drivers/pinctrl/pinctrl-abx500.h b/drivers/pinctrl/pinctrl-abx500.h index eeca8f973999..82293806e842 100644 --- a/drivers/pinctrl/pinctrl-abx500.h +++ b/drivers/pinctrl/pinctrl-abx500.h | |||
| @@ -1,4 +1,4 @@ | |||
| 1 | #ifndef PINCTRL_PINCTRL_ABx5O0_H | 1 | #ifndef PINCTRL_PINCTRL_ABx500_H |
| 2 | #define PINCTRL_PINCTRL_ABx500_H | 2 | #define PINCTRL_PINCTRL_ABx500_H |
| 3 | 3 | ||
| 4 | /* Package definitions */ | 4 | /* Package definitions */ |
diff --git a/drivers/pinctrl/pinctrl-rockchip.c b/drivers/pinctrl/pinctrl-rockchip.c index e939c28cbf1f..46dddc159286 100644 --- a/drivers/pinctrl/pinctrl-rockchip.c +++ b/drivers/pinctrl/pinctrl-rockchip.c | |||
| @@ -504,6 +504,7 @@ static int rockchip_set_pull(struct rockchip_pin_bank *bank, | |||
| 504 | data |= (3 << bit); | 504 | data |= (3 << bit); |
| 505 | break; | 505 | break; |
| 506 | default: | 506 | default: |
| 507 | spin_unlock_irqrestore(&bank->slock, flags); | ||
| 507 | dev_err(info->dev, "unsupported pull setting %d\n", | 508 | dev_err(info->dev, "unsupported pull setting %d\n", |
| 508 | pull); | 509 | pull); |
| 509 | return -EINVAL; | 510 | return -EINVAL; |
| @@ -1453,8 +1454,8 @@ static int rockchip_pinctrl_probe(struct platform_device *pdev) | |||
| 1453 | if (ctrl->type == RK3188) { | 1454 | if (ctrl->type == RK3188) { |
| 1454 | res = platform_get_resource(pdev, IORESOURCE_MEM, 1); | 1455 | res = platform_get_resource(pdev, IORESOURCE_MEM, 1); |
| 1455 | info->reg_pull = devm_ioremap_resource(&pdev->dev, res); | 1456 | info->reg_pull = devm_ioremap_resource(&pdev->dev, res); |
| 1456 | if (IS_ERR(info->reg_base)) | 1457 | if (IS_ERR(info->reg_pull)) |
| 1457 | return PTR_ERR(info->reg_base); | 1458 | return PTR_ERR(info->reg_pull); |
| 1458 | } | 1459 | } |
| 1459 | 1460 | ||
| 1460 | ret = rockchip_gpiolib_register(pdev, info); | 1461 | ret = rockchip_gpiolib_register(pdev, info); |
diff --git a/drivers/pinctrl/sh-pfc/pfc-r8a7740.c b/drivers/pinctrl/sh-pfc/pfc-r8a7740.c index 009174d07767..bc5eb453a45c 100644 --- a/drivers/pinctrl/sh-pfc/pfc-r8a7740.c +++ b/drivers/pinctrl/sh-pfc/pfc-r8a7740.c | |||
| @@ -3720,7 +3720,7 @@ static void __iomem *r8a7740_pinmux_portcr(struct sh_pfc *pfc, unsigned int pin) | |||
| 3720 | const struct r8a7740_portcr_group *group = | 3720 | const struct r8a7740_portcr_group *group = |
| 3721 | &r8a7740_portcr_offsets[i]; | 3721 | &r8a7740_portcr_offsets[i]; |
| 3722 | 3722 | ||
| 3723 | if (i <= group->end_pin) | 3723 | if (pin <= group->end_pin) |
| 3724 | return pfc->window->virt + group->offset + pin; | 3724 | return pfc->window->virt + group->offset + pin; |
| 3725 | } | 3725 | } |
| 3726 | 3726 | ||
diff --git a/drivers/pinctrl/sh-pfc/pfc-sh7372.c b/drivers/pinctrl/sh-pfc/pfc-sh7372.c index 70b522d34821..cc097b693820 100644 --- a/drivers/pinctrl/sh-pfc/pfc-sh7372.c +++ b/drivers/pinctrl/sh-pfc/pfc-sh7372.c | |||
| @@ -2584,7 +2584,7 @@ static void __iomem *sh7372_pinmux_portcr(struct sh_pfc *pfc, unsigned int pin) | |||
| 2584 | const struct sh7372_portcr_group *group = | 2584 | const struct sh7372_portcr_group *group = |
| 2585 | &sh7372_portcr_offsets[i]; | 2585 | &sh7372_portcr_offsets[i]; |
| 2586 | 2586 | ||
| 2587 | if (i <= group->end_pin) | 2587 | if (pin <= group->end_pin) |
| 2588 | return pfc->window->virt + group->offset + pin; | 2588 | return pfc->window->virt + group->offset + pin; |
| 2589 | } | 2589 | } |
| 2590 | 2590 | ||
diff --git a/drivers/platform/Kconfig b/drivers/platform/Kconfig index 69616aeaa966..09fde58b12e0 100644 --- a/drivers/platform/Kconfig +++ b/drivers/platform/Kconfig | |||
| @@ -5,3 +5,4 @@ if GOLDFISH | |||
| 5 | source "drivers/platform/goldfish/Kconfig" | 5 | source "drivers/platform/goldfish/Kconfig" |
| 6 | endif | 6 | endif |
| 7 | 7 | ||
| 8 | source "drivers/platform/chrome/Kconfig" | ||
diff --git a/drivers/platform/Makefile b/drivers/platform/Makefile index 8a44a4cd6d1e..3656b7b17b99 100644 --- a/drivers/platform/Makefile +++ b/drivers/platform/Makefile | |||
| @@ -5,3 +5,4 @@ | |||
| 5 | obj-$(CONFIG_X86) += x86/ | 5 | obj-$(CONFIG_X86) += x86/ |
| 6 | obj-$(CONFIG_OLPC) += olpc/ | 6 | obj-$(CONFIG_OLPC) += olpc/ |
| 7 | obj-$(CONFIG_GOLDFISH) += goldfish/ | 7 | obj-$(CONFIG_GOLDFISH) += goldfish/ |
| 8 | obj-$(CONFIG_CHROME_PLATFORMS) += chrome/ | ||
diff --git a/drivers/platform/chrome/Kconfig b/drivers/platform/chrome/Kconfig new file mode 100644 index 000000000000..b13303e75a34 --- /dev/null +++ b/drivers/platform/chrome/Kconfig | |||
| @@ -0,0 +1,28 @@ | |||
| 1 | # | ||
| 2 | # Platform support for Chrome OS hardware (Chromebooks and Chromeboxes) | ||
| 3 | # | ||
| 4 | |||
| 5 | menuconfig CHROME_PLATFORMS | ||
| 6 | bool "Platform support for Chrome hardware" | ||
| 7 | depends on X86 | ||
| 8 | ---help--- | ||
| 9 | Say Y here to get to see options for platform support for | ||
| 10 | various Chromebooks and Chromeboxes. This option alone does | ||
| 11 | not add any kernel code. | ||
| 12 | |||
| 13 | If you say N, all options in this submenu will be skipped and disabled. | ||
| 14 | |||
| 15 | if CHROME_PLATFORMS | ||
| 16 | |||
| 17 | config CHROMEOS_LAPTOP | ||
| 18 | tristate "Chrome OS Laptop" | ||
| 19 | depends on I2C | ||
| 20 | depends on DMI | ||
| 21 | ---help--- | ||
| 22 | This driver instantiates i2c and smbus devices such as | ||
| 23 | light sensors and touchpads. | ||
| 24 | |||
| 25 | If you have a supported Chromebook, choose Y or M here. | ||
| 26 | The module will be called chromeos_laptop. | ||
| 27 | |||
| 28 | endif # CHROMEOS_PLATFORMS | ||
diff --git a/drivers/platform/chrome/Makefile b/drivers/platform/chrome/Makefile new file mode 100644 index 000000000000..015e9195e226 --- /dev/null +++ b/drivers/platform/chrome/Makefile | |||
| @@ -0,0 +1,2 @@ | |||
| 1 | |||
| 2 | obj-$(CONFIG_CHROMEOS_LAPTOP) += chromeos_laptop.o | ||
diff --git a/drivers/platform/x86/chromeos_laptop.c b/drivers/platform/chrome/chromeos_laptop.c index 3e5b4497a1d0..3e5b4497a1d0 100644 --- a/drivers/platform/x86/chromeos_laptop.c +++ b/drivers/platform/chrome/chromeos_laptop.c | |||
diff --git a/drivers/platform/x86/Kconfig b/drivers/platform/x86/Kconfig index b51a7460cc49..d9dcd37b5a52 100644 --- a/drivers/platform/x86/Kconfig +++ b/drivers/platform/x86/Kconfig | |||
| @@ -79,17 +79,6 @@ config ASUS_LAPTOP | |||
| 79 | 79 | ||
| 80 | If you have an ACPI-compatible ASUS laptop, say Y or M here. | 80 | If you have an ACPI-compatible ASUS laptop, say Y or M here. |
| 81 | 81 | ||
| 82 | config CHROMEOS_LAPTOP | ||
| 83 | tristate "Chrome OS Laptop" | ||
| 84 | depends on I2C | ||
| 85 | depends on DMI | ||
| 86 | ---help--- | ||
| 87 | This driver instantiates i2c and smbus devices such as | ||
| 88 | light sensors and touchpads. | ||
| 89 | |||
| 90 | If you have a supported Chromebook, choose Y or M here. | ||
| 91 | The module will be called chromeos_laptop. | ||
| 92 | |||
| 93 | config DELL_LAPTOP | 82 | config DELL_LAPTOP |
| 94 | tristate "Dell Laptop Extras" | 83 | tristate "Dell Laptop Extras" |
| 95 | depends on X86 | 84 | depends on X86 |
diff --git a/drivers/platform/x86/Makefile b/drivers/platform/x86/Makefile index 5dbe19324351..f0e6aa407ffb 100644 --- a/drivers/platform/x86/Makefile +++ b/drivers/platform/x86/Makefile | |||
| @@ -50,7 +50,6 @@ obj-$(CONFIG_INTEL_MID_POWER_BUTTON) += intel_mid_powerbtn.o | |||
| 50 | obj-$(CONFIG_INTEL_OAKTRAIL) += intel_oaktrail.o | 50 | obj-$(CONFIG_INTEL_OAKTRAIL) += intel_oaktrail.o |
| 51 | obj-$(CONFIG_SAMSUNG_Q10) += samsung-q10.o | 51 | obj-$(CONFIG_SAMSUNG_Q10) += samsung-q10.o |
| 52 | obj-$(CONFIG_APPLE_GMUX) += apple-gmux.o | 52 | obj-$(CONFIG_APPLE_GMUX) += apple-gmux.o |
| 53 | obj-$(CONFIG_CHROMEOS_LAPTOP) += chromeos_laptop.o | ||
| 54 | obj-$(CONFIG_INTEL_RST) += intel-rst.o | 53 | obj-$(CONFIG_INTEL_RST) += intel-rst.o |
| 55 | obj-$(CONFIG_INTEL_SMARTCONNECT) += intel-smartconnect.o | 54 | obj-$(CONFIG_INTEL_SMARTCONNECT) += intel-smartconnect.o |
| 56 | 55 | ||
diff --git a/drivers/platform/x86/asus-laptop.c b/drivers/platform/x86/asus-laptop.c index 0e9c169b42f8..594323a926cf 100644 --- a/drivers/platform/x86/asus-laptop.c +++ b/drivers/platform/x86/asus-laptop.c | |||
| @@ -1494,10 +1494,9 @@ static int asus_input_init(struct asus_laptop *asus) | |||
| 1494 | int error; | 1494 | int error; |
| 1495 | 1495 | ||
| 1496 | input = input_allocate_device(); | 1496 | input = input_allocate_device(); |
| 1497 | if (!input) { | 1497 | if (!input) |
| 1498 | pr_warn("Unable to allocate input device\n"); | ||
| 1499 | return -ENOMEM; | 1498 | return -ENOMEM; |
| 1500 | } | 1499 | |
| 1501 | input->name = "Asus Laptop extra buttons"; | 1500 | input->name = "Asus Laptop extra buttons"; |
| 1502 | input->phys = ASUS_LAPTOP_FILE "/input0"; | 1501 | input->phys = ASUS_LAPTOP_FILE "/input0"; |
| 1503 | input->id.bustype = BUS_HOST; | 1502 | input->id.bustype = BUS_HOST; |
diff --git a/drivers/platform/x86/dell-laptop.c b/drivers/platform/x86/dell-laptop.c index bb77e18b3dd4..c608b1d33f4a 100644 --- a/drivers/platform/x86/dell-laptop.c +++ b/drivers/platform/x86/dell-laptop.c | |||
| @@ -21,6 +21,7 @@ | |||
| 21 | #include <linux/err.h> | 21 | #include <linux/err.h> |
| 22 | #include <linux/dmi.h> | 22 | #include <linux/dmi.h> |
| 23 | #include <linux/io.h> | 23 | #include <linux/io.h> |
| 24 | #include <linux/rfkill.h> | ||
| 24 | #include <linux/power_supply.h> | 25 | #include <linux/power_supply.h> |
| 25 | #include <linux/acpi.h> | 26 | #include <linux/acpi.h> |
| 26 | #include <linux/mm.h> | 27 | #include <linux/mm.h> |
| @@ -89,6 +90,13 @@ static struct platform_driver platform_driver = { | |||
| 89 | 90 | ||
| 90 | static struct platform_device *platform_device; | 91 | static struct platform_device *platform_device; |
| 91 | static struct backlight_device *dell_backlight_device; | 92 | static struct backlight_device *dell_backlight_device; |
| 93 | static struct rfkill *wifi_rfkill; | ||
| 94 | static struct rfkill *bluetooth_rfkill; | ||
| 95 | static struct rfkill *wwan_rfkill; | ||
| 96 | static bool force_rfkill; | ||
| 97 | |||
| 98 | module_param(force_rfkill, bool, 0444); | ||
| 99 | MODULE_PARM_DESC(force_rfkill, "enable rfkill on non whitelisted models"); | ||
| 92 | 100 | ||
| 93 | static const struct dmi_system_id dell_device_table[] __initconst = { | 101 | static const struct dmi_system_id dell_device_table[] __initconst = { |
| 94 | { | 102 | { |
| @@ -355,6 +363,108 @@ dell_send_request(struct calling_interface_buffer *buffer, int class, | |||
| 355 | return buffer; | 363 | return buffer; |
| 356 | } | 364 | } |
| 357 | 365 | ||
| 366 | /* Derived from information in DellWirelessCtl.cpp: | ||
| 367 | Class 17, select 11 is radio control. It returns an array of 32-bit values. | ||
| 368 | |||
| 369 | Input byte 0 = 0: Wireless information | ||
| 370 | |||
| 371 | result[0]: return code | ||
| 372 | result[1]: | ||
| 373 | Bit 0: Hardware switch supported | ||
| 374 | Bit 1: Wifi locator supported | ||
| 375 | Bit 2: Wifi is supported | ||
| 376 | Bit 3: Bluetooth is supported | ||
| 377 | Bit 4: WWAN is supported | ||
| 378 | Bit 5: Wireless keyboard supported | ||
| 379 | Bits 6-7: Reserved | ||
| 380 | Bit 8: Wifi is installed | ||
| 381 | Bit 9: Bluetooth is installed | ||
| 382 | Bit 10: WWAN is installed | ||
| 383 | Bits 11-15: Reserved | ||
| 384 | Bit 16: Hardware switch is on | ||
| 385 | Bit 17: Wifi is blocked | ||
| 386 | Bit 18: Bluetooth is blocked | ||
| 387 | Bit 19: WWAN is blocked | ||
| 388 | Bits 20-31: Reserved | ||
| 389 | result[2]: NVRAM size in bytes | ||
| 390 | result[3]: NVRAM format version number | ||
| 391 | |||
| 392 | Input byte 0 = 2: Wireless switch configuration | ||
| 393 | result[0]: return code | ||
| 394 | result[1]: | ||
| 395 | Bit 0: Wifi controlled by switch | ||
| 396 | Bit 1: Bluetooth controlled by switch | ||
| 397 | Bit 2: WWAN controlled by switch | ||
| 398 | Bits 3-6: Reserved | ||
| 399 | Bit 7: Wireless switch config locked | ||
| 400 | Bit 8: Wifi locator enabled | ||
| 401 | Bits 9-14: Reserved | ||
| 402 | Bit 15: Wifi locator setting locked | ||
| 403 | Bits 16-31: Reserved | ||
| 404 | */ | ||
| 405 | |||
| 406 | static int dell_rfkill_set(void *data, bool blocked) | ||
| 407 | { | ||
| 408 | int disable = blocked ? 1 : 0; | ||
| 409 | unsigned long radio = (unsigned long)data; | ||
| 410 | int hwswitch_bit = (unsigned long)data - 1; | ||
| 411 | |||
| 412 | get_buffer(); | ||
| 413 | dell_send_request(buffer, 17, 11); | ||
| 414 | |||
| 415 | /* If the hardware switch controls this radio, and the hardware | ||
| 416 | switch is disabled, always disable the radio */ | ||
| 417 | if ((hwswitch_state & BIT(hwswitch_bit)) && | ||
| 418 | !(buffer->output[1] & BIT(16))) | ||
| 419 | disable = 1; | ||
| 420 | |||
| 421 | buffer->input[0] = (1 | (radio<<8) | (disable << 16)); | ||
| 422 | dell_send_request(buffer, 17, 11); | ||
| 423 | |||
| 424 | release_buffer(); | ||
| 425 | return 0; | ||
| 426 | } | ||
| 427 | |||
| 428 | /* Must be called with the buffer held */ | ||
| 429 | static void dell_rfkill_update_sw_state(struct rfkill *rfkill, int radio, | ||
| 430 | int status) | ||
| 431 | { | ||
| 432 | if (status & BIT(0)) { | ||
| 433 | /* Has hw-switch, sync sw_state to BIOS */ | ||
| 434 | int block = rfkill_blocked(rfkill); | ||
| 435 | buffer->input[0] = (1 | (radio << 8) | (block << 16)); | ||
| 436 | dell_send_request(buffer, 17, 11); | ||
| 437 | } else { | ||
| 438 | /* No hw-switch, sync BIOS state to sw_state */ | ||
| 439 | rfkill_set_sw_state(rfkill, !!(status & BIT(radio + 16))); | ||
| 440 | } | ||
| 441 | } | ||
| 442 | |||
| 443 | static void dell_rfkill_update_hw_state(struct rfkill *rfkill, int radio, | ||
| 444 | int status) | ||
| 445 | { | ||
| 446 | if (hwswitch_state & (BIT(radio - 1))) | ||
| 447 | rfkill_set_hw_state(rfkill, !(status & BIT(16))); | ||
| 448 | } | ||
| 449 | |||
| 450 | static void dell_rfkill_query(struct rfkill *rfkill, void *data) | ||
| 451 | { | ||
| 452 | int status; | ||
| 453 | |||
| 454 | get_buffer(); | ||
| 455 | dell_send_request(buffer, 17, 11); | ||
| 456 | status = buffer->output[1]; | ||
| 457 | |||
| 458 | dell_rfkill_update_hw_state(rfkill, (unsigned long)data, status); | ||
| 459 | |||
| 460 | release_buffer(); | ||
| 461 | } | ||
| 462 | |||
| 463 | static const struct rfkill_ops dell_rfkill_ops = { | ||
| 464 | .set_block = dell_rfkill_set, | ||
| 465 | .query = dell_rfkill_query, | ||
| 466 | }; | ||
| 467 | |||
| 358 | static struct dentry *dell_laptop_dir; | 468 | static struct dentry *dell_laptop_dir; |
| 359 | 469 | ||
| 360 | static int dell_debugfs_show(struct seq_file *s, void *data) | 470 | static int dell_debugfs_show(struct seq_file *s, void *data) |
| @@ -424,6 +534,136 @@ static const struct file_operations dell_debugfs_fops = { | |||
| 424 | .release = single_release, | 534 | .release = single_release, |
| 425 | }; | 535 | }; |
| 426 | 536 | ||
| 537 | static void dell_update_rfkill(struct work_struct *ignored) | ||
| 538 | { | ||
| 539 | int status; | ||
| 540 | |||
| 541 | get_buffer(); | ||
| 542 | dell_send_request(buffer, 17, 11); | ||
| 543 | status = buffer->output[1]; | ||
| 544 | |||
| 545 | if (wifi_rfkill) { | ||
| 546 | dell_rfkill_update_hw_state(wifi_rfkill, 1, status); | ||
| 547 | dell_rfkill_update_sw_state(wifi_rfkill, 1, status); | ||
| 548 | } | ||
| 549 | if (bluetooth_rfkill) { | ||
| 550 | dell_rfkill_update_hw_state(bluetooth_rfkill, 2, status); | ||
| 551 | dell_rfkill_update_sw_state(bluetooth_rfkill, 2, status); | ||
| 552 | } | ||
| 553 | if (wwan_rfkill) { | ||
| 554 | dell_rfkill_update_hw_state(wwan_rfkill, 3, status); | ||
| 555 | dell_rfkill_update_sw_state(wwan_rfkill, 3, status); | ||
| 556 | } | ||
| 557 | |||
| 558 | release_buffer(); | ||
| 559 | } | ||
| 560 | static DECLARE_DELAYED_WORK(dell_rfkill_work, dell_update_rfkill); | ||
| 561 | |||
| 562 | |||
| 563 | static int __init dell_setup_rfkill(void) | ||
| 564 | { | ||
| 565 | int status; | ||
| 566 | int ret; | ||
| 567 | const char *product; | ||
| 568 | |||
| 569 | /* | ||
| 570 | * rfkill causes trouble on various non Latitudes, according to Dell | ||
| 571 | * actually testing the rfkill functionality is only done on Latitudes. | ||
| 572 | */ | ||
| 573 | product = dmi_get_system_info(DMI_PRODUCT_NAME); | ||
| 574 | if (!force_rfkill && (!product || strncmp(product, "Latitude", 8))) | ||
| 575 | return 0; | ||
| 576 | |||
| 577 | get_buffer(); | ||
| 578 | dell_send_request(buffer, 17, 11); | ||
| 579 | status = buffer->output[1]; | ||
| 580 | buffer->input[0] = 0x2; | ||
| 581 | dell_send_request(buffer, 17, 11); | ||
| 582 | hwswitch_state = buffer->output[1]; | ||
| 583 | release_buffer(); | ||
| 584 | |||
| 585 | if (!(status & BIT(0))) { | ||
| 586 | if (force_rfkill) { | ||
| 587 | /* No hwsitch, clear all hw-controlled bits */ | ||
| 588 | hwswitch_state &= ~7; | ||
| 589 | } else { | ||
| 590 | /* rfkill is only tested on laptops with a hwswitch */ | ||
| 591 | return 0; | ||
| 592 | } | ||
| 593 | } | ||
| 594 | |||
| 595 | if ((status & (1<<2|1<<8)) == (1<<2|1<<8)) { | ||
| 596 | wifi_rfkill = rfkill_alloc("dell-wifi", &platform_device->dev, | ||
| 597 | RFKILL_TYPE_WLAN, | ||
| 598 | &dell_rfkill_ops, (void *) 1); | ||
| 599 | if (!wifi_rfkill) { | ||
| 600 | ret = -ENOMEM; | ||
| 601 | goto err_wifi; | ||
| 602 | } | ||
| 603 | ret = rfkill_register(wifi_rfkill); | ||
| 604 | if (ret) | ||
| 605 | goto err_wifi; | ||
| 606 | } | ||
| 607 | |||
| 608 | if ((status & (1<<3|1<<9)) == (1<<3|1<<9)) { | ||
| 609 | bluetooth_rfkill = rfkill_alloc("dell-bluetooth", | ||
| 610 | &platform_device->dev, | ||
| 611 | RFKILL_TYPE_BLUETOOTH, | ||
| 612 | &dell_rfkill_ops, (void *) 2); | ||
| 613 | if (!bluetooth_rfkill) { | ||
| 614 | ret = -ENOMEM; | ||
| 615 | goto err_bluetooth; | ||
| 616 | } | ||
| 617 | ret = rfkill_register(bluetooth_rfkill); | ||
| 618 | if (ret) | ||
| 619 | goto err_bluetooth; | ||
| 620 | } | ||
| 621 | |||
| 622 | if ((status & (1<<4|1<<10)) == (1<<4|1<<10)) { | ||
| 623 | wwan_rfkill = rfkill_alloc("dell-wwan", | ||
| 624 | &platform_device->dev, | ||
| 625 | RFKILL_TYPE_WWAN, | ||
| 626 | &dell_rfkill_ops, (void *) 3); | ||
| 627 | if (!wwan_rfkill) { | ||
| 628 | ret = -ENOMEM; | ||
| 629 | goto err_wwan; | ||
| 630 | } | ||
| 631 | ret = rfkill_register(wwan_rfkill); | ||
| 632 | if (ret) | ||
| 633 | goto err_wwan; | ||
| 634 | } | ||
| 635 | |||
| 636 | return 0; | ||
| 637 | err_wwan: | ||
| 638 | rfkill_destroy(wwan_rfkill); | ||
| 639 | if (bluetooth_rfkill) | ||
| 640 | rfkill_unregister(bluetooth_rfkill); | ||
| 641 | err_bluetooth: | ||
| 642 | rfkill_destroy(bluetooth_rfkill); | ||
| 643 | if (wifi_rfkill) | ||
| 644 | rfkill_unregister(wifi_rfkill); | ||
| 645 | err_wifi: | ||
| 646 | rfkill_destroy(wifi_rfkill); | ||
| 647 | |||
| 648 | return ret; | ||
| 649 | } | ||
| 650 | |||
| 651 | static void dell_cleanup_rfkill(void) | ||
| 652 | { | ||
| 653 | if (wifi_rfkill) { | ||
| 654 | rfkill_unregister(wifi_rfkill); | ||
| 655 | rfkill_destroy(wifi_rfkill); | ||
| 656 | } | ||
| 657 | if (bluetooth_rfkill) { | ||
| 658 | rfkill_unregister(bluetooth_rfkill); | ||
| 659 | rfkill_destroy(bluetooth_rfkill); | ||
| 660 | } | ||
| 661 | if (wwan_rfkill) { | ||
| 662 | rfkill_unregister(wwan_rfkill); | ||
| 663 | rfkill_destroy(wwan_rfkill); | ||
| 664 | } | ||
| 665 | } | ||
| 666 | |||
| 427 | static int dell_send_intensity(struct backlight_device *bd) | 667 | static int dell_send_intensity(struct backlight_device *bd) |
| 428 | { | 668 | { |
| 429 | int ret = 0; | 669 | int ret = 0; |
| @@ -515,6 +755,30 @@ static void touchpad_led_exit(void) | |||
| 515 | led_classdev_unregister(&touchpad_led); | 755 | led_classdev_unregister(&touchpad_led); |
| 516 | } | 756 | } |
| 517 | 757 | ||
| 758 | static bool dell_laptop_i8042_filter(unsigned char data, unsigned char str, | ||
| 759 | struct serio *port) | ||
| 760 | { | ||
| 761 | static bool extended; | ||
| 762 | |||
| 763 | if (str & 0x20) | ||
| 764 | return false; | ||
| 765 | |||
| 766 | if (unlikely(data == 0xe0)) { | ||
| 767 | extended = true; | ||
| 768 | return false; | ||
| 769 | } else if (unlikely(extended)) { | ||
| 770 | switch (data) { | ||
| 771 | case 0x8: | ||
| 772 | schedule_delayed_work(&dell_rfkill_work, | ||
| 773 | round_jiffies_relative(HZ / 4)); | ||
| 774 | break; | ||
| 775 | } | ||
| 776 | extended = false; | ||
| 777 | } | ||
| 778 | |||
| 779 | return false; | ||
| 780 | } | ||
| 781 | |||
| 518 | static int __init dell_init(void) | 782 | static int __init dell_init(void) |
| 519 | { | 783 | { |
| 520 | int max_intensity = 0; | 784 | int max_intensity = 0; |
| @@ -557,10 +821,26 @@ static int __init dell_init(void) | |||
| 557 | } | 821 | } |
| 558 | buffer = page_address(bufferpage); | 822 | buffer = page_address(bufferpage); |
| 559 | 823 | ||
| 824 | ret = dell_setup_rfkill(); | ||
| 825 | |||
| 826 | if (ret) { | ||
| 827 | pr_warn("Unable to setup rfkill\n"); | ||
| 828 | goto fail_rfkill; | ||
| 829 | } | ||
| 830 | |||
| 831 | ret = i8042_install_filter(dell_laptop_i8042_filter); | ||
| 832 | if (ret) { | ||
| 833 | pr_warn("Unable to install key filter\n"); | ||
| 834 | goto fail_filter; | ||
| 835 | } | ||
| 836 | |||
| 560 | if (quirks && quirks->touchpad_led) | 837 | if (quirks && quirks->touchpad_led) |
| 561 | touchpad_led_init(&platform_device->dev); | 838 | touchpad_led_init(&platform_device->dev); |
| 562 | 839 | ||
| 563 | dell_laptop_dir = debugfs_create_dir("dell_laptop", NULL); | 840 | dell_laptop_dir = debugfs_create_dir("dell_laptop", NULL); |
| 841 | if (dell_laptop_dir != NULL) | ||
| 842 | debugfs_create_file("rfkill", 0444, dell_laptop_dir, NULL, | ||
| 843 | &dell_debugfs_fops); | ||
| 564 | 844 | ||
| 565 | #ifdef CONFIG_ACPI | 845 | #ifdef CONFIG_ACPI |
| 566 | /* In the event of an ACPI backlight being available, don't | 846 | /* In the event of an ACPI backlight being available, don't |
| @@ -603,6 +883,11 @@ static int __init dell_init(void) | |||
| 603 | return 0; | 883 | return 0; |
| 604 | 884 | ||
| 605 | fail_backlight: | 885 | fail_backlight: |
| 886 | i8042_remove_filter(dell_laptop_i8042_filter); | ||
| 887 | cancel_delayed_work_sync(&dell_rfkill_work); | ||
| 888 | fail_filter: | ||
| 889 | dell_cleanup_rfkill(); | ||
| 890 | fail_rfkill: | ||
| 606 | free_page((unsigned long)bufferpage); | 891 | free_page((unsigned long)bufferpage); |
| 607 | fail_buffer: | 892 | fail_buffer: |
| 608 | platform_device_del(platform_device); | 893 | platform_device_del(platform_device); |
| @@ -620,7 +905,10 @@ static void __exit dell_exit(void) | |||
| 620 | debugfs_remove_recursive(dell_laptop_dir); | 905 | debugfs_remove_recursive(dell_laptop_dir); |
| 621 | if (quirks && quirks->touchpad_led) | 906 | if (quirks && quirks->touchpad_led) |
| 622 | touchpad_led_exit(); | 907 | touchpad_led_exit(); |
| 908 | i8042_remove_filter(dell_laptop_i8042_filter); | ||
| 909 | cancel_delayed_work_sync(&dell_rfkill_work); | ||
| 623 | backlight_device_unregister(dell_backlight_device); | 910 | backlight_device_unregister(dell_backlight_device); |
| 911 | dell_cleanup_rfkill(); | ||
| 624 | if (platform_device) { | 912 | if (platform_device) { |
| 625 | platform_device_unregister(platform_device); | 913 | platform_device_unregister(platform_device); |
| 626 | platform_driver_unregister(&platform_driver); | 914 | platform_driver_unregister(&platform_driver); |
diff --git a/drivers/platform/x86/dell-wmi.c b/drivers/platform/x86/dell-wmi.c index fa9a2171cc13..60e0900bc117 100644 --- a/drivers/platform/x86/dell-wmi.c +++ b/drivers/platform/x86/dell-wmi.c | |||
| @@ -130,7 +130,8 @@ static const u16 bios_to_linux_keycode[256] __initconst = { | |||
| 130 | KEY_BRIGHTNESSUP, KEY_UNKNOWN, KEY_KBDILLUMTOGGLE, | 130 | KEY_BRIGHTNESSUP, KEY_UNKNOWN, KEY_KBDILLUMTOGGLE, |
| 131 | KEY_UNKNOWN, KEY_SWITCHVIDEOMODE, KEY_UNKNOWN, KEY_UNKNOWN, | 131 | KEY_UNKNOWN, KEY_SWITCHVIDEOMODE, KEY_UNKNOWN, KEY_UNKNOWN, |
| 132 | KEY_SWITCHVIDEOMODE, KEY_UNKNOWN, KEY_UNKNOWN, KEY_PROG2, | 132 | KEY_SWITCHVIDEOMODE, KEY_UNKNOWN, KEY_UNKNOWN, KEY_PROG2, |
| 133 | KEY_UNKNOWN, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 133 | KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, |
| 134 | KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_MICMUTE, | ||
| 134 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 135 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 135 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 136 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 136 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 137 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| @@ -139,8 +140,8 @@ static const u16 bios_to_linux_keycode[256] __initconst = { | |||
| 139 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 140 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 140 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 141 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 141 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 142 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 142 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, | 143 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 143 | KEY_PROG3 | 144 | 0, 0, 0, 0, 0, 0, 0, 0, 0, KEY_PROG3 |
| 144 | }; | 145 | }; |
| 145 | 146 | ||
| 146 | static struct input_dev *dell_wmi_input_dev; | 147 | static struct input_dev *dell_wmi_input_dev; |
diff --git a/drivers/platform/x86/eeepc-laptop.c b/drivers/platform/x86/eeepc-laptop.c index aefcc32e5634..dec68e7a99c7 100644 --- a/drivers/platform/x86/eeepc-laptop.c +++ b/drivers/platform/x86/eeepc-laptop.c | |||
| @@ -1203,10 +1203,8 @@ static int eeepc_input_init(struct eeepc_laptop *eeepc) | |||
| 1203 | int error; | 1203 | int error; |
| 1204 | 1204 | ||
| 1205 | input = input_allocate_device(); | 1205 | input = input_allocate_device(); |
| 1206 | if (!input) { | 1206 | if (!input) |
| 1207 | pr_info("Unable to allocate input device\n"); | ||
| 1208 | return -ENOMEM; | 1207 | return -ENOMEM; |
| 1209 | } | ||
| 1210 | 1208 | ||
| 1211 | input->name = "Asus EeePC extra buttons"; | 1209 | input->name = "Asus EeePC extra buttons"; |
| 1212 | input->phys = EEEPC_LAPTOP_FILE "/input0"; | 1210 | input->phys = EEEPC_LAPTOP_FILE "/input0"; |
diff --git a/drivers/platform/x86/hp-wmi.c b/drivers/platform/x86/hp-wmi.c index 1c86fa0857c8..8ba8956b5a48 100644 --- a/drivers/platform/x86/hp-wmi.c +++ b/drivers/platform/x86/hp-wmi.c | |||
| @@ -54,6 +54,7 @@ MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4"); | |||
| 54 | #define HPWMI_HARDWARE_QUERY 0x4 | 54 | #define HPWMI_HARDWARE_QUERY 0x4 |
| 55 | #define HPWMI_WIRELESS_QUERY 0x5 | 55 | #define HPWMI_WIRELESS_QUERY 0x5 |
| 56 | #define HPWMI_HOTKEY_QUERY 0xc | 56 | #define HPWMI_HOTKEY_QUERY 0xc |
| 57 | #define HPWMI_FEATURE_QUERY 0xd | ||
| 57 | #define HPWMI_WIRELESS2_QUERY 0x1b | 58 | #define HPWMI_WIRELESS2_QUERY 0x1b |
| 58 | #define HPWMI_POSTCODEERROR_QUERY 0x2a | 59 | #define HPWMI_POSTCODEERROR_QUERY 0x2a |
| 59 | 60 | ||
| @@ -292,6 +293,17 @@ static int hp_wmi_tablet_state(void) | |||
| 292 | return (state & 0x4) ? 1 : 0; | 293 | return (state & 0x4) ? 1 : 0; |
| 293 | } | 294 | } |
| 294 | 295 | ||
| 296 | static int hp_wmi_bios_2009_later(void) | ||
| 297 | { | ||
| 298 | int state = 0; | ||
| 299 | int ret = hp_wmi_perform_query(HPWMI_FEATURE_QUERY, 0, &state, | ||
| 300 | sizeof(state), sizeof(state)); | ||
| 301 | if (ret) | ||
| 302 | return ret; | ||
| 303 | |||
| 304 | return (state & 0x10) ? 1 : 0; | ||
| 305 | } | ||
| 306 | |||
| 295 | static int hp_wmi_set_block(void *data, bool blocked) | 307 | static int hp_wmi_set_block(void *data, bool blocked) |
| 296 | { | 308 | { |
| 297 | enum hp_wmi_radio r = (enum hp_wmi_radio) data; | 309 | enum hp_wmi_radio r = (enum hp_wmi_radio) data; |
| @@ -871,7 +883,7 @@ static int __init hp_wmi_bios_setup(struct platform_device *device) | |||
| 871 | gps_rfkill = NULL; | 883 | gps_rfkill = NULL; |
| 872 | rfkill2_count = 0; | 884 | rfkill2_count = 0; |
| 873 | 885 | ||
| 874 | if (hp_wmi_rfkill_setup(device)) | 886 | if (hp_wmi_bios_2009_later() || hp_wmi_rfkill_setup(device)) |
| 875 | hp_wmi_rfkill2_setup(device); | 887 | hp_wmi_rfkill2_setup(device); |
| 876 | 888 | ||
| 877 | err = device_create_file(&device->dev, &dev_attr_display); | 889 | err = device_create_file(&device->dev, &dev_attr_display); |
diff --git a/drivers/platform/x86/ideapad-laptop.c b/drivers/platform/x86/ideapad-laptop.c index 6788acc22ab9..19ec95147f69 100644 --- a/drivers/platform/x86/ideapad-laptop.c +++ b/drivers/platform/x86/ideapad-laptop.c | |||
| @@ -570,10 +570,8 @@ static int ideapad_input_init(struct ideapad_private *priv) | |||
| 570 | int error; | 570 | int error; |
| 571 | 571 | ||
| 572 | inputdev = input_allocate_device(); | 572 | inputdev = input_allocate_device(); |
| 573 | if (!inputdev) { | 573 | if (!inputdev) |
| 574 | pr_info("Unable to allocate input device\n"); | ||
| 575 | return -ENOMEM; | 574 | return -ENOMEM; |
| 576 | } | ||
| 577 | 575 | ||
| 578 | inputdev->name = "Ideapad extra buttons"; | 576 | inputdev->name = "Ideapad extra buttons"; |
| 579 | inputdev->phys = "ideapad/input0"; | 577 | inputdev->phys = "ideapad/input0"; |
diff --git a/drivers/platform/x86/intel_mid_powerbtn.c b/drivers/platform/x86/intel_mid_powerbtn.c index 6b18aba82cfa..8d6775266d66 100644 --- a/drivers/platform/x86/intel_mid_powerbtn.c +++ b/drivers/platform/x86/intel_mid_powerbtn.c | |||
| @@ -66,10 +66,8 @@ static int mfld_pb_probe(struct platform_device *pdev) | |||
| 66 | return -EINVAL; | 66 | return -EINVAL; |
| 67 | 67 | ||
| 68 | input = input_allocate_device(); | 68 | input = input_allocate_device(); |
| 69 | if (!input) { | 69 | if (!input) |
| 70 | dev_err(&pdev->dev, "Input device allocation error\n"); | ||
| 71 | return -ENOMEM; | 70 | return -ENOMEM; |
| 72 | } | ||
| 73 | 71 | ||
| 74 | input->name = pdev->name; | 72 | input->name = pdev->name; |
| 75 | input->phys = "power-button/input0"; | 73 | input->phys = "power-button/input0"; |
diff --git a/drivers/platform/x86/intel_scu_ipc.c b/drivers/platform/x86/intel_scu_ipc.c index d654f831410d..60ea476a9130 100644 --- a/drivers/platform/x86/intel_scu_ipc.c +++ b/drivers/platform/x86/intel_scu_ipc.c | |||
| @@ -58,12 +58,56 @@ | |||
| 58 | * message handler is called within firmware. | 58 | * message handler is called within firmware. |
| 59 | */ | 59 | */ |
| 60 | 60 | ||
| 61 | #define IPC_BASE_ADDR 0xFF11C000 /* IPC1 base register address */ | ||
| 62 | #define IPC_MAX_ADDR 0x100 /* Maximum IPC regisers */ | ||
| 63 | #define IPC_WWBUF_SIZE 20 /* IPC Write buffer Size */ | 61 | #define IPC_WWBUF_SIZE 20 /* IPC Write buffer Size */ |
| 64 | #define IPC_RWBUF_SIZE 20 /* IPC Read buffer Size */ | 62 | #define IPC_RWBUF_SIZE 20 /* IPC Read buffer Size */ |
| 65 | #define IPC_I2C_BASE 0xFF12B000 /* I2C control register base address */ | 63 | #define IPC_IOC 0x100 /* IPC command register IOC bit */ |
| 66 | #define IPC_I2C_MAX_ADDR 0x10 /* Maximum I2C regisers */ | 64 | |
| 65 | enum { | ||
| 66 | SCU_IPC_LINCROFT, | ||
| 67 | SCU_IPC_PENWELL, | ||
| 68 | SCU_IPC_CLOVERVIEW, | ||
| 69 | SCU_IPC_TANGIER, | ||
| 70 | }; | ||
| 71 | |||
| 72 | /* intel scu ipc driver data*/ | ||
| 73 | struct intel_scu_ipc_pdata_t { | ||
| 74 | u32 ipc_base; | ||
| 75 | u32 i2c_base; | ||
| 76 | u32 ipc_len; | ||
| 77 | u32 i2c_len; | ||
| 78 | u8 irq_mode; | ||
| 79 | }; | ||
| 80 | |||
| 81 | static struct intel_scu_ipc_pdata_t intel_scu_ipc_pdata[] = { | ||
| 82 | [SCU_IPC_LINCROFT] = { | ||
| 83 | .ipc_base = 0xff11c000, | ||
| 84 | .i2c_base = 0xff12b000, | ||
| 85 | .ipc_len = 0x100, | ||
| 86 | .i2c_len = 0x10, | ||
| 87 | .irq_mode = 0, | ||
| 88 | }, | ||
| 89 | [SCU_IPC_PENWELL] = { | ||
| 90 | .ipc_base = 0xff11c000, | ||
| 91 | .i2c_base = 0xff12b000, | ||
| 92 | .ipc_len = 0x100, | ||
| 93 | .i2c_len = 0x10, | ||
| 94 | .irq_mode = 1, | ||
| 95 | }, | ||
| 96 | [SCU_IPC_CLOVERVIEW] = { | ||
| 97 | .ipc_base = 0xff11c000, | ||
| 98 | .i2c_base = 0xff12b000, | ||
| 99 | .ipc_len = 0x100, | ||
| 100 | .i2c_len = 0x10, | ||
| 101 | .irq_mode = 1, | ||
| 102 | }, | ||
| 103 | [SCU_IPC_TANGIER] = { | ||
| 104 | .ipc_base = 0xff009000, | ||
| 105 | .i2c_base = 0xff00d000, | ||
| 106 | .ipc_len = 0x100, | ||
| 107 | .i2c_len = 0x10, | ||
| 108 | .irq_mode = 0, | ||
| 109 | }, | ||
| 110 | }; | ||
| 67 | 111 | ||
| 68 | static int ipc_probe(struct pci_dev *dev, const struct pci_device_id *id); | 112 | static int ipc_probe(struct pci_dev *dev, const struct pci_device_id *id); |
| 69 | static void ipc_remove(struct pci_dev *pdev); | 113 | static void ipc_remove(struct pci_dev *pdev); |
| @@ -72,6 +116,8 @@ struct intel_scu_ipc_dev { | |||
| 72 | struct pci_dev *pdev; | 116 | struct pci_dev *pdev; |
| 73 | void __iomem *ipc_base; | 117 | void __iomem *ipc_base; |
| 74 | void __iomem *i2c_base; | 118 | void __iomem *i2c_base; |
| 119 | struct completion cmd_complete; | ||
| 120 | u8 irq_mode; | ||
| 75 | }; | 121 | }; |
| 76 | 122 | ||
| 77 | static struct intel_scu_ipc_dev ipcdev; /* Only one for now */ | 123 | static struct intel_scu_ipc_dev ipcdev; /* Only one for now */ |
| @@ -98,6 +144,10 @@ static DEFINE_MUTEX(ipclock); /* lock used to prevent multiple call to SCU */ | |||
| 98 | */ | 144 | */ |
| 99 | static inline void ipc_command(u32 cmd) /* Send ipc command */ | 145 | static inline void ipc_command(u32 cmd) /* Send ipc command */ |
| 100 | { | 146 | { |
| 147 | if (ipcdev.irq_mode) { | ||
| 148 | reinit_completion(&ipcdev.cmd_complete); | ||
| 149 | writel(cmd | IPC_IOC, ipcdev.ipc_base); | ||
| 150 | } | ||
| 101 | writel(cmd, ipcdev.ipc_base); | 151 | writel(cmd, ipcdev.ipc_base); |
| 102 | } | 152 | } |
| 103 | 153 | ||
| @@ -156,6 +206,30 @@ static inline int busy_loop(void) /* Wait till scu status is busy */ | |||
| 156 | return 0; | 206 | return 0; |
| 157 | } | 207 | } |
| 158 | 208 | ||
| 209 | /* Wait till ipc ioc interrupt is received or timeout in 3 HZ */ | ||
| 210 | static inline int ipc_wait_for_interrupt(void) | ||
| 211 | { | ||
| 212 | int status; | ||
| 213 | |||
| 214 | if (!wait_for_completion_timeout(&ipcdev.cmd_complete, 3 * HZ)) { | ||
| 215 | struct device *dev = &ipcdev.pdev->dev; | ||
| 216 | dev_err(dev, "IPC timed out\n"); | ||
| 217 | return -ETIMEDOUT; | ||
| 218 | } | ||
| 219 | |||
| 220 | status = ipc_read_status(); | ||
| 221 | |||
| 222 | if ((status >> 1) & 1) | ||
| 223 | return -EIO; | ||
| 224 | |||
| 225 | return 0; | ||
| 226 | } | ||
| 227 | |||
| 228 | int intel_scu_ipc_check_status(void) | ||
| 229 | { | ||
| 230 | return ipcdev.irq_mode ? ipc_wait_for_interrupt() : busy_loop(); | ||
| 231 | } | ||
| 232 | |||
| 159 | /* Read/Write power control(PMIC in Langwell, MSIC in PenWell) registers */ | 233 | /* Read/Write power control(PMIC in Langwell, MSIC in PenWell) registers */ |
| 160 | static int pwr_reg_rdwr(u16 *addr, u8 *data, u32 count, u32 op, u32 id) | 234 | static int pwr_reg_rdwr(u16 *addr, u8 *data, u32 count, u32 op, u32 id) |
| 161 | { | 235 | { |
| @@ -196,8 +270,8 @@ static int pwr_reg_rdwr(u16 *addr, u8 *data, u32 count, u32 op, u32 id) | |||
| 196 | ipc_command(4 << 16 | id << 12 | 0 << 8 | op); | 270 | ipc_command(4 << 16 | id << 12 | 0 << 8 | op); |
| 197 | } | 271 | } |
| 198 | 272 | ||
| 199 | err = busy_loop(); | 273 | err = intel_scu_ipc_check_status(); |
| 200 | if (id == IPC_CMD_PCNTRL_R) { /* Read rbuf */ | 274 | if (!err && id == IPC_CMD_PCNTRL_R) { /* Read rbuf */ |
| 201 | /* Workaround: values are read as 0 without memcpy_fromio */ | 275 | /* Workaround: values are read as 0 without memcpy_fromio */ |
| 202 | memcpy_fromio(cbuf, ipcdev.ipc_base + 0x90, 16); | 276 | memcpy_fromio(cbuf, ipcdev.ipc_base + 0x90, 16); |
| 203 | for (nc = 0; nc < count; nc++) | 277 | for (nc = 0; nc < count; nc++) |
| @@ -391,7 +465,7 @@ int intel_scu_ipc_simple_command(int cmd, int sub) | |||
| 391 | return -ENODEV; | 465 | return -ENODEV; |
| 392 | } | 466 | } |
| 393 | ipc_command(sub << 12 | cmd); | 467 | ipc_command(sub << 12 | cmd); |
| 394 | err = busy_loop(); | 468 | err = intel_scu_ipc_check_status(); |
| 395 | mutex_unlock(&ipclock); | 469 | mutex_unlock(&ipclock); |
| 396 | return err; | 470 | return err; |
| 397 | } | 471 | } |
| @@ -425,10 +499,12 @@ int intel_scu_ipc_command(int cmd, int sub, u32 *in, int inlen, | |||
| 425 | ipc_data_writel(*in++, 4 * i); | 499 | ipc_data_writel(*in++, 4 * i); |
| 426 | 500 | ||
| 427 | ipc_command((inlen << 16) | (sub << 12) | cmd); | 501 | ipc_command((inlen << 16) | (sub << 12) | cmd); |
| 428 | err = busy_loop(); | 502 | err = intel_scu_ipc_check_status(); |
| 429 | 503 | ||
| 430 | for (i = 0; i < outlen; i++) | 504 | if (!err) { |
| 431 | *out++ = ipc_data_readl(4 * i); | 505 | for (i = 0; i < outlen; i++) |
| 506 | *out++ = ipc_data_readl(4 * i); | ||
| 507 | } | ||
| 432 | 508 | ||
| 433 | mutex_unlock(&ipclock); | 509 | mutex_unlock(&ipclock); |
| 434 | return err; | 510 | return err; |
| @@ -491,6 +567,9 @@ EXPORT_SYMBOL(intel_scu_ipc_i2c_cntrl); | |||
| 491 | */ | 567 | */ |
| 492 | static irqreturn_t ioc(int irq, void *dev_id) | 568 | static irqreturn_t ioc(int irq, void *dev_id) |
| 493 | { | 569 | { |
| 570 | if (ipcdev.irq_mode) | ||
| 571 | complete(&ipcdev.cmd_complete); | ||
| 572 | |||
| 494 | return IRQ_HANDLED; | 573 | return IRQ_HANDLED; |
| 495 | } | 574 | } |
| 496 | 575 | ||
| @@ -504,13 +583,18 @@ static irqreturn_t ioc(int irq, void *dev_id) | |||
| 504 | */ | 583 | */ |
| 505 | static int ipc_probe(struct pci_dev *dev, const struct pci_device_id *id) | 584 | static int ipc_probe(struct pci_dev *dev, const struct pci_device_id *id) |
| 506 | { | 585 | { |
| 507 | int err; | 586 | int err, pid; |
| 587 | struct intel_scu_ipc_pdata_t *pdata; | ||
| 508 | resource_size_t pci_resource; | 588 | resource_size_t pci_resource; |
| 509 | 589 | ||
| 510 | if (ipcdev.pdev) /* We support only one SCU */ | 590 | if (ipcdev.pdev) /* We support only one SCU */ |
| 511 | return -EBUSY; | 591 | return -EBUSY; |
| 512 | 592 | ||
| 593 | pid = id->driver_data; | ||
| 594 | pdata = &intel_scu_ipc_pdata[pid]; | ||
| 595 | |||
| 513 | ipcdev.pdev = pci_dev_get(dev); | 596 | ipcdev.pdev = pci_dev_get(dev); |
| 597 | ipcdev.irq_mode = pdata->irq_mode; | ||
| 514 | 598 | ||
| 515 | err = pci_enable_device(dev); | 599 | err = pci_enable_device(dev); |
| 516 | if (err) | 600 | if (err) |
| @@ -524,14 +608,16 @@ static int ipc_probe(struct pci_dev *dev, const struct pci_device_id *id) | |||
| 524 | if (!pci_resource) | 608 | if (!pci_resource) |
| 525 | return -ENOMEM; | 609 | return -ENOMEM; |
| 526 | 610 | ||
| 611 | init_completion(&ipcdev.cmd_complete); | ||
| 612 | |||
| 527 | if (request_irq(dev->irq, ioc, 0, "intel_scu_ipc", &ipcdev)) | 613 | if (request_irq(dev->irq, ioc, 0, "intel_scu_ipc", &ipcdev)) |
| 528 | return -EBUSY; | 614 | return -EBUSY; |
| 529 | 615 | ||
| 530 | ipcdev.ipc_base = ioremap_nocache(IPC_BASE_ADDR, IPC_MAX_ADDR); | 616 | ipcdev.ipc_base = ioremap_nocache(pdata->ipc_base, pdata->ipc_len); |
| 531 | if (!ipcdev.ipc_base) | 617 | if (!ipcdev.ipc_base) |
| 532 | return -ENOMEM; | 618 | return -ENOMEM; |
| 533 | 619 | ||
| 534 | ipcdev.i2c_base = ioremap_nocache(IPC_I2C_BASE, IPC_I2C_MAX_ADDR); | 620 | ipcdev.i2c_base = ioremap_nocache(pdata->i2c_base, pdata->i2c_len); |
| 535 | if (!ipcdev.i2c_base) { | 621 | if (!ipcdev.i2c_base) { |
| 536 | iounmap(ipcdev.ipc_base); | 622 | iounmap(ipcdev.ipc_base); |
| 537 | return -ENOMEM; | 623 | return -ENOMEM; |
| @@ -564,7 +650,10 @@ static void ipc_remove(struct pci_dev *pdev) | |||
| 564 | } | 650 | } |
| 565 | 651 | ||
| 566 | static DEFINE_PCI_DEVICE_TABLE(pci_ids) = { | 652 | static DEFINE_PCI_DEVICE_TABLE(pci_ids) = { |
| 567 | {PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x082a)}, | 653 | {PCI_VDEVICE(INTEL, 0x082a), SCU_IPC_LINCROFT}, |
| 654 | {PCI_VDEVICE(INTEL, 0x080e), SCU_IPC_PENWELL}, | ||
| 655 | {PCI_VDEVICE(INTEL, 0x08ea), SCU_IPC_CLOVERVIEW}, | ||
| 656 | {PCI_VDEVICE(INTEL, 0x11a0), SCU_IPC_TANGIER}, | ||
| 568 | { 0,} | 657 | { 0,} |
| 569 | }; | 658 | }; |
| 570 | MODULE_DEVICE_TABLE(pci, pci_ids); | 659 | MODULE_DEVICE_TABLE(pci, pci_ids); |
diff --git a/drivers/platform/x86/panasonic-laptop.c b/drivers/platform/x86/panasonic-laptop.c index 10d12b221601..3008fd20572e 100644 --- a/drivers/platform/x86/panasonic-laptop.c +++ b/drivers/platform/x86/panasonic-laptop.c | |||
| @@ -490,11 +490,8 @@ static int acpi_pcc_init_input(struct pcc_acpi *pcc) | |||
| 490 | int error; | 490 | int error; |
| 491 | 491 | ||
| 492 | input_dev = input_allocate_device(); | 492 | input_dev = input_allocate_device(); |
| 493 | if (!input_dev) { | 493 | if (!input_dev) |
| 494 | ACPI_DEBUG_PRINT((ACPI_DB_ERROR, | ||
| 495 | "Couldn't allocate input device for hotkey")); | ||
| 496 | return -ENOMEM; | 494 | return -ENOMEM; |
| 497 | } | ||
| 498 | 495 | ||
| 499 | input_dev->name = ACPI_PCC_DRIVER_NAME; | 496 | input_dev->name = ACPI_PCC_DRIVER_NAME; |
| 500 | input_dev->phys = ACPI_PCC_INPUT_PHYS; | 497 | input_dev->phys = ACPI_PCC_INPUT_PHYS; |
diff --git a/drivers/platform/x86/sony-laptop.c b/drivers/platform/x86/sony-laptop.c index 47caab0ea7a1..fb233ae7bb0e 100644 --- a/drivers/platform/x86/sony-laptop.c +++ b/drivers/platform/x86/sony-laptop.c | |||
| @@ -140,12 +140,12 @@ MODULE_PARM_DESC(kbd_backlight_timeout, | |||
| 140 | "on the model (default: no change from current value)"); | 140 | "on the model (default: no change from current value)"); |
| 141 | 141 | ||
| 142 | #ifdef CONFIG_PM_SLEEP | 142 | #ifdef CONFIG_PM_SLEEP |
| 143 | static void sony_nc_kbd_backlight_resume(void); | ||
| 144 | static void sony_nc_thermal_resume(void); | 143 | static void sony_nc_thermal_resume(void); |
| 145 | #endif | 144 | #endif |
| 146 | static int sony_nc_kbd_backlight_setup(struct platform_device *pd, | 145 | static int sony_nc_kbd_backlight_setup(struct platform_device *pd, |
| 147 | unsigned int handle); | 146 | unsigned int handle); |
| 148 | static void sony_nc_kbd_backlight_cleanup(struct platform_device *pd); | 147 | static void sony_nc_kbd_backlight_cleanup(struct platform_device *pd, |
| 148 | unsigned int handle); | ||
| 149 | 149 | ||
| 150 | static int sony_nc_battery_care_setup(struct platform_device *pd, | 150 | static int sony_nc_battery_care_setup(struct platform_device *pd, |
| 151 | unsigned int handle); | 151 | unsigned int handle); |
| @@ -304,8 +304,8 @@ static int sony_laptop_input_keycode_map[] = { | |||
| 304 | KEY_FN_F10, /* 14 SONYPI_EVENT_FNKEY_F10 */ | 304 | KEY_FN_F10, /* 14 SONYPI_EVENT_FNKEY_F10 */ |
| 305 | KEY_FN_F11, /* 15 SONYPI_EVENT_FNKEY_F11 */ | 305 | KEY_FN_F11, /* 15 SONYPI_EVENT_FNKEY_F11 */ |
| 306 | KEY_FN_F12, /* 16 SONYPI_EVENT_FNKEY_F12 */ | 306 | KEY_FN_F12, /* 16 SONYPI_EVENT_FNKEY_F12 */ |
| 307 | KEY_FN_F1, /* 17 SONYPI_EVENT_FNKEY_1 */ | 307 | KEY_FN_1, /* 17 SONYPI_EVENT_FNKEY_1 */ |
| 308 | KEY_FN_F2, /* 18 SONYPI_EVENT_FNKEY_2 */ | 308 | KEY_FN_2, /* 18 SONYPI_EVENT_FNKEY_2 */ |
| 309 | KEY_FN_D, /* 19 SONYPI_EVENT_FNKEY_D */ | 309 | KEY_FN_D, /* 19 SONYPI_EVENT_FNKEY_D */ |
| 310 | KEY_FN_E, /* 20 SONYPI_EVENT_FNKEY_E */ | 310 | KEY_FN_E, /* 20 SONYPI_EVENT_FNKEY_E */ |
| 311 | KEY_FN_F, /* 21 SONYPI_EVENT_FNKEY_F */ | 311 | KEY_FN_F, /* 21 SONYPI_EVENT_FNKEY_F */ |
| @@ -1444,7 +1444,7 @@ static void sony_nc_function_cleanup(struct platform_device *pd) | |||
| 1444 | case 0x014b: | 1444 | case 0x014b: |
| 1445 | case 0x014c: | 1445 | case 0x014c: |
| 1446 | case 0x0163: | 1446 | case 0x0163: |
| 1447 | sony_nc_kbd_backlight_cleanup(pd); | 1447 | sony_nc_kbd_backlight_cleanup(pd, handle); |
| 1448 | break; | 1448 | break; |
| 1449 | default: | 1449 | default: |
| 1450 | continue; | 1450 | continue; |
| @@ -1486,13 +1486,6 @@ static void sony_nc_function_resume(void) | |||
| 1486 | case 0x0135: | 1486 | case 0x0135: |
| 1487 | sony_nc_rfkill_update(); | 1487 | sony_nc_rfkill_update(); |
| 1488 | break; | 1488 | break; |
| 1489 | case 0x0137: | ||
| 1490 | case 0x0143: | ||
| 1491 | case 0x014b: | ||
| 1492 | case 0x014c: | ||
| 1493 | case 0x0163: | ||
| 1494 | sony_nc_kbd_backlight_resume(); | ||
| 1495 | break; | ||
| 1496 | default: | 1489 | default: |
| 1497 | continue; | 1490 | continue; |
| 1498 | } | 1491 | } |
| @@ -1822,6 +1815,12 @@ static int sony_nc_kbd_backlight_setup(struct platform_device *pd, | |||
| 1822 | int result; | 1815 | int result; |
| 1823 | int ret = 0; | 1816 | int ret = 0; |
| 1824 | 1817 | ||
| 1818 | if (kbdbl_ctl) { | ||
| 1819 | pr_warn("handle 0x%.4x: keyboard backlight setup already done for 0x%.4x\n", | ||
| 1820 | handle, kbdbl_ctl->handle); | ||
| 1821 | return -EBUSY; | ||
| 1822 | } | ||
| 1823 | |||
| 1825 | /* verify the kbd backlight presence, these handles are not used for | 1824 | /* verify the kbd backlight presence, these handles are not used for |
| 1826 | * keyboard backlight only | 1825 | * keyboard backlight only |
| 1827 | */ | 1826 | */ |
| @@ -1881,9 +1880,10 @@ outkzalloc: | |||
| 1881 | return ret; | 1880 | return ret; |
| 1882 | } | 1881 | } |
| 1883 | 1882 | ||
| 1884 | static void sony_nc_kbd_backlight_cleanup(struct platform_device *pd) | 1883 | static void sony_nc_kbd_backlight_cleanup(struct platform_device *pd, |
| 1884 | unsigned int handle) | ||
| 1885 | { | 1885 | { |
| 1886 | if (kbdbl_ctl) { | 1886 | if (kbdbl_ctl && handle == kbdbl_ctl->handle) { |
| 1887 | device_remove_file(&pd->dev, &kbdbl_ctl->mode_attr); | 1887 | device_remove_file(&pd->dev, &kbdbl_ctl->mode_attr); |
| 1888 | device_remove_file(&pd->dev, &kbdbl_ctl->timeout_attr); | 1888 | device_remove_file(&pd->dev, &kbdbl_ctl->timeout_attr); |
| 1889 | kfree(kbdbl_ctl); | 1889 | kfree(kbdbl_ctl); |
| @@ -1891,25 +1891,6 @@ static void sony_nc_kbd_backlight_cleanup(struct platform_device *pd) | |||
| 1891 | } | 1891 | } |
| 1892 | } | 1892 | } |
| 1893 | 1893 | ||
| 1894 | #ifdef CONFIG_PM_SLEEP | ||
| 1895 | static void sony_nc_kbd_backlight_resume(void) | ||
| 1896 | { | ||
| 1897 | int ignore = 0; | ||
| 1898 | |||
| 1899 | if (!kbdbl_ctl) | ||
| 1900 | return; | ||
| 1901 | |||
| 1902 | if (kbdbl_ctl->mode == 0) | ||
| 1903 | sony_call_snc_handle(kbdbl_ctl->handle, kbdbl_ctl->base, | ||
| 1904 | &ignore); | ||
| 1905 | |||
| 1906 | if (kbdbl_ctl->timeout != 0) | ||
| 1907 | sony_call_snc_handle(kbdbl_ctl->handle, | ||
| 1908 | (kbdbl_ctl->base + 0x200) | | ||
| 1909 | (kbdbl_ctl->timeout << 0x10), &ignore); | ||
| 1910 | } | ||
| 1911 | #endif | ||
| 1912 | |||
| 1913 | struct battery_care_control { | 1894 | struct battery_care_control { |
| 1914 | struct device_attribute attrs[2]; | 1895 | struct device_attribute attrs[2]; |
| 1915 | unsigned int handle; | 1896 | unsigned int handle; |
diff --git a/drivers/platform/x86/thinkpad_acpi.c b/drivers/platform/x86/thinkpad_acpi.c index 05e046aa5e31..58b0274d24cc 100644 --- a/drivers/platform/x86/thinkpad_acpi.c +++ b/drivers/platform/x86/thinkpad_acpi.c | |||
| @@ -6438,7 +6438,12 @@ static struct ibm_struct brightness_driver_data = { | |||
| 6438 | #define TPACPI_ALSA_SHRTNAME "ThinkPad Console Audio Control" | 6438 | #define TPACPI_ALSA_SHRTNAME "ThinkPad Console Audio Control" |
| 6439 | #define TPACPI_ALSA_MIXERNAME TPACPI_ALSA_SHRTNAME | 6439 | #define TPACPI_ALSA_MIXERNAME TPACPI_ALSA_SHRTNAME |
| 6440 | 6440 | ||
| 6441 | static int alsa_index = ~((1 << (SNDRV_CARDS - 3)) - 1); /* last three slots */ | 6441 | #if SNDRV_CARDS <= 32 |
| 6442 | #define DEFAULT_ALSA_IDX ~((1 << (SNDRV_CARDS - 3)) - 1) | ||
| 6443 | #else | ||
| 6444 | #define DEFAULT_ALSA_IDX ~((1 << (32 - 3)) - 1) | ||
| 6445 | #endif | ||
| 6446 | static int alsa_index = DEFAULT_ALSA_IDX; /* last three slots */ | ||
| 6442 | static char *alsa_id = "ThinkPadEC"; | 6447 | static char *alsa_id = "ThinkPadEC"; |
| 6443 | static bool alsa_enable = SNDRV_DEFAULT_ENABLE1; | 6448 | static bool alsa_enable = SNDRV_DEFAULT_ENABLE1; |
| 6444 | 6449 | ||
| @@ -9163,7 +9168,6 @@ static int __init thinkpad_acpi_module_init(void) | |||
| 9163 | mutex_init(&tpacpi_inputdev_send_mutex); | 9168 | mutex_init(&tpacpi_inputdev_send_mutex); |
| 9164 | tpacpi_inputdev = input_allocate_device(); | 9169 | tpacpi_inputdev = input_allocate_device(); |
| 9165 | if (!tpacpi_inputdev) { | 9170 | if (!tpacpi_inputdev) { |
| 9166 | pr_err("unable to allocate input device\n"); | ||
| 9167 | thinkpad_acpi_module_exit(); | 9171 | thinkpad_acpi_module_exit(); |
| 9168 | return -ENOMEM; | 9172 | return -ENOMEM; |
| 9169 | } else { | 9173 | } else { |
diff --git a/drivers/platform/x86/topstar-laptop.c b/drivers/platform/x86/topstar-laptop.c index 67897c8740ba..e597de05e6c2 100644 --- a/drivers/platform/x86/topstar-laptop.c +++ b/drivers/platform/x86/topstar-laptop.c | |||
| @@ -97,10 +97,8 @@ static int acpi_topstar_init_hkey(struct topstar_hkey *hkey) | |||
| 97 | int error; | 97 | int error; |
| 98 | 98 | ||
| 99 | input = input_allocate_device(); | 99 | input = input_allocate_device(); |
| 100 | if (!input) { | 100 | if (!input) |
| 101 | pr_err("Unable to allocate input device\n"); | ||
| 102 | return -ENOMEM; | 101 | return -ENOMEM; |
| 103 | } | ||
| 104 | 102 | ||
| 105 | input->name = "Topstar Laptop extra buttons"; | 103 | input->name = "Topstar Laptop extra buttons"; |
| 106 | input->phys = "topstar/input0"; | 104 | input->phys = "topstar/input0"; |
diff --git a/drivers/platform/x86/toshiba_acpi.c b/drivers/platform/x86/toshiba_acpi.c index 0cfadb65f7c6..7fce391818d3 100644 --- a/drivers/platform/x86/toshiba_acpi.c +++ b/drivers/platform/x86/toshiba_acpi.c | |||
| @@ -975,10 +975,8 @@ static int toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev) | |||
| 975 | u32 hci_result; | 975 | u32 hci_result; |
| 976 | 976 | ||
| 977 | dev->hotkey_dev = input_allocate_device(); | 977 | dev->hotkey_dev = input_allocate_device(); |
| 978 | if (!dev->hotkey_dev) { | 978 | if (!dev->hotkey_dev) |
| 979 | pr_info("Unable to register input device\n"); | ||
| 980 | return -ENOMEM; | 979 | return -ENOMEM; |
| 981 | } | ||
| 982 | 980 | ||
| 983 | dev->hotkey_dev->name = "Toshiba input device"; | 981 | dev->hotkey_dev->name = "Toshiba input device"; |
| 984 | dev->hotkey_dev->phys = "toshiba_acpi/input0"; | 982 | dev->hotkey_dev->phys = "toshiba_acpi/input0"; |
diff --git a/drivers/platform/x86/wmi.c b/drivers/platform/x86/wmi.c index 62e8c221d01e..c2e7b2657aeb 100644 --- a/drivers/platform/x86/wmi.c +++ b/drivers/platform/x86/wmi.c | |||
| @@ -672,8 +672,10 @@ static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, | |||
| 672 | struct wmi_block *wblock; | 672 | struct wmi_block *wblock; |
| 673 | 673 | ||
| 674 | wblock = dev_get_drvdata(dev); | 674 | wblock = dev_get_drvdata(dev); |
| 675 | if (!wblock) | 675 | if (!wblock) { |
| 676 | return -ENOMEM; | 676 | strcat(buf, "\n"); |
| 677 | return strlen(buf); | ||
| 678 | } | ||
| 677 | 679 | ||
| 678 | wmi_gtoa(wblock->gblock.guid, guid_string); | 680 | wmi_gtoa(wblock->gblock.guid, guid_string); |
| 679 | 681 | ||
diff --git a/drivers/pnp/driver.c b/drivers/pnp/driver.c index 6936e0acedcd..f748cc8cbb03 100644 --- a/drivers/pnp/driver.c +++ b/drivers/pnp/driver.c | |||
| @@ -197,6 +197,11 @@ static int pnp_bus_freeze(struct device *dev) | |||
| 197 | return __pnp_bus_suspend(dev, PMSG_FREEZE); | 197 | return __pnp_bus_suspend(dev, PMSG_FREEZE); |
| 198 | } | 198 | } |
| 199 | 199 | ||
| 200 | static int pnp_bus_poweroff(struct device *dev) | ||
| 201 | { | ||
| 202 | return __pnp_bus_suspend(dev, PMSG_HIBERNATE); | ||
| 203 | } | ||
| 204 | |||
| 200 | static int pnp_bus_resume(struct device *dev) | 205 | static int pnp_bus_resume(struct device *dev) |
| 201 | { | 206 | { |
| 202 | struct pnp_dev *pnp_dev = to_pnp_dev(dev); | 207 | struct pnp_dev *pnp_dev = to_pnp_dev(dev); |
| @@ -234,9 +239,14 @@ static int pnp_bus_resume(struct device *dev) | |||
| 234 | } | 239 | } |
| 235 | 240 | ||
| 236 | static const struct dev_pm_ops pnp_bus_dev_pm_ops = { | 241 | static const struct dev_pm_ops pnp_bus_dev_pm_ops = { |
| 242 | /* Suspend callbacks */ | ||
| 237 | .suspend = pnp_bus_suspend, | 243 | .suspend = pnp_bus_suspend, |
| 238 | .freeze = pnp_bus_freeze, | ||
| 239 | .resume = pnp_bus_resume, | 244 | .resume = pnp_bus_resume, |
| 245 | /* Hibernate callbacks */ | ||
| 246 | .freeze = pnp_bus_freeze, | ||
| 247 | .thaw = pnp_bus_resume, | ||
| 248 | .poweroff = pnp_bus_poweroff, | ||
| 249 | .restore = pnp_bus_resume, | ||
| 240 | }; | 250 | }; |
| 241 | 251 | ||
| 242 | struct bus_type pnp_bus_type = { | 252 | struct bus_type pnp_bus_type = { |
diff --git a/drivers/powercap/powercap_sys.c b/drivers/powercap/powercap_sys.c index 8d0fe431dbdd..84419af16f77 100644 --- a/drivers/powercap/powercap_sys.c +++ b/drivers/powercap/powercap_sys.c | |||
| @@ -377,9 +377,14 @@ static void create_power_zone_common_attributes( | |||
| 377 | if (power_zone->ops->get_max_energy_range_uj) | 377 | if (power_zone->ops->get_max_energy_range_uj) |
| 378 | power_zone->zone_dev_attrs[count++] = | 378 | power_zone->zone_dev_attrs[count++] = |
| 379 | &dev_attr_max_energy_range_uj.attr; | 379 | &dev_attr_max_energy_range_uj.attr; |
| 380 | if (power_zone->ops->get_energy_uj) | 380 | if (power_zone->ops->get_energy_uj) { |
| 381 | if (power_zone->ops->reset_energy_uj) | ||
| 382 | dev_attr_energy_uj.attr.mode = S_IWUSR | S_IRUGO; | ||
| 383 | else | ||
| 384 | dev_attr_energy_uj.attr.mode = S_IRUGO; | ||
| 381 | power_zone->zone_dev_attrs[count++] = | 385 | power_zone->zone_dev_attrs[count++] = |
| 382 | &dev_attr_energy_uj.attr; | 386 | &dev_attr_energy_uj.attr; |
| 387 | } | ||
| 383 | if (power_zone->ops->get_power_uw) | 388 | if (power_zone->ops->get_power_uw) |
| 384 | power_zone->zone_dev_attrs[count++] = | 389 | power_zone->zone_dev_attrs[count++] = |
| 385 | &dev_attr_power_uw.attr; | 390 | &dev_attr_power_uw.attr; |
diff --git a/drivers/regulator/arizona-micsupp.c b/drivers/regulator/arizona-micsupp.c index 724706a97dc4..fd3154d86901 100644 --- a/drivers/regulator/arizona-micsupp.c +++ b/drivers/regulator/arizona-micsupp.c | |||
| @@ -174,6 +174,33 @@ static const struct regulator_desc arizona_micsupp = { | |||
| 174 | .owner = THIS_MODULE, | 174 | .owner = THIS_MODULE, |
| 175 | }; | 175 | }; |
| 176 | 176 | ||
| 177 | static const struct regulator_linear_range arizona_micsupp_ext_ranges[] = { | ||
| 178 | REGULATOR_LINEAR_RANGE(900000, 0, 0x14, 25000), | ||
| 179 | REGULATOR_LINEAR_RANGE(1500000, 0x15, 0x27, 100000), | ||
| 180 | }; | ||
| 181 | |||
| 182 | static const struct regulator_desc arizona_micsupp_ext = { | ||
| 183 | .name = "MICVDD", | ||
| 184 | .supply_name = "CPVDD", | ||
| 185 | .type = REGULATOR_VOLTAGE, | ||
| 186 | .n_voltages = 40, | ||
| 187 | .ops = &arizona_micsupp_ops, | ||
| 188 | |||
| 189 | .vsel_reg = ARIZONA_LDO2_CONTROL_1, | ||
| 190 | .vsel_mask = ARIZONA_LDO2_VSEL_MASK, | ||
| 191 | .enable_reg = ARIZONA_MIC_CHARGE_PUMP_1, | ||
| 192 | .enable_mask = ARIZONA_CPMIC_ENA, | ||
| 193 | .bypass_reg = ARIZONA_MIC_CHARGE_PUMP_1, | ||
| 194 | .bypass_mask = ARIZONA_CPMIC_BYPASS, | ||
| 195 | |||
| 196 | .linear_ranges = arizona_micsupp_ext_ranges, | ||
| 197 | .n_linear_ranges = ARRAY_SIZE(arizona_micsupp_ext_ranges), | ||
| 198 | |||
| 199 | .enable_time = 3000, | ||
| 200 | |||
| 201 | .owner = THIS_MODULE, | ||
| 202 | }; | ||
| 203 | |||
| 177 | static const struct regulator_init_data arizona_micsupp_default = { | 204 | static const struct regulator_init_data arizona_micsupp_default = { |
| 178 | .constraints = { | 205 | .constraints = { |
| 179 | .valid_ops_mask = REGULATOR_CHANGE_STATUS | | 206 | .valid_ops_mask = REGULATOR_CHANGE_STATUS | |
| @@ -186,9 +213,22 @@ static const struct regulator_init_data arizona_micsupp_default = { | |||
| 186 | .num_consumer_supplies = 1, | 213 | .num_consumer_supplies = 1, |
| 187 | }; | 214 | }; |
| 188 | 215 | ||
| 216 | static const struct regulator_init_data arizona_micsupp_ext_default = { | ||
| 217 | .constraints = { | ||
| 218 | .valid_ops_mask = REGULATOR_CHANGE_STATUS | | ||
| 219 | REGULATOR_CHANGE_VOLTAGE | | ||
| 220 | REGULATOR_CHANGE_BYPASS, | ||
| 221 | .min_uV = 900000, | ||
| 222 | .max_uV = 3300000, | ||
| 223 | }, | ||
| 224 | |||
| 225 | .num_consumer_supplies = 1, | ||
| 226 | }; | ||
| 227 | |||
| 189 | static int arizona_micsupp_probe(struct platform_device *pdev) | 228 | static int arizona_micsupp_probe(struct platform_device *pdev) |
| 190 | { | 229 | { |
| 191 | struct arizona *arizona = dev_get_drvdata(pdev->dev.parent); | 230 | struct arizona *arizona = dev_get_drvdata(pdev->dev.parent); |
| 231 | const struct regulator_desc *desc; | ||
| 192 | struct regulator_config config = { }; | 232 | struct regulator_config config = { }; |
| 193 | struct arizona_micsupp *micsupp; | 233 | struct arizona_micsupp *micsupp; |
| 194 | int ret; | 234 | int ret; |
| @@ -207,7 +247,17 @@ static int arizona_micsupp_probe(struct platform_device *pdev) | |||
| 207 | * default init_data for it. This will be overridden with | 247 | * default init_data for it. This will be overridden with |
| 208 | * platform data if provided. | 248 | * platform data if provided. |
| 209 | */ | 249 | */ |
| 210 | micsupp->init_data = arizona_micsupp_default; | 250 | switch (arizona->type) { |
| 251 | case WM5110: | ||
| 252 | desc = &arizona_micsupp_ext; | ||
| 253 | micsupp->init_data = arizona_micsupp_ext_default; | ||
| 254 | break; | ||
| 255 | default: | ||
| 256 | desc = &arizona_micsupp; | ||
| 257 | micsupp->init_data = arizona_micsupp_default; | ||
| 258 | break; | ||
| 259 | } | ||
| 260 | |||
| 211 | micsupp->init_data.consumer_supplies = &micsupp->supply; | 261 | micsupp->init_data.consumer_supplies = &micsupp->supply; |
| 212 | micsupp->supply.supply = "MICVDD"; | 262 | micsupp->supply.supply = "MICVDD"; |
| 213 | micsupp->supply.dev_name = dev_name(arizona->dev); | 263 | micsupp->supply.dev_name = dev_name(arizona->dev); |
| @@ -226,7 +276,7 @@ static int arizona_micsupp_probe(struct platform_device *pdev) | |||
| 226 | ARIZONA_CPMIC_BYPASS, 0); | 276 | ARIZONA_CPMIC_BYPASS, 0); |
| 227 | 277 | ||
| 228 | micsupp->regulator = devm_regulator_register(&pdev->dev, | 278 | micsupp->regulator = devm_regulator_register(&pdev->dev, |
| 229 | &arizona_micsupp, | 279 | desc, |
| 230 | &config); | 280 | &config); |
| 231 | if (IS_ERR(micsupp->regulator)) { | 281 | if (IS_ERR(micsupp->regulator)) { |
| 232 | ret = PTR_ERR(micsupp->regulator); | 282 | ret = PTR_ERR(micsupp->regulator); |
diff --git a/drivers/regulator/as3722-regulator.c b/drivers/regulator/as3722-regulator.c index 5917fe3dc983..b9f1d24c6812 100644 --- a/drivers/regulator/as3722-regulator.c +++ b/drivers/regulator/as3722-regulator.c | |||
| @@ -590,8 +590,8 @@ static int as3722_sd016_set_current_limit(struct regulator_dev *rdev, | |||
| 590 | default: | 590 | default: |
| 591 | return -EINVAL; | 591 | return -EINVAL; |
| 592 | } | 592 | } |
| 593 | ret <<= ffs(mask) - 1; | ||
| 593 | val = ret & mask; | 594 | val = ret & mask; |
| 594 | val <<= ffs(mask) - 1; | ||
| 595 | return as3722_update_bits(as3722, reg, mask, val); | 595 | return as3722_update_bits(as3722, reg, mask, val); |
| 596 | } | 596 | } |
| 597 | 597 | ||
diff --git a/drivers/regulator/core.c b/drivers/regulator/core.c index 6382f0af353b..d85f31385b24 100644 --- a/drivers/regulator/core.c +++ b/drivers/regulator/core.c | |||
| @@ -119,6 +119,11 @@ static const char *rdev_get_name(struct regulator_dev *rdev) | |||
| 119 | return ""; | 119 | return ""; |
| 120 | } | 120 | } |
| 121 | 121 | ||
| 122 | static bool have_full_constraints(void) | ||
| 123 | { | ||
| 124 | return has_full_constraints || of_have_populated_dt(); | ||
| 125 | } | ||
| 126 | |||
| 122 | /** | 127 | /** |
| 123 | * of_get_regulator - get a regulator device node based on supply name | 128 | * of_get_regulator - get a regulator device node based on supply name |
| 124 | * @dev: Device pointer for the consumer (of regulator) device | 129 | * @dev: Device pointer for the consumer (of regulator) device |
| @@ -1340,7 +1345,7 @@ static struct regulator *_regulator_get(struct device *dev, const char *id, | |||
| 1340 | * Assume that a regulator is physically present and enabled | 1345 | * Assume that a regulator is physically present and enabled |
| 1341 | * even if it isn't hooked up and just provide a dummy. | 1346 | * even if it isn't hooked up and just provide a dummy. |
| 1342 | */ | 1347 | */ |
| 1343 | if (has_full_constraints && allow_dummy) { | 1348 | if (have_full_constraints() && allow_dummy) { |
| 1344 | pr_warn("%s supply %s not found, using dummy regulator\n", | 1349 | pr_warn("%s supply %s not found, using dummy regulator\n", |
| 1345 | devname, id); | 1350 | devname, id); |
| 1346 | 1351 | ||
| @@ -2184,6 +2189,9 @@ int regulator_list_voltage(struct regulator *regulator, unsigned selector) | |||
| 2184 | struct regulator_ops *ops = rdev->desc->ops; | 2189 | struct regulator_ops *ops = rdev->desc->ops; |
| 2185 | int ret; | 2190 | int ret; |
| 2186 | 2191 | ||
| 2192 | if (rdev->desc->fixed_uV && rdev->desc->n_voltages == 1 && !selector) | ||
| 2193 | return rdev->desc->fixed_uV; | ||
| 2194 | |||
| 2187 | if (!ops->list_voltage || selector >= rdev->desc->n_voltages) | 2195 | if (!ops->list_voltage || selector >= rdev->desc->n_voltages) |
| 2188 | return -EINVAL; | 2196 | return -EINVAL; |
| 2189 | 2197 | ||
| @@ -3624,7 +3632,7 @@ int regulator_suspend_finish(void) | |||
| 3624 | if (error) | 3632 | if (error) |
| 3625 | ret = error; | 3633 | ret = error; |
| 3626 | } else { | 3634 | } else { |
| 3627 | if (!has_full_constraints) | 3635 | if (!have_full_constraints()) |
| 3628 | goto unlock; | 3636 | goto unlock; |
| 3629 | if (!ops->disable) | 3637 | if (!ops->disable) |
| 3630 | goto unlock; | 3638 | goto unlock; |
| @@ -3822,7 +3830,7 @@ static int __init regulator_init_complete(void) | |||
| 3822 | if (!enabled) | 3830 | if (!enabled) |
| 3823 | goto unlock; | 3831 | goto unlock; |
| 3824 | 3832 | ||
| 3825 | if (has_full_constraints) { | 3833 | if (have_full_constraints()) { |
| 3826 | /* We log since this may kill the system if it | 3834 | /* We log since this may kill the system if it |
| 3827 | * goes wrong. */ | 3835 | * goes wrong. */ |
| 3828 | rdev_info(rdev, "disabling\n"); | 3836 | rdev_info(rdev, "disabling\n"); |
diff --git a/drivers/regulator/gpio-regulator.c b/drivers/regulator/gpio-regulator.c index 04406a918c04..234960dc9607 100644 --- a/drivers/regulator/gpio-regulator.c +++ b/drivers/regulator/gpio-regulator.c | |||
| @@ -139,6 +139,7 @@ of_get_gpio_regulator_config(struct device *dev, struct device_node *np) | |||
| 139 | struct property *prop; | 139 | struct property *prop; |
| 140 | const char *regtype; | 140 | const char *regtype; |
| 141 | int proplen, gpio, i; | 141 | int proplen, gpio, i; |
| 142 | int ret; | ||
| 142 | 143 | ||
| 143 | config = devm_kzalloc(dev, | 144 | config = devm_kzalloc(dev, |
| 144 | sizeof(struct gpio_regulator_config), | 145 | sizeof(struct gpio_regulator_config), |
| @@ -202,7 +203,11 @@ of_get_gpio_regulator_config(struct device *dev, struct device_node *np) | |||
| 202 | } | 203 | } |
| 203 | config->nr_states = i; | 204 | config->nr_states = i; |
| 204 | 205 | ||
| 205 | of_property_read_string(np, "regulator-type", ®type); | 206 | ret = of_property_read_string(np, "regulator-type", ®type); |
| 207 | if (ret < 0) { | ||
| 208 | dev_err(dev, "Missing 'regulator-type' property\n"); | ||
| 209 | return ERR_PTR(-EINVAL); | ||
| 210 | } | ||
| 206 | 211 | ||
| 207 | if (!strncmp("voltage", regtype, 7)) | 212 | if (!strncmp("voltage", regtype, 7)) |
| 208 | config->type = REGULATOR_VOLTAGE; | 213 | config->type = REGULATOR_VOLTAGE; |
diff --git a/drivers/regulator/pfuze100-regulator.c b/drivers/regulator/pfuze100-regulator.c index ba67b2c4e2e7..8b5e4c712a01 100644 --- a/drivers/regulator/pfuze100-regulator.c +++ b/drivers/regulator/pfuze100-regulator.c | |||
| @@ -38,7 +38,7 @@ | |||
| 38 | 38 | ||
| 39 | #define PFUZE100_DEVICEID 0x0 | 39 | #define PFUZE100_DEVICEID 0x0 |
| 40 | #define PFUZE100_REVID 0x3 | 40 | #define PFUZE100_REVID 0x3 |
| 41 | #define PFUZE100_FABID 0x3 | 41 | #define PFUZE100_FABID 0x4 |
| 42 | 42 | ||
| 43 | #define PFUZE100_SW1ABVOL 0x20 | 43 | #define PFUZE100_SW1ABVOL 0x20 |
| 44 | #define PFUZE100_SW1CVOL 0x2e | 44 | #define PFUZE100_SW1CVOL 0x2e |
| @@ -308,9 +308,15 @@ static int pfuze_identify(struct pfuze_chip *pfuze_chip) | |||
| 308 | if (ret) | 308 | if (ret) |
| 309 | return ret; | 309 | return ret; |
| 310 | 310 | ||
| 311 | if (value & 0x0f) { | 311 | switch (value & 0x0f) { |
| 312 | dev_warn(pfuze_chip->dev, "Illegal ID: %x\n", value); | 312 | /* Freescale misprogrammed 1-3% of parts prior to week 8 of 2013 as ID=8 */ |
| 313 | return -ENODEV; | 313 | case 0x8: |
| 314 | dev_info(pfuze_chip->dev, "Assuming misprogrammed ID=0x8"); | ||
| 315 | case 0x0: | ||
| 316 | break; | ||
| 317 | default: | ||
| 318 | dev_warn(pfuze_chip->dev, "Illegal ID: %x\n", value); | ||
| 319 | return -ENODEV; | ||
| 314 | } | 320 | } |
| 315 | 321 | ||
| 316 | ret = regmap_read(pfuze_chip->regmap, PFUZE100_REVID, &value); | 322 | ret = regmap_read(pfuze_chip->regmap, PFUZE100_REVID, &value); |
diff --git a/drivers/regulator/s5m8767.c b/drivers/regulator/s5m8767.c index cbf91e25cf7f..aeb40aad0ae7 100644 --- a/drivers/regulator/s5m8767.c +++ b/drivers/regulator/s5m8767.c | |||
| @@ -925,7 +925,7 @@ static int s5m8767_pmic_probe(struct platform_device *pdev) | |||
| 925 | config.dev = s5m8767->dev; | 925 | config.dev = s5m8767->dev; |
| 926 | config.init_data = pdata->regulators[i].initdata; | 926 | config.init_data = pdata->regulators[i].initdata; |
| 927 | config.driver_data = s5m8767; | 927 | config.driver_data = s5m8767; |
| 928 | config.regmap = iodev->regmap; | 928 | config.regmap = iodev->regmap_pmic; |
| 929 | config.of_node = pdata->regulators[i].reg_node; | 929 | config.of_node = pdata->regulators[i].reg_node; |
| 930 | 930 | ||
| 931 | rdev[i] = devm_regulator_register(&pdev->dev, ®ulators[id], | 931 | rdev[i] = devm_regulator_register(&pdev->dev, ®ulators[id], |
diff --git a/drivers/rtc/rtc-at91rm9200.c b/drivers/rtc/rtc-at91rm9200.c index c0da95e95702..3281c90691c3 100644 --- a/drivers/rtc/rtc-at91rm9200.c +++ b/drivers/rtc/rtc-at91rm9200.c | |||
| @@ -220,6 +220,8 @@ static int at91_rtc_setalarm(struct device *dev, struct rtc_wkalrm *alrm) | |||
| 220 | 220 | ||
| 221 | at91_alarm_year = tm.tm_year; | 221 | at91_alarm_year = tm.tm_year; |
| 222 | 222 | ||
| 223 | tm.tm_mon = alrm->time.tm_mon; | ||
| 224 | tm.tm_mday = alrm->time.tm_mday; | ||
| 223 | tm.tm_hour = alrm->time.tm_hour; | 225 | tm.tm_hour = alrm->time.tm_hour; |
| 224 | tm.tm_min = alrm->time.tm_min; | 226 | tm.tm_min = alrm->time.tm_min; |
| 225 | tm.tm_sec = alrm->time.tm_sec; | 227 | tm.tm_sec = alrm->time.tm_sec; |
diff --git a/drivers/rtc/rtc-s5m.c b/drivers/rtc/rtc-s5m.c index b7fd02bc0a14..ae8119dc2846 100644 --- a/drivers/rtc/rtc-s5m.c +++ b/drivers/rtc/rtc-s5m.c | |||
| @@ -28,10 +28,20 @@ | |||
| 28 | #include <linux/mfd/samsung/irq.h> | 28 | #include <linux/mfd/samsung/irq.h> |
| 29 | #include <linux/mfd/samsung/rtc.h> | 29 | #include <linux/mfd/samsung/rtc.h> |
| 30 | 30 | ||
| 31 | /* | ||
| 32 | * Maximum number of retries for checking changes in UDR field | ||
| 33 | * of SEC_RTC_UDR_CON register (to limit possible endless loop). | ||
| 34 | * | ||
| 35 | * After writing to RTC registers (setting time or alarm) read the UDR field | ||
| 36 | * in SEC_RTC_UDR_CON register. UDR is auto-cleared when data have | ||
| 37 | * been transferred. | ||
| 38 | */ | ||
| 39 | #define UDR_READ_RETRY_CNT 5 | ||
| 40 | |||
| 31 | struct s5m_rtc_info { | 41 | struct s5m_rtc_info { |
| 32 | struct device *dev; | 42 | struct device *dev; |
| 33 | struct sec_pmic_dev *s5m87xx; | 43 | struct sec_pmic_dev *s5m87xx; |
| 34 | struct regmap *rtc; | 44 | struct regmap *regmap; |
| 35 | struct rtc_device *rtc_dev; | 45 | struct rtc_device *rtc_dev; |
| 36 | int irq; | 46 | int irq; |
| 37 | int device_type; | 47 | int device_type; |
| @@ -84,12 +94,31 @@ static int s5m8767_tm_to_data(struct rtc_time *tm, u8 *data) | |||
| 84 | } | 94 | } |
| 85 | } | 95 | } |
| 86 | 96 | ||
| 97 | /* | ||
| 98 | * Read RTC_UDR_CON register and wait till UDR field is cleared. | ||
| 99 | * This indicates that time/alarm update ended. | ||
| 100 | */ | ||
| 101 | static inline int s5m8767_wait_for_udr_update(struct s5m_rtc_info *info) | ||
| 102 | { | ||
| 103 | int ret, retry = UDR_READ_RETRY_CNT; | ||
| 104 | unsigned int data; | ||
| 105 | |||
| 106 | do { | ||
| 107 | ret = regmap_read(info->regmap, SEC_RTC_UDR_CON, &data); | ||
| 108 | } while (--retry && (data & RTC_UDR_MASK) && !ret); | ||
| 109 | |||
| 110 | if (!retry) | ||
| 111 | dev_err(info->dev, "waiting for UDR update, reached max number of retries\n"); | ||
| 112 | |||
| 113 | return ret; | ||
| 114 | } | ||
| 115 | |||
| 87 | static inline int s5m8767_rtc_set_time_reg(struct s5m_rtc_info *info) | 116 | static inline int s5m8767_rtc_set_time_reg(struct s5m_rtc_info *info) |
| 88 | { | 117 | { |
| 89 | int ret; | 118 | int ret; |
| 90 | unsigned int data; | 119 | unsigned int data; |
| 91 | 120 | ||
| 92 | ret = regmap_read(info->rtc, SEC_RTC_UDR_CON, &data); | 121 | ret = regmap_read(info->regmap, SEC_RTC_UDR_CON, &data); |
| 93 | if (ret < 0) { | 122 | if (ret < 0) { |
| 94 | dev_err(info->dev, "failed to read update reg(%d)\n", ret); | 123 | dev_err(info->dev, "failed to read update reg(%d)\n", ret); |
| 95 | return ret; | 124 | return ret; |
| @@ -98,15 +127,13 @@ static inline int s5m8767_rtc_set_time_reg(struct s5m_rtc_info *info) | |||
| 98 | data |= RTC_TIME_EN_MASK; | 127 | data |= RTC_TIME_EN_MASK; |
| 99 | data |= RTC_UDR_MASK; | 128 | data |= RTC_UDR_MASK; |
| 100 | 129 | ||
| 101 | ret = regmap_write(info->rtc, SEC_RTC_UDR_CON, data); | 130 | ret = regmap_write(info->regmap, SEC_RTC_UDR_CON, data); |
| 102 | if (ret < 0) { | 131 | if (ret < 0) { |
| 103 | dev_err(info->dev, "failed to write update reg(%d)\n", ret); | 132 | dev_err(info->dev, "failed to write update reg(%d)\n", ret); |
| 104 | return ret; | 133 | return ret; |
| 105 | } | 134 | } |
| 106 | 135 | ||
| 107 | do { | 136 | ret = s5m8767_wait_for_udr_update(info); |
| 108 | ret = regmap_read(info->rtc, SEC_RTC_UDR_CON, &data); | ||
| 109 | } while ((data & RTC_UDR_MASK) && !ret); | ||
| 110 | 137 | ||
| 111 | return ret; | 138 | return ret; |
| 112 | } | 139 | } |
| @@ -116,7 +143,7 @@ static inline int s5m8767_rtc_set_alarm_reg(struct s5m_rtc_info *info) | |||
| 116 | int ret; | 143 | int ret; |
| 117 | unsigned int data; | 144 | unsigned int data; |
| 118 | 145 | ||
| 119 | ret = regmap_read(info->rtc, SEC_RTC_UDR_CON, &data); | 146 | ret = regmap_read(info->regmap, SEC_RTC_UDR_CON, &data); |
| 120 | if (ret < 0) { | 147 | if (ret < 0) { |
| 121 | dev_err(info->dev, "%s: fail to read update reg(%d)\n", | 148 | dev_err(info->dev, "%s: fail to read update reg(%d)\n", |
| 122 | __func__, ret); | 149 | __func__, ret); |
| @@ -126,16 +153,14 @@ static inline int s5m8767_rtc_set_alarm_reg(struct s5m_rtc_info *info) | |||
| 126 | data &= ~RTC_TIME_EN_MASK; | 153 | data &= ~RTC_TIME_EN_MASK; |
| 127 | data |= RTC_UDR_MASK; | 154 | data |= RTC_UDR_MASK; |
| 128 | 155 | ||
| 129 | ret = regmap_write(info->rtc, SEC_RTC_UDR_CON, data); | 156 | ret = regmap_write(info->regmap, SEC_RTC_UDR_CON, data); |
| 130 | if (ret < 0) { | 157 | if (ret < 0) { |
| 131 | dev_err(info->dev, "%s: fail to write update reg(%d)\n", | 158 | dev_err(info->dev, "%s: fail to write update reg(%d)\n", |
| 132 | __func__, ret); | 159 | __func__, ret); |
| 133 | return ret; | 160 | return ret; |
| 134 | } | 161 | } |
| 135 | 162 | ||
| 136 | do { | 163 | ret = s5m8767_wait_for_udr_update(info); |
| 137 | ret = regmap_read(info->rtc, SEC_RTC_UDR_CON, &data); | ||
| 138 | } while ((data & RTC_UDR_MASK) && !ret); | ||
| 139 | 164 | ||
| 140 | return ret; | 165 | return ret; |
| 141 | } | 166 | } |
| @@ -178,7 +203,7 @@ static int s5m_rtc_read_time(struct device *dev, struct rtc_time *tm) | |||
| 178 | u8 data[8]; | 203 | u8 data[8]; |
| 179 | int ret; | 204 | int ret; |
| 180 | 205 | ||
| 181 | ret = regmap_bulk_read(info->rtc, SEC_RTC_SEC, data, 8); | 206 | ret = regmap_bulk_read(info->regmap, SEC_RTC_SEC, data, 8); |
| 182 | if (ret < 0) | 207 | if (ret < 0) |
| 183 | return ret; | 208 | return ret; |
| 184 | 209 | ||
| @@ -226,7 +251,7 @@ static int s5m_rtc_set_time(struct device *dev, struct rtc_time *tm) | |||
| 226 | 1900 + tm->tm_year, 1 + tm->tm_mon, tm->tm_mday, | 251 | 1900 + tm->tm_year, 1 + tm->tm_mon, tm->tm_mday, |
| 227 | tm->tm_hour, tm->tm_min, tm->tm_sec, tm->tm_wday); | 252 | tm->tm_hour, tm->tm_min, tm->tm_sec, tm->tm_wday); |
| 228 | 253 | ||
| 229 | ret = regmap_raw_write(info->rtc, SEC_RTC_SEC, data, 8); | 254 | ret = regmap_raw_write(info->regmap, SEC_RTC_SEC, data, 8); |
| 230 | if (ret < 0) | 255 | if (ret < 0) |
| 231 | return ret; | 256 | return ret; |
| 232 | 257 | ||
| @@ -242,20 +267,20 @@ static int s5m_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm) | |||
| 242 | unsigned int val; | 267 | unsigned int val; |
| 243 | int ret, i; | 268 | int ret, i; |
| 244 | 269 | ||
| 245 | ret = regmap_bulk_read(info->rtc, SEC_ALARM0_SEC, data, 8); | 270 | ret = regmap_bulk_read(info->regmap, SEC_ALARM0_SEC, data, 8); |
| 246 | if (ret < 0) | 271 | if (ret < 0) |
| 247 | return ret; | 272 | return ret; |
| 248 | 273 | ||
| 249 | switch (info->device_type) { | 274 | switch (info->device_type) { |
| 250 | case S5M8763X: | 275 | case S5M8763X: |
| 251 | s5m8763_data_to_tm(data, &alrm->time); | 276 | s5m8763_data_to_tm(data, &alrm->time); |
| 252 | ret = regmap_read(info->rtc, SEC_ALARM0_CONF, &val); | 277 | ret = regmap_read(info->regmap, SEC_ALARM0_CONF, &val); |
| 253 | if (ret < 0) | 278 | if (ret < 0) |
| 254 | return ret; | 279 | return ret; |
| 255 | 280 | ||
| 256 | alrm->enabled = !!val; | 281 | alrm->enabled = !!val; |
| 257 | 282 | ||
| 258 | ret = regmap_read(info->rtc, SEC_RTC_STATUS, &val); | 283 | ret = regmap_read(info->regmap, SEC_RTC_STATUS, &val); |
| 259 | if (ret < 0) | 284 | if (ret < 0) |
| 260 | return ret; | 285 | return ret; |
| 261 | 286 | ||
| @@ -278,7 +303,7 @@ static int s5m_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm) | |||
| 278 | } | 303 | } |
| 279 | 304 | ||
| 280 | alrm->pending = 0; | 305 | alrm->pending = 0; |
| 281 | ret = regmap_read(info->rtc, SEC_RTC_STATUS, &val); | 306 | ret = regmap_read(info->regmap, SEC_RTC_STATUS, &val); |
| 282 | if (ret < 0) | 307 | if (ret < 0) |
| 283 | return ret; | 308 | return ret; |
| 284 | break; | 309 | break; |
| @@ -301,7 +326,7 @@ static int s5m_rtc_stop_alarm(struct s5m_rtc_info *info) | |||
| 301 | int ret, i; | 326 | int ret, i; |
| 302 | struct rtc_time tm; | 327 | struct rtc_time tm; |
| 303 | 328 | ||
| 304 | ret = regmap_bulk_read(info->rtc, SEC_ALARM0_SEC, data, 8); | 329 | ret = regmap_bulk_read(info->regmap, SEC_ALARM0_SEC, data, 8); |
| 305 | if (ret < 0) | 330 | if (ret < 0) |
| 306 | return ret; | 331 | return ret; |
| 307 | 332 | ||
| @@ -312,14 +337,14 @@ static int s5m_rtc_stop_alarm(struct s5m_rtc_info *info) | |||
| 312 | 337 | ||
| 313 | switch (info->device_type) { | 338 | switch (info->device_type) { |
| 314 | case S5M8763X: | 339 | case S5M8763X: |
| 315 | ret = regmap_write(info->rtc, SEC_ALARM0_CONF, 0); | 340 | ret = regmap_write(info->regmap, SEC_ALARM0_CONF, 0); |
| 316 | break; | 341 | break; |
| 317 | 342 | ||
| 318 | case S5M8767X: | 343 | case S5M8767X: |
| 319 | for (i = 0; i < 7; i++) | 344 | for (i = 0; i < 7; i++) |
| 320 | data[i] &= ~ALARM_ENABLE_MASK; | 345 | data[i] &= ~ALARM_ENABLE_MASK; |
| 321 | 346 | ||
| 322 | ret = regmap_raw_write(info->rtc, SEC_ALARM0_SEC, data, 8); | 347 | ret = regmap_raw_write(info->regmap, SEC_ALARM0_SEC, data, 8); |
| 323 | if (ret < 0) | 348 | if (ret < 0) |
| 324 | return ret; | 349 | return ret; |
| 325 | 350 | ||
| @@ -341,7 +366,7 @@ static int s5m_rtc_start_alarm(struct s5m_rtc_info *info) | |||
| 341 | u8 alarm0_conf; | 366 | u8 alarm0_conf; |
| 342 | struct rtc_time tm; | 367 | struct rtc_time tm; |
| 343 | 368 | ||
| 344 | ret = regmap_bulk_read(info->rtc, SEC_ALARM0_SEC, data, 8); | 369 | ret = regmap_bulk_read(info->regmap, SEC_ALARM0_SEC, data, 8); |
| 345 | if (ret < 0) | 370 | if (ret < 0) |
| 346 | return ret; | 371 | return ret; |
| 347 | 372 | ||
| @@ -353,7 +378,7 @@ static int s5m_rtc_start_alarm(struct s5m_rtc_info *info) | |||
| 353 | switch (info->device_type) { | 378 | switch (info->device_type) { |
| 354 | case S5M8763X: | 379 | case S5M8763X: |
| 355 | alarm0_conf = 0x77; | 380 | alarm0_conf = 0x77; |
| 356 | ret = regmap_write(info->rtc, SEC_ALARM0_CONF, alarm0_conf); | 381 | ret = regmap_write(info->regmap, SEC_ALARM0_CONF, alarm0_conf); |
| 357 | break; | 382 | break; |
| 358 | 383 | ||
| 359 | case S5M8767X: | 384 | case S5M8767X: |
| @@ -368,7 +393,7 @@ static int s5m_rtc_start_alarm(struct s5m_rtc_info *info) | |||
| 368 | if (data[RTC_YEAR1] & 0x7f) | 393 | if (data[RTC_YEAR1] & 0x7f) |
| 369 | data[RTC_YEAR1] |= ALARM_ENABLE_MASK; | 394 | data[RTC_YEAR1] |= ALARM_ENABLE_MASK; |
| 370 | 395 | ||
| 371 | ret = regmap_raw_write(info->rtc, SEC_ALARM0_SEC, data, 8); | 396 | ret = regmap_raw_write(info->regmap, SEC_ALARM0_SEC, data, 8); |
| 372 | if (ret < 0) | 397 | if (ret < 0) |
| 373 | return ret; | 398 | return ret; |
| 374 | ret = s5m8767_rtc_set_alarm_reg(info); | 399 | ret = s5m8767_rtc_set_alarm_reg(info); |
| @@ -410,7 +435,7 @@ static int s5m_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm) | |||
| 410 | if (ret < 0) | 435 | if (ret < 0) |
| 411 | return ret; | 436 | return ret; |
| 412 | 437 | ||
| 413 | ret = regmap_raw_write(info->rtc, SEC_ALARM0_SEC, data, 8); | 438 | ret = regmap_raw_write(info->regmap, SEC_ALARM0_SEC, data, 8); |
| 414 | if (ret < 0) | 439 | if (ret < 0) |
| 415 | return ret; | 440 | return ret; |
| 416 | 441 | ||
| @@ -455,7 +480,7 @@ static const struct rtc_class_ops s5m_rtc_ops = { | |||
| 455 | static void s5m_rtc_enable_wtsr(struct s5m_rtc_info *info, bool enable) | 480 | static void s5m_rtc_enable_wtsr(struct s5m_rtc_info *info, bool enable) |
| 456 | { | 481 | { |
| 457 | int ret; | 482 | int ret; |
| 458 | ret = regmap_update_bits(info->rtc, SEC_WTSR_SMPL_CNTL, | 483 | ret = regmap_update_bits(info->regmap, SEC_WTSR_SMPL_CNTL, |
| 459 | WTSR_ENABLE_MASK, | 484 | WTSR_ENABLE_MASK, |
| 460 | enable ? WTSR_ENABLE_MASK : 0); | 485 | enable ? WTSR_ENABLE_MASK : 0); |
| 461 | if (ret < 0) | 486 | if (ret < 0) |
| @@ -466,7 +491,7 @@ static void s5m_rtc_enable_wtsr(struct s5m_rtc_info *info, bool enable) | |||
| 466 | static void s5m_rtc_enable_smpl(struct s5m_rtc_info *info, bool enable) | 491 | static void s5m_rtc_enable_smpl(struct s5m_rtc_info *info, bool enable) |
| 467 | { | 492 | { |
| 468 | int ret; | 493 | int ret; |
| 469 | ret = regmap_update_bits(info->rtc, SEC_WTSR_SMPL_CNTL, | 494 | ret = regmap_update_bits(info->regmap, SEC_WTSR_SMPL_CNTL, |
| 470 | SMPL_ENABLE_MASK, | 495 | SMPL_ENABLE_MASK, |
| 471 | enable ? SMPL_ENABLE_MASK : 0); | 496 | enable ? SMPL_ENABLE_MASK : 0); |
| 472 | if (ret < 0) | 497 | if (ret < 0) |
| @@ -481,7 +506,7 @@ static int s5m8767_rtc_init_reg(struct s5m_rtc_info *info) | |||
| 481 | int ret; | 506 | int ret; |
| 482 | struct rtc_time tm; | 507 | struct rtc_time tm; |
| 483 | 508 | ||
| 484 | ret = regmap_read(info->rtc, SEC_RTC_UDR_CON, &tp_read); | 509 | ret = regmap_read(info->regmap, SEC_RTC_UDR_CON, &tp_read); |
| 485 | if (ret < 0) { | 510 | if (ret < 0) { |
| 486 | dev_err(info->dev, "%s: fail to read control reg(%d)\n", | 511 | dev_err(info->dev, "%s: fail to read control reg(%d)\n", |
| 487 | __func__, ret); | 512 | __func__, ret); |
| @@ -493,7 +518,7 @@ static int s5m8767_rtc_init_reg(struct s5m_rtc_info *info) | |||
| 493 | data[1] = (0 << BCD_EN_SHIFT) | (1 << MODEL24_SHIFT); | 518 | data[1] = (0 << BCD_EN_SHIFT) | (1 << MODEL24_SHIFT); |
| 494 | 519 | ||
| 495 | info->rtc_24hr_mode = 1; | 520 | info->rtc_24hr_mode = 1; |
| 496 | ret = regmap_raw_write(info->rtc, SEC_ALARM0_CONF, data, 2); | 521 | ret = regmap_raw_write(info->regmap, SEC_ALARM0_CONF, data, 2); |
| 497 | if (ret < 0) { | 522 | if (ret < 0) { |
| 498 | dev_err(info->dev, "%s: fail to write controlm reg(%d)\n", | 523 | dev_err(info->dev, "%s: fail to write controlm reg(%d)\n", |
| 499 | __func__, ret); | 524 | __func__, ret); |
| @@ -515,7 +540,7 @@ static int s5m8767_rtc_init_reg(struct s5m_rtc_info *info) | |||
| 515 | ret = s5m_rtc_set_time(info->dev, &tm); | 540 | ret = s5m_rtc_set_time(info->dev, &tm); |
| 516 | } | 541 | } |
| 517 | 542 | ||
| 518 | ret = regmap_update_bits(info->rtc, SEC_RTC_UDR_CON, | 543 | ret = regmap_update_bits(info->regmap, SEC_RTC_UDR_CON, |
| 519 | RTC_TCON_MASK, tp_read | RTC_TCON_MASK); | 544 | RTC_TCON_MASK, tp_read | RTC_TCON_MASK); |
| 520 | if (ret < 0) | 545 | if (ret < 0) |
| 521 | dev_err(info->dev, "%s: fail to update TCON reg(%d)\n", | 546 | dev_err(info->dev, "%s: fail to update TCON reg(%d)\n", |
| @@ -542,17 +567,19 @@ static int s5m_rtc_probe(struct platform_device *pdev) | |||
| 542 | 567 | ||
| 543 | info->dev = &pdev->dev; | 568 | info->dev = &pdev->dev; |
| 544 | info->s5m87xx = s5m87xx; | 569 | info->s5m87xx = s5m87xx; |
| 545 | info->rtc = s5m87xx->rtc; | 570 | info->regmap = s5m87xx->regmap_rtc; |
| 546 | info->device_type = s5m87xx->device_type; | 571 | info->device_type = s5m87xx->device_type; |
| 547 | info->wtsr_smpl = s5m87xx->wtsr_smpl; | 572 | info->wtsr_smpl = s5m87xx->wtsr_smpl; |
| 548 | 573 | ||
| 549 | switch (pdata->device_type) { | 574 | switch (pdata->device_type) { |
| 550 | case S5M8763X: | 575 | case S5M8763X: |
| 551 | info->irq = s5m87xx->irq_base + S5M8763_IRQ_ALARM0; | 576 | info->irq = regmap_irq_get_virq(s5m87xx->irq_data, |
| 577 | S5M8763_IRQ_ALARM0); | ||
| 552 | break; | 578 | break; |
| 553 | 579 | ||
| 554 | case S5M8767X: | 580 | case S5M8767X: |
| 555 | info->irq = s5m87xx->irq_base + S5M8767_IRQ_RTCA1; | 581 | info->irq = regmap_irq_get_virq(s5m87xx->irq_data, |
| 582 | S5M8767_IRQ_RTCA1); | ||
| 556 | break; | 583 | break; |
| 557 | 584 | ||
| 558 | default: | 585 | default: |
| @@ -596,7 +623,7 @@ static void s5m_rtc_shutdown(struct platform_device *pdev) | |||
| 596 | if (info->wtsr_smpl) { | 623 | if (info->wtsr_smpl) { |
| 597 | for (i = 0; i < 3; i++) { | 624 | for (i = 0; i < 3; i++) { |
| 598 | s5m_rtc_enable_wtsr(info, false); | 625 | s5m_rtc_enable_wtsr(info, false); |
| 599 | regmap_read(info->rtc, SEC_WTSR_SMPL_CNTL, &val); | 626 | regmap_read(info->regmap, SEC_WTSR_SMPL_CNTL, &val); |
| 600 | pr_debug("%s: WTSR_SMPL reg(0x%02x)\n", __func__, val); | 627 | pr_debug("%s: WTSR_SMPL reg(0x%02x)\n", __func__, val); |
| 601 | if (val & WTSR_ENABLE_MASK) | 628 | if (val & WTSR_ENABLE_MASK) |
| 602 | pr_emerg("%s: fail to disable WTSR\n", | 629 | pr_emerg("%s: fail to disable WTSR\n", |
| @@ -612,6 +639,30 @@ static void s5m_rtc_shutdown(struct platform_device *pdev) | |||
| 612 | s5m_rtc_enable_smpl(info, false); | 639 | s5m_rtc_enable_smpl(info, false); |
| 613 | } | 640 | } |
| 614 | 641 | ||
| 642 | static int s5m_rtc_resume(struct device *dev) | ||
| 643 | { | ||
| 644 | struct s5m_rtc_info *info = dev_get_drvdata(dev); | ||
| 645 | int ret = 0; | ||
| 646 | |||
| 647 | if (device_may_wakeup(dev)) | ||
| 648 | ret = disable_irq_wake(info->irq); | ||
| 649 | |||
| 650 | return ret; | ||
| 651 | } | ||
| 652 | |||
| 653 | static int s5m_rtc_suspend(struct device *dev) | ||
| 654 | { | ||
| 655 | struct s5m_rtc_info *info = dev_get_drvdata(dev); | ||
| 656 | int ret = 0; | ||
| 657 | |||
| 658 | if (device_may_wakeup(dev)) | ||
| 659 | ret = enable_irq_wake(info->irq); | ||
| 660 | |||
| 661 | return ret; | ||
| 662 | } | ||
| 663 | |||
| 664 | static SIMPLE_DEV_PM_OPS(s5m_rtc_pm_ops, s5m_rtc_suspend, s5m_rtc_resume); | ||
| 665 | |||
| 615 | static const struct platform_device_id s5m_rtc_id[] = { | 666 | static const struct platform_device_id s5m_rtc_id[] = { |
| 616 | { "s5m-rtc", 0 }, | 667 | { "s5m-rtc", 0 }, |
| 617 | }; | 668 | }; |
| @@ -620,6 +671,7 @@ static struct platform_driver s5m_rtc_driver = { | |||
| 620 | .driver = { | 671 | .driver = { |
| 621 | .name = "s5m-rtc", | 672 | .name = "s5m-rtc", |
| 622 | .owner = THIS_MODULE, | 673 | .owner = THIS_MODULE, |
| 674 | .pm = &s5m_rtc_pm_ops, | ||
| 623 | }, | 675 | }, |
| 624 | .probe = s5m_rtc_probe, | 676 | .probe = s5m_rtc_probe, |
| 625 | .shutdown = s5m_rtc_shutdown, | 677 | .shutdown = s5m_rtc_shutdown, |
diff --git a/drivers/s390/block/dasd_eckd.c b/drivers/s390/block/dasd_eckd.c index cee7e2708a1f..95e45782692f 100644 --- a/drivers/s390/block/dasd_eckd.c +++ b/drivers/s390/block/dasd_eckd.c | |||
| @@ -3224,6 +3224,8 @@ static struct dasd_ccw_req *dasd_eckd_build_cp(struct dasd_device *startdev, | |||
| 3224 | 3224 | ||
| 3225 | fcx_multitrack = private->features.feature[40] & 0x20; | 3225 | fcx_multitrack = private->features.feature[40] & 0x20; |
| 3226 | data_size = blk_rq_bytes(req); | 3226 | data_size = blk_rq_bytes(req); |
| 3227 | if (data_size % blksize) | ||
| 3228 | return ERR_PTR(-EINVAL); | ||
| 3227 | /* tpm write request add CBC data on each track boundary */ | 3229 | /* tpm write request add CBC data on each track boundary */ |
| 3228 | if (rq_data_dir(req) == WRITE) | 3230 | if (rq_data_dir(req) == WRITE) |
| 3229 | data_size += (last_trk - first_trk) * 4; | 3231 | data_size += (last_trk - first_trk) * 4; |
diff --git a/drivers/s390/block/dasd_genhd.c b/drivers/s390/block/dasd_genhd.c index f64921756ad6..f224d59c4b6b 100644 --- a/drivers/s390/block/dasd_genhd.c +++ b/drivers/s390/block/dasd_genhd.c | |||
| @@ -87,7 +87,6 @@ void dasd_gendisk_free(struct dasd_block *block) | |||
| 87 | { | 87 | { |
| 88 | if (block->gdp) { | 88 | if (block->gdp) { |
| 89 | del_gendisk(block->gdp); | 89 | del_gendisk(block->gdp); |
| 90 | block->gdp->queue = NULL; | ||
| 91 | block->gdp->private_data = NULL; | 90 | block->gdp->private_data = NULL; |
| 92 | put_disk(block->gdp); | 91 | put_disk(block->gdp); |
| 93 | block->gdp = NULL; | 92 | block->gdp = NULL; |
diff --git a/drivers/s390/char/sclp_early.c b/drivers/s390/char/sclp_early.c index f7aa080e9b28..1465e9563101 100644 --- a/drivers/s390/char/sclp_early.c +++ b/drivers/s390/char/sclp_early.c | |||
| @@ -35,7 +35,6 @@ struct read_info_sccb { | |||
| 35 | u8 _reserved5[4096 - 112]; /* 112-4095 */ | 35 | u8 _reserved5[4096 - 112]; /* 112-4095 */ |
| 36 | } __packed __aligned(PAGE_SIZE); | 36 | } __packed __aligned(PAGE_SIZE); |
| 37 | 37 | ||
| 38 | static __initdata struct init_sccb early_event_mask_sccb __aligned(PAGE_SIZE); | ||
| 39 | static __initdata struct read_info_sccb early_read_info_sccb; | 38 | static __initdata struct read_info_sccb early_read_info_sccb; |
| 40 | static __initdata char sccb_early[PAGE_SIZE] __aligned(PAGE_SIZE); | 39 | static __initdata char sccb_early[PAGE_SIZE] __aligned(PAGE_SIZE); |
| 41 | static unsigned long sclp_hsa_size; | 40 | static unsigned long sclp_hsa_size; |
| @@ -113,7 +112,7 @@ static void __init sclp_facilities_detect(void) | |||
| 113 | 112 | ||
| 114 | bool __init sclp_has_linemode(void) | 113 | bool __init sclp_has_linemode(void) |
| 115 | { | 114 | { |
| 116 | struct init_sccb *sccb = &early_event_mask_sccb; | 115 | struct init_sccb *sccb = (void *) &sccb_early; |
| 117 | 116 | ||
| 118 | if (sccb->header.response_code != 0x20) | 117 | if (sccb->header.response_code != 0x20) |
| 119 | return 0; | 118 | return 0; |
| @@ -126,7 +125,7 @@ bool __init sclp_has_linemode(void) | |||
| 126 | 125 | ||
| 127 | bool __init sclp_has_vt220(void) | 126 | bool __init sclp_has_vt220(void) |
| 128 | { | 127 | { |
| 129 | struct init_sccb *sccb = &early_event_mask_sccb; | 128 | struct init_sccb *sccb = (void *) &sccb_early; |
| 130 | 129 | ||
| 131 | if (sccb->header.response_code != 0x20) | 130 | if (sccb->header.response_code != 0x20) |
| 132 | return 0; | 131 | return 0; |
diff --git a/drivers/scsi/3w-9xxx.c b/drivers/scsi/3w-9xxx.c index 5e1e12c0cf42..0a7325361d29 100644 --- a/drivers/scsi/3w-9xxx.c +++ b/drivers/scsi/3w-9xxx.c | |||
| @@ -2025,7 +2025,8 @@ static struct scsi_host_template driver_template = { | |||
| 2025 | .cmd_per_lun = TW_MAX_CMDS_PER_LUN, | 2025 | .cmd_per_lun = TW_MAX_CMDS_PER_LUN, |
| 2026 | .use_clustering = ENABLE_CLUSTERING, | 2026 | .use_clustering = ENABLE_CLUSTERING, |
| 2027 | .shost_attrs = twa_host_attrs, | 2027 | .shost_attrs = twa_host_attrs, |
| 2028 | .emulated = 1 | 2028 | .emulated = 1, |
| 2029 | .no_write_same = 1, | ||
| 2029 | }; | 2030 | }; |
| 2030 | 2031 | ||
| 2031 | /* This function will probe and initialize a card */ | 2032 | /* This function will probe and initialize a card */ |
diff --git a/drivers/scsi/3w-sas.c b/drivers/scsi/3w-sas.c index c845bdbeb6c0..4de346017e9f 100644 --- a/drivers/scsi/3w-sas.c +++ b/drivers/scsi/3w-sas.c | |||
| @@ -1600,7 +1600,8 @@ static struct scsi_host_template driver_template = { | |||
| 1600 | .cmd_per_lun = TW_MAX_CMDS_PER_LUN, | 1600 | .cmd_per_lun = TW_MAX_CMDS_PER_LUN, |
| 1601 | .use_clustering = ENABLE_CLUSTERING, | 1601 | .use_clustering = ENABLE_CLUSTERING, |
| 1602 | .shost_attrs = twl_host_attrs, | 1602 | .shost_attrs = twl_host_attrs, |
| 1603 | .emulated = 1 | 1603 | .emulated = 1, |
| 1604 | .no_write_same = 1, | ||
| 1604 | }; | 1605 | }; |
| 1605 | 1606 | ||
| 1606 | /* This function will probe and initialize a card */ | 1607 | /* This function will probe and initialize a card */ |
diff --git a/drivers/scsi/3w-xxxx.c b/drivers/scsi/3w-xxxx.c index b9276d10b25c..752624e6bc00 100644 --- a/drivers/scsi/3w-xxxx.c +++ b/drivers/scsi/3w-xxxx.c | |||
| @@ -2279,7 +2279,8 @@ static struct scsi_host_template driver_template = { | |||
| 2279 | .cmd_per_lun = TW_MAX_CMDS_PER_LUN, | 2279 | .cmd_per_lun = TW_MAX_CMDS_PER_LUN, |
| 2280 | .use_clustering = ENABLE_CLUSTERING, | 2280 | .use_clustering = ENABLE_CLUSTERING, |
| 2281 | .shost_attrs = tw_host_attrs, | 2281 | .shost_attrs = tw_host_attrs, |
| 2282 | .emulated = 1 | 2282 | .emulated = 1, |
| 2283 | .no_write_same = 1, | ||
| 2283 | }; | 2284 | }; |
| 2284 | 2285 | ||
| 2285 | /* This function will probe and initialize a card */ | 2286 | /* This function will probe and initialize a card */ |
diff --git a/drivers/scsi/aacraid/linit.c b/drivers/scsi/aacraid/linit.c index f0d432c139d0..4921ed19a027 100644 --- a/drivers/scsi/aacraid/linit.c +++ b/drivers/scsi/aacraid/linit.c | |||
| @@ -1081,6 +1081,7 @@ static struct scsi_host_template aac_driver_template = { | |||
| 1081 | #endif | 1081 | #endif |
| 1082 | .use_clustering = ENABLE_CLUSTERING, | 1082 | .use_clustering = ENABLE_CLUSTERING, |
| 1083 | .emulated = 1, | 1083 | .emulated = 1, |
| 1084 | .no_write_same = 1, | ||
| 1084 | }; | 1085 | }; |
| 1085 | 1086 | ||
| 1086 | static void __aac_shutdown(struct aac_dev * aac) | 1087 | static void __aac_shutdown(struct aac_dev * aac) |
diff --git a/drivers/scsi/arcmsr/arcmsr_hba.c b/drivers/scsi/arcmsr/arcmsr_hba.c index 97fd450aff09..4f6a30b8e5f9 100644 --- a/drivers/scsi/arcmsr/arcmsr_hba.c +++ b/drivers/scsi/arcmsr/arcmsr_hba.c | |||
| @@ -137,6 +137,7 @@ static struct scsi_host_template arcmsr_scsi_host_template = { | |||
| 137 | .cmd_per_lun = ARCMSR_MAX_CMD_PERLUN, | 137 | .cmd_per_lun = ARCMSR_MAX_CMD_PERLUN, |
| 138 | .use_clustering = ENABLE_CLUSTERING, | 138 | .use_clustering = ENABLE_CLUSTERING, |
| 139 | .shost_attrs = arcmsr_host_attrs, | 139 | .shost_attrs = arcmsr_host_attrs, |
| 140 | .no_write_same = 1, | ||
| 140 | }; | 141 | }; |
| 141 | static struct pci_device_id arcmsr_device_id_table[] = { | 142 | static struct pci_device_id arcmsr_device_id_table[] = { |
| 142 | {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1110)}, | 143 | {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1110)}, |
diff --git a/drivers/scsi/bfa/bfa_fcs.h b/drivers/scsi/bfa/bfa_fcs.h index 94d5d0102f7d..42bcb970445a 100644 --- a/drivers/scsi/bfa/bfa_fcs.h +++ b/drivers/scsi/bfa/bfa_fcs.h | |||
| @@ -296,6 +296,7 @@ wwn_t bfa_fcs_lport_get_rport(struct bfa_fcs_lport_s *port, wwn_t wwn, | |||
| 296 | struct bfa_fcs_lport_s *bfa_fcs_lookup_port(struct bfa_fcs_s *fcs, | 296 | struct bfa_fcs_lport_s *bfa_fcs_lookup_port(struct bfa_fcs_s *fcs, |
| 297 | u16 vf_id, wwn_t lpwwn); | 297 | u16 vf_id, wwn_t lpwwn); |
| 298 | 298 | ||
| 299 | void bfa_fcs_lport_set_symname(struct bfa_fcs_lport_s *port, char *symname); | ||
| 299 | void bfa_fcs_lport_get_info(struct bfa_fcs_lport_s *port, | 300 | void bfa_fcs_lport_get_info(struct bfa_fcs_lport_s *port, |
| 300 | struct bfa_lport_info_s *port_info); | 301 | struct bfa_lport_info_s *port_info); |
| 301 | void bfa_fcs_lport_get_attr(struct bfa_fcs_lport_s *port, | 302 | void bfa_fcs_lport_get_attr(struct bfa_fcs_lport_s *port, |
diff --git a/drivers/scsi/bfa/bfa_fcs_lport.c b/drivers/scsi/bfa/bfa_fcs_lport.c index 2f61a5af3658..f5e4e61a0fd7 100644 --- a/drivers/scsi/bfa/bfa_fcs_lport.c +++ b/drivers/scsi/bfa/bfa_fcs_lport.c | |||
| @@ -1097,6 +1097,17 @@ bfa_fcs_lport_init(struct bfa_fcs_lport_s *lport, | |||
| 1097 | bfa_sm_send_event(lport, BFA_FCS_PORT_SM_CREATE); | 1097 | bfa_sm_send_event(lport, BFA_FCS_PORT_SM_CREATE); |
| 1098 | } | 1098 | } |
| 1099 | 1099 | ||
| 1100 | void | ||
| 1101 | bfa_fcs_lport_set_symname(struct bfa_fcs_lport_s *port, | ||
| 1102 | char *symname) | ||
| 1103 | { | ||
| 1104 | strcpy(port->port_cfg.sym_name.symname, symname); | ||
| 1105 | |||
| 1106 | if (bfa_sm_cmp_state(port, bfa_fcs_lport_sm_online)) | ||
| 1107 | bfa_fcs_lport_ns_util_send_rspn_id( | ||
| 1108 | BFA_FCS_GET_NS_FROM_PORT(port), NULL); | ||
| 1109 | } | ||
| 1110 | |||
| 1100 | /* | 1111 | /* |
| 1101 | * fcs_lport_api | 1112 | * fcs_lport_api |
| 1102 | */ | 1113 | */ |
| @@ -5140,9 +5151,6 @@ bfa_fcs_lport_ns_util_send_rspn_id(void *cbarg, struct bfa_fcxp_s *fcxp_alloced) | |||
| 5140 | u8 *psymbl = &symbl[0]; | 5151 | u8 *psymbl = &symbl[0]; |
| 5141 | int len; | 5152 | int len; |
| 5142 | 5153 | ||
| 5143 | if (!bfa_sm_cmp_state(port, bfa_fcs_lport_sm_online)) | ||
| 5144 | return; | ||
| 5145 | |||
| 5146 | /* Avoid sending RSPN in the following states. */ | 5154 | /* Avoid sending RSPN in the following states. */ |
| 5147 | if (bfa_sm_cmp_state(ns, bfa_fcs_lport_ns_sm_offline) || | 5155 | if (bfa_sm_cmp_state(ns, bfa_fcs_lport_ns_sm_offline) || |
| 5148 | bfa_sm_cmp_state(ns, bfa_fcs_lport_ns_sm_plogi_sending) || | 5156 | bfa_sm_cmp_state(ns, bfa_fcs_lport_ns_sm_plogi_sending) || |
diff --git a/drivers/scsi/bfa/bfad_attr.c b/drivers/scsi/bfa/bfad_attr.c index e9a681d31223..40be670a1cbc 100644 --- a/drivers/scsi/bfa/bfad_attr.c +++ b/drivers/scsi/bfa/bfad_attr.c | |||
| @@ -593,11 +593,8 @@ bfad_im_vport_set_symbolic_name(struct fc_vport *fc_vport) | |||
| 593 | return; | 593 | return; |
| 594 | 594 | ||
| 595 | spin_lock_irqsave(&bfad->bfad_lock, flags); | 595 | spin_lock_irqsave(&bfad->bfad_lock, flags); |
| 596 | if (strlen(sym_name) > 0) { | 596 | if (strlen(sym_name) > 0) |
| 597 | strcpy(fcs_vport->lport.port_cfg.sym_name.symname, sym_name); | 597 | bfa_fcs_lport_set_symname(&fcs_vport->lport, sym_name); |
| 598 | bfa_fcs_lport_ns_util_send_rspn_id( | ||
| 599 | BFA_FCS_GET_NS_FROM_PORT((&fcs_vport->lport)), NULL); | ||
| 600 | } | ||
| 601 | spin_unlock_irqrestore(&bfad->bfad_lock, flags); | 598 | spin_unlock_irqrestore(&bfad->bfad_lock, flags); |
| 602 | } | 599 | } |
| 603 | 600 | ||
diff --git a/drivers/scsi/gdth.c b/drivers/scsi/gdth.c index ee4fa40a50b1..ce5ef0190bad 100644 --- a/drivers/scsi/gdth.c +++ b/drivers/scsi/gdth.c | |||
| @@ -4684,6 +4684,7 @@ static struct scsi_host_template gdth_template = { | |||
| 4684 | .cmd_per_lun = GDTH_MAXC_P_L, | 4684 | .cmd_per_lun = GDTH_MAXC_P_L, |
| 4685 | .unchecked_isa_dma = 1, | 4685 | .unchecked_isa_dma = 1, |
| 4686 | .use_clustering = ENABLE_CLUSTERING, | 4686 | .use_clustering = ENABLE_CLUSTERING, |
| 4687 | .no_write_same = 1, | ||
| 4687 | }; | 4688 | }; |
| 4688 | 4689 | ||
| 4689 | #ifdef CONFIG_ISA | 4690 | #ifdef CONFIG_ISA |
diff --git a/drivers/scsi/hosts.c b/drivers/scsi/hosts.c index f334859024c0..f2c5005f312a 100644 --- a/drivers/scsi/hosts.c +++ b/drivers/scsi/hosts.c | |||
| @@ -395,6 +395,7 @@ struct Scsi_Host *scsi_host_alloc(struct scsi_host_template *sht, int privsize) | |||
| 395 | shost->use_clustering = sht->use_clustering; | 395 | shost->use_clustering = sht->use_clustering; |
| 396 | shost->ordered_tag = sht->ordered_tag; | 396 | shost->ordered_tag = sht->ordered_tag; |
| 397 | shost->eh_deadline = shost_eh_deadline * HZ; | 397 | shost->eh_deadline = shost_eh_deadline * HZ; |
| 398 | shost->no_write_same = sht->no_write_same; | ||
| 398 | 399 | ||
| 399 | if (sht->supported_mode == MODE_UNKNOWN) | 400 | if (sht->supported_mode == MODE_UNKNOWN) |
| 400 | /* means we didn't set it ... default to INITIATOR */ | 401 | /* means we didn't set it ... default to INITIATOR */ |
diff --git a/drivers/scsi/hpsa.c b/drivers/scsi/hpsa.c index 22f6432eb475..20a5e6ecf945 100644 --- a/drivers/scsi/hpsa.c +++ b/drivers/scsi/hpsa.c | |||
| @@ -561,6 +561,7 @@ static struct scsi_host_template hpsa_driver_template = { | |||
| 561 | .sdev_attrs = hpsa_sdev_attrs, | 561 | .sdev_attrs = hpsa_sdev_attrs, |
| 562 | .shost_attrs = hpsa_shost_attrs, | 562 | .shost_attrs = hpsa_shost_attrs, |
| 563 | .max_sectors = 8192, | 563 | .max_sectors = 8192, |
| 564 | .no_write_same = 1, | ||
| 564 | }; | 565 | }; |
| 565 | 566 | ||
| 566 | 567 | ||
| @@ -1288,7 +1289,7 @@ static void complete_scsi_command(struct CommandList *cp) | |||
| 1288 | "has check condition: aborted command: " | 1289 | "has check condition: aborted command: " |
| 1289 | "ASC: 0x%x, ASCQ: 0x%x\n", | 1290 | "ASC: 0x%x, ASCQ: 0x%x\n", |
| 1290 | cp, asc, ascq); | 1291 | cp, asc, ascq); |
| 1291 | cmd->result = DID_SOFT_ERROR << 16; | 1292 | cmd->result |= DID_SOFT_ERROR << 16; |
| 1292 | break; | 1293 | break; |
| 1293 | } | 1294 | } |
| 1294 | /* Must be some other type of check condition */ | 1295 | /* Must be some other type of check condition */ |
| @@ -4925,7 +4926,7 @@ reinit_after_soft_reset: | |||
| 4925 | hpsa_hba_inquiry(h); | 4926 | hpsa_hba_inquiry(h); |
| 4926 | hpsa_register_scsi(h); /* hook ourselves into SCSI subsystem */ | 4927 | hpsa_register_scsi(h); /* hook ourselves into SCSI subsystem */ |
| 4927 | start_controller_lockup_detector(h); | 4928 | start_controller_lockup_detector(h); |
| 4928 | return 1; | 4929 | return 0; |
| 4929 | 4930 | ||
| 4930 | clean4: | 4931 | clean4: |
| 4931 | hpsa_free_sg_chain_blocks(h); | 4932 | hpsa_free_sg_chain_blocks(h); |
diff --git a/drivers/scsi/ipr.c b/drivers/scsi/ipr.c index 36ac1c34ce97..573f4128b6b6 100644 --- a/drivers/scsi/ipr.c +++ b/drivers/scsi/ipr.c | |||
| @@ -6305,7 +6305,8 @@ static struct scsi_host_template driver_template = { | |||
| 6305 | .use_clustering = ENABLE_CLUSTERING, | 6305 | .use_clustering = ENABLE_CLUSTERING, |
| 6306 | .shost_attrs = ipr_ioa_attrs, | 6306 | .shost_attrs = ipr_ioa_attrs, |
| 6307 | .sdev_attrs = ipr_dev_attrs, | 6307 | .sdev_attrs = ipr_dev_attrs, |
| 6308 | .proc_name = IPR_NAME | 6308 | .proc_name = IPR_NAME, |
| 6309 | .no_write_same = 1, | ||
| 6309 | }; | 6310 | }; |
| 6310 | 6311 | ||
| 6311 | /** | 6312 | /** |
diff --git a/drivers/scsi/ips.c b/drivers/scsi/ips.c index 8d5ea8a1e5a6..52a216f21ae5 100644 --- a/drivers/scsi/ips.c +++ b/drivers/scsi/ips.c | |||
| @@ -374,6 +374,7 @@ static struct scsi_host_template ips_driver_template = { | |||
| 374 | .sg_tablesize = IPS_MAX_SG, | 374 | .sg_tablesize = IPS_MAX_SG, |
| 375 | .cmd_per_lun = 3, | 375 | .cmd_per_lun = 3, |
| 376 | .use_clustering = ENABLE_CLUSTERING, | 376 | .use_clustering = ENABLE_CLUSTERING, |
| 377 | .no_write_same = 1, | ||
| 377 | }; | 378 | }; |
| 378 | 379 | ||
| 379 | 380 | ||
diff --git a/drivers/scsi/libsas/sas_ata.c b/drivers/scsi/libsas/sas_ata.c index 161c98efade9..d2895836f9fa 100644 --- a/drivers/scsi/libsas/sas_ata.c +++ b/drivers/scsi/libsas/sas_ata.c | |||
| @@ -211,7 +211,7 @@ static unsigned int sas_ata_qc_issue(struct ata_queued_cmd *qc) | |||
| 211 | qc->tf.nsect = 0; | 211 | qc->tf.nsect = 0; |
| 212 | } | 212 | } |
| 213 | 213 | ||
| 214 | ata_tf_to_fis(&qc->tf, 1, 0, (u8*)&task->ata_task.fis); | 214 | ata_tf_to_fis(&qc->tf, qc->dev->link->pmp, 1, (u8 *)&task->ata_task.fis); |
| 215 | task->uldd_task = qc; | 215 | task->uldd_task = qc; |
| 216 | if (ata_is_atapi(qc->tf.protocol)) { | 216 | if (ata_is_atapi(qc->tf.protocol)) { |
| 217 | memcpy(task->ata_task.atapi_packet, qc->cdb, qc->dev->cdb_len); | 217 | memcpy(task->ata_task.atapi_packet, qc->cdb, qc->dev->cdb_len); |
diff --git a/drivers/scsi/megaraid.c b/drivers/scsi/megaraid.c index 90c95a3385d1..816db12ef5d5 100644 --- a/drivers/scsi/megaraid.c +++ b/drivers/scsi/megaraid.c | |||
| @@ -4244,6 +4244,7 @@ static struct scsi_host_template megaraid_template = { | |||
| 4244 | .eh_device_reset_handler = megaraid_reset, | 4244 | .eh_device_reset_handler = megaraid_reset, |
| 4245 | .eh_bus_reset_handler = megaraid_reset, | 4245 | .eh_bus_reset_handler = megaraid_reset, |
| 4246 | .eh_host_reset_handler = megaraid_reset, | 4246 | .eh_host_reset_handler = megaraid_reset, |
| 4247 | .no_write_same = 1, | ||
| 4247 | }; | 4248 | }; |
| 4248 | 4249 | ||
| 4249 | static int | 4250 | static int |
diff --git a/drivers/scsi/megaraid/megaraid_mbox.c b/drivers/scsi/megaraid/megaraid_mbox.c index d1a4b82836ea..e2237a97cb9d 100644 --- a/drivers/scsi/megaraid/megaraid_mbox.c +++ b/drivers/scsi/megaraid/megaraid_mbox.c | |||
| @@ -367,6 +367,7 @@ static struct scsi_host_template megaraid_template_g = { | |||
| 367 | .eh_host_reset_handler = megaraid_reset_handler, | 367 | .eh_host_reset_handler = megaraid_reset_handler, |
| 368 | .change_queue_depth = megaraid_change_queue_depth, | 368 | .change_queue_depth = megaraid_change_queue_depth, |
| 369 | .use_clustering = ENABLE_CLUSTERING, | 369 | .use_clustering = ENABLE_CLUSTERING, |
| 370 | .no_write_same = 1, | ||
| 370 | .sdev_attrs = megaraid_sdev_attrs, | 371 | .sdev_attrs = megaraid_sdev_attrs, |
| 371 | .shost_attrs = megaraid_shost_attrs, | 372 | .shost_attrs = megaraid_shost_attrs, |
| 372 | }; | 373 | }; |
diff --git a/drivers/scsi/megaraid/megaraid_sas_base.c b/drivers/scsi/megaraid/megaraid_sas_base.c index 0a743a5d1647..c99812bf2a73 100644 --- a/drivers/scsi/megaraid/megaraid_sas_base.c +++ b/drivers/scsi/megaraid/megaraid_sas_base.c | |||
| @@ -2148,6 +2148,7 @@ static struct scsi_host_template megasas_template = { | |||
| 2148 | .bios_param = megasas_bios_param, | 2148 | .bios_param = megasas_bios_param, |
| 2149 | .use_clustering = ENABLE_CLUSTERING, | 2149 | .use_clustering = ENABLE_CLUSTERING, |
| 2150 | .change_queue_depth = megasas_change_queue_depth, | 2150 | .change_queue_depth = megasas_change_queue_depth, |
| 2151 | .no_write_same = 1, | ||
| 2151 | }; | 2152 | }; |
| 2152 | 2153 | ||
| 2153 | /** | 2154 | /** |
diff --git a/drivers/scsi/pm8001/pm8001_hwi.c b/drivers/scsi/pm8001/pm8001_hwi.c index f16ece91b94a..0a1296a87d66 100644 --- a/drivers/scsi/pm8001/pm8001_hwi.c +++ b/drivers/scsi/pm8001/pm8001_hwi.c | |||
| @@ -3403,6 +3403,7 @@ hw_event_sas_phy_up(struct pm8001_hba_info *pm8001_ha, void *piomb) | |||
| 3403 | unsigned long flags; | 3403 | unsigned long flags; |
| 3404 | u8 deviceType = pPayload->sas_identify.dev_type; | 3404 | u8 deviceType = pPayload->sas_identify.dev_type; |
| 3405 | port->port_state = portstate; | 3405 | port->port_state = portstate; |
| 3406 | phy->phy_state = PHY_STATE_LINK_UP_SPC; | ||
| 3406 | PM8001_MSG_DBG(pm8001_ha, | 3407 | PM8001_MSG_DBG(pm8001_ha, |
| 3407 | pm8001_printk("HW_EVENT_SAS_PHY_UP port id = %d, phy id = %d\n", | 3408 | pm8001_printk("HW_EVENT_SAS_PHY_UP port id = %d, phy id = %d\n", |
| 3408 | port_id, phy_id)); | 3409 | port_id, phy_id)); |
| @@ -3483,6 +3484,7 @@ hw_event_sata_phy_up(struct pm8001_hba_info *pm8001_ha, void *piomb) | |||
| 3483 | pm8001_printk("HW_EVENT_SATA_PHY_UP port id = %d," | 3484 | pm8001_printk("HW_EVENT_SATA_PHY_UP port id = %d," |
| 3484 | " phy id = %d\n", port_id, phy_id)); | 3485 | " phy id = %d\n", port_id, phy_id)); |
| 3485 | port->port_state = portstate; | 3486 | port->port_state = portstate; |
| 3487 | phy->phy_state = PHY_STATE_LINK_UP_SPC; | ||
| 3486 | port->port_attached = 1; | 3488 | port->port_attached = 1; |
| 3487 | pm8001_get_lrate_mode(phy, link_rate); | 3489 | pm8001_get_lrate_mode(phy, link_rate); |
| 3488 | phy->phy_type |= PORT_TYPE_SATA; | 3490 | phy->phy_type |= PORT_TYPE_SATA; |
diff --git a/drivers/scsi/pm8001/pm8001_hwi.h b/drivers/scsi/pm8001/pm8001_hwi.h index 6d91e2446542..e4867e690c84 100644 --- a/drivers/scsi/pm8001/pm8001_hwi.h +++ b/drivers/scsi/pm8001/pm8001_hwi.h | |||
| @@ -131,6 +131,10 @@ | |||
| 131 | #define LINKRATE_30 (0x02 << 8) | 131 | #define LINKRATE_30 (0x02 << 8) |
| 132 | #define LINKRATE_60 (0x04 << 8) | 132 | #define LINKRATE_60 (0x04 << 8) |
| 133 | 133 | ||
| 134 | /* for phy state */ | ||
| 135 | |||
| 136 | #define PHY_STATE_LINK_UP_SPC 0x1 | ||
| 137 | |||
| 134 | /* for new SPC controllers MEMBASE III is shared between BIOS and DATA */ | 138 | /* for new SPC controllers MEMBASE III is shared between BIOS and DATA */ |
| 135 | #define GSM_SM_BASE 0x4F0000 | 139 | #define GSM_SM_BASE 0x4F0000 |
| 136 | struct mpi_msg_hdr{ | 140 | struct mpi_msg_hdr{ |
diff --git a/drivers/scsi/pm8001/pm8001_init.c b/drivers/scsi/pm8001/pm8001_init.c index 34f5f5ffef05..73a120d81b4d 100644 --- a/drivers/scsi/pm8001/pm8001_init.c +++ b/drivers/scsi/pm8001/pm8001_init.c | |||
| @@ -175,20 +175,16 @@ static void pm8001_free(struct pm8001_hba_info *pm8001_ha) | |||
| 175 | static void pm8001_tasklet(unsigned long opaque) | 175 | static void pm8001_tasklet(unsigned long opaque) |
| 176 | { | 176 | { |
| 177 | struct pm8001_hba_info *pm8001_ha; | 177 | struct pm8001_hba_info *pm8001_ha; |
| 178 | u32 vec; | 178 | struct isr_param *irq_vector; |
| 179 | pm8001_ha = (struct pm8001_hba_info *)opaque; | 179 | |
| 180 | irq_vector = (struct isr_param *)opaque; | ||
| 181 | pm8001_ha = irq_vector->drv_inst; | ||
| 180 | if (unlikely(!pm8001_ha)) | 182 | if (unlikely(!pm8001_ha)) |
| 181 | BUG_ON(1); | 183 | BUG_ON(1); |
| 182 | vec = pm8001_ha->int_vector; | 184 | PM8001_CHIP_DISP->isr(pm8001_ha, irq_vector->irq_id); |
| 183 | PM8001_CHIP_DISP->isr(pm8001_ha, vec); | ||
| 184 | } | 185 | } |
| 185 | #endif | 186 | #endif |
| 186 | 187 | ||
| 187 | static struct pm8001_hba_info *outq_to_hba(u8 *outq) | ||
| 188 | { | ||
| 189 | return container_of((outq - *outq), struct pm8001_hba_info, outq[0]); | ||
| 190 | } | ||
| 191 | |||
| 192 | /** | 188 | /** |
| 193 | * pm8001_interrupt_handler_msix - main MSIX interrupt handler. | 189 | * pm8001_interrupt_handler_msix - main MSIX interrupt handler. |
| 194 | * It obtains the vector number and calls the equivalent bottom | 190 | * It obtains the vector number and calls the equivalent bottom |
| @@ -198,18 +194,20 @@ static struct pm8001_hba_info *outq_to_hba(u8 *outq) | |||
| 198 | */ | 194 | */ |
| 199 | static irqreturn_t pm8001_interrupt_handler_msix(int irq, void *opaque) | 195 | static irqreturn_t pm8001_interrupt_handler_msix(int irq, void *opaque) |
| 200 | { | 196 | { |
| 201 | struct pm8001_hba_info *pm8001_ha = outq_to_hba(opaque); | 197 | struct isr_param *irq_vector; |
| 202 | u8 outq = *(u8 *)opaque; | 198 | struct pm8001_hba_info *pm8001_ha; |
| 203 | irqreturn_t ret = IRQ_HANDLED; | 199 | irqreturn_t ret = IRQ_HANDLED; |
| 200 | irq_vector = (struct isr_param *)opaque; | ||
| 201 | pm8001_ha = irq_vector->drv_inst; | ||
| 202 | |||
| 204 | if (unlikely(!pm8001_ha)) | 203 | if (unlikely(!pm8001_ha)) |
| 205 | return IRQ_NONE; | 204 | return IRQ_NONE; |
| 206 | if (!PM8001_CHIP_DISP->is_our_interupt(pm8001_ha)) | 205 | if (!PM8001_CHIP_DISP->is_our_interupt(pm8001_ha)) |
| 207 | return IRQ_NONE; | 206 | return IRQ_NONE; |
| 208 | pm8001_ha->int_vector = outq; | ||
| 209 | #ifdef PM8001_USE_TASKLET | 207 | #ifdef PM8001_USE_TASKLET |
| 210 | tasklet_schedule(&pm8001_ha->tasklet); | 208 | tasklet_schedule(&pm8001_ha->tasklet[irq_vector->irq_id]); |
| 211 | #else | 209 | #else |
| 212 | ret = PM8001_CHIP_DISP->isr(pm8001_ha, outq); | 210 | ret = PM8001_CHIP_DISP->isr(pm8001_ha, irq_vector->irq_id); |
| 213 | #endif | 211 | #endif |
| 214 | return ret; | 212 | return ret; |
| 215 | } | 213 | } |
| @@ -230,9 +228,8 @@ static irqreturn_t pm8001_interrupt_handler_intx(int irq, void *dev_id) | |||
| 230 | if (!PM8001_CHIP_DISP->is_our_interupt(pm8001_ha)) | 228 | if (!PM8001_CHIP_DISP->is_our_interupt(pm8001_ha)) |
| 231 | return IRQ_NONE; | 229 | return IRQ_NONE; |
| 232 | 230 | ||
| 233 | pm8001_ha->int_vector = 0; | ||
| 234 | #ifdef PM8001_USE_TASKLET | 231 | #ifdef PM8001_USE_TASKLET |
| 235 | tasklet_schedule(&pm8001_ha->tasklet); | 232 | tasklet_schedule(&pm8001_ha->tasklet[0]); |
| 236 | #else | 233 | #else |
| 237 | ret = PM8001_CHIP_DISP->isr(pm8001_ha, 0); | 234 | ret = PM8001_CHIP_DISP->isr(pm8001_ha, 0); |
| 238 | #endif | 235 | #endif |
| @@ -457,7 +454,7 @@ static struct pm8001_hba_info *pm8001_pci_alloc(struct pci_dev *pdev, | |||
| 457 | { | 454 | { |
| 458 | struct pm8001_hba_info *pm8001_ha; | 455 | struct pm8001_hba_info *pm8001_ha; |
| 459 | struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost); | 456 | struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost); |
| 460 | 457 | int j; | |
| 461 | 458 | ||
| 462 | pm8001_ha = sha->lldd_ha; | 459 | pm8001_ha = sha->lldd_ha; |
| 463 | if (!pm8001_ha) | 460 | if (!pm8001_ha) |
| @@ -480,12 +477,14 @@ static struct pm8001_hba_info *pm8001_pci_alloc(struct pci_dev *pdev, | |||
| 480 | pm8001_ha->iomb_size = IOMB_SIZE_SPC; | 477 | pm8001_ha->iomb_size = IOMB_SIZE_SPC; |
| 481 | 478 | ||
| 482 | #ifdef PM8001_USE_TASKLET | 479 | #ifdef PM8001_USE_TASKLET |
| 483 | /** | 480 | /* Tasklet for non msi-x interrupt handler */ |
| 484 | * default tasklet for non msi-x interrupt handler/first msi-x | 481 | if ((!pdev->msix_cap) || (pm8001_ha->chip_id == chip_8001)) |
| 485 | * interrupt handler | 482 | tasklet_init(&pm8001_ha->tasklet[0], pm8001_tasklet, |
| 486 | **/ | 483 | (unsigned long)&(pm8001_ha->irq_vector[0])); |
| 487 | tasklet_init(&pm8001_ha->tasklet, pm8001_tasklet, | 484 | else |
| 488 | (unsigned long)pm8001_ha); | 485 | for (j = 0; j < PM8001_MAX_MSIX_VEC; j++) |
| 486 | tasklet_init(&pm8001_ha->tasklet[j], pm8001_tasklet, | ||
| 487 | (unsigned long)&(pm8001_ha->irq_vector[j])); | ||
| 489 | #endif | 488 | #endif |
| 490 | pm8001_ioremap(pm8001_ha); | 489 | pm8001_ioremap(pm8001_ha); |
| 491 | if (!pm8001_alloc(pm8001_ha, ent)) | 490 | if (!pm8001_alloc(pm8001_ha, ent)) |
| @@ -733,19 +732,20 @@ static u32 pm8001_setup_msix(struct pm8001_hba_info *pm8001_ha) | |||
| 733 | "pci_enable_msix request ret:%d no of intr %d\n", | 732 | "pci_enable_msix request ret:%d no of intr %d\n", |
| 734 | rc, pm8001_ha->number_of_intr)); | 733 | rc, pm8001_ha->number_of_intr)); |
| 735 | 734 | ||
| 736 | for (i = 0; i < number_of_intr; i++) | ||
| 737 | pm8001_ha->outq[i] = i; | ||
| 738 | 735 | ||
| 739 | for (i = 0; i < number_of_intr; i++) { | 736 | for (i = 0; i < number_of_intr; i++) { |
| 740 | snprintf(intr_drvname[i], sizeof(intr_drvname[0]), | 737 | snprintf(intr_drvname[i], sizeof(intr_drvname[0]), |
| 741 | DRV_NAME"%d", i); | 738 | DRV_NAME"%d", i); |
| 739 | pm8001_ha->irq_vector[i].irq_id = i; | ||
| 740 | pm8001_ha->irq_vector[i].drv_inst = pm8001_ha; | ||
| 741 | |||
| 742 | if (request_irq(pm8001_ha->msix_entries[i].vector, | 742 | if (request_irq(pm8001_ha->msix_entries[i].vector, |
| 743 | pm8001_interrupt_handler_msix, flag, | 743 | pm8001_interrupt_handler_msix, flag, |
| 744 | intr_drvname[i], &pm8001_ha->outq[i])) { | 744 | intr_drvname[i], &(pm8001_ha->irq_vector[i]))) { |
| 745 | for (j = 0; j < i; j++) | 745 | for (j = 0; j < i; j++) |
| 746 | free_irq( | 746 | free_irq( |
| 747 | pm8001_ha->msix_entries[j].vector, | 747 | pm8001_ha->msix_entries[j].vector, |
| 748 | &pm8001_ha->outq[j]); | 748 | &(pm8001_ha->irq_vector[i])); |
| 749 | pci_disable_msix(pm8001_ha->pdev); | 749 | pci_disable_msix(pm8001_ha->pdev); |
| 750 | break; | 750 | break; |
| 751 | } | 751 | } |
| @@ -907,7 +907,7 @@ static void pm8001_pci_remove(struct pci_dev *pdev) | |||
| 907 | { | 907 | { |
| 908 | struct sas_ha_struct *sha = pci_get_drvdata(pdev); | 908 | struct sas_ha_struct *sha = pci_get_drvdata(pdev); |
| 909 | struct pm8001_hba_info *pm8001_ha; | 909 | struct pm8001_hba_info *pm8001_ha; |
| 910 | int i; | 910 | int i, j; |
| 911 | pm8001_ha = sha->lldd_ha; | 911 | pm8001_ha = sha->lldd_ha; |
| 912 | sas_unregister_ha(sha); | 912 | sas_unregister_ha(sha); |
| 913 | sas_remove_host(pm8001_ha->shost); | 913 | sas_remove_host(pm8001_ha->shost); |
| @@ -921,13 +921,18 @@ static void pm8001_pci_remove(struct pci_dev *pdev) | |||
| 921 | synchronize_irq(pm8001_ha->msix_entries[i].vector); | 921 | synchronize_irq(pm8001_ha->msix_entries[i].vector); |
| 922 | for (i = 0; i < pm8001_ha->number_of_intr; i++) | 922 | for (i = 0; i < pm8001_ha->number_of_intr; i++) |
| 923 | free_irq(pm8001_ha->msix_entries[i].vector, | 923 | free_irq(pm8001_ha->msix_entries[i].vector, |
| 924 | &pm8001_ha->outq[i]); | 924 | &(pm8001_ha->irq_vector[i])); |
| 925 | pci_disable_msix(pdev); | 925 | pci_disable_msix(pdev); |
| 926 | #else | 926 | #else |
| 927 | free_irq(pm8001_ha->irq, sha); | 927 | free_irq(pm8001_ha->irq, sha); |
| 928 | #endif | 928 | #endif |
| 929 | #ifdef PM8001_USE_TASKLET | 929 | #ifdef PM8001_USE_TASKLET |
| 930 | tasklet_kill(&pm8001_ha->tasklet); | 930 | /* For non-msix and msix interrupts */ |
| 931 | if ((!pdev->msix_cap) || (pm8001_ha->chip_id == chip_8001)) | ||
| 932 | tasklet_kill(&pm8001_ha->tasklet[0]); | ||
| 933 | else | ||
| 934 | for (j = 0; j < PM8001_MAX_MSIX_VEC; j++) | ||
| 935 | tasklet_kill(&pm8001_ha->tasklet[j]); | ||
| 931 | #endif | 936 | #endif |
| 932 | pm8001_free(pm8001_ha); | 937 | pm8001_free(pm8001_ha); |
| 933 | kfree(sha->sas_phy); | 938 | kfree(sha->sas_phy); |
| @@ -948,7 +953,7 @@ static int pm8001_pci_suspend(struct pci_dev *pdev, pm_message_t state) | |||
| 948 | { | 953 | { |
| 949 | struct sas_ha_struct *sha = pci_get_drvdata(pdev); | 954 | struct sas_ha_struct *sha = pci_get_drvdata(pdev); |
| 950 | struct pm8001_hba_info *pm8001_ha; | 955 | struct pm8001_hba_info *pm8001_ha; |
| 951 | int i; | 956 | int i, j; |
| 952 | u32 device_state; | 957 | u32 device_state; |
| 953 | pm8001_ha = sha->lldd_ha; | 958 | pm8001_ha = sha->lldd_ha; |
| 954 | flush_workqueue(pm8001_wq); | 959 | flush_workqueue(pm8001_wq); |
| @@ -964,13 +969,18 @@ static int pm8001_pci_suspend(struct pci_dev *pdev, pm_message_t state) | |||
| 964 | synchronize_irq(pm8001_ha->msix_entries[i].vector); | 969 | synchronize_irq(pm8001_ha->msix_entries[i].vector); |
| 965 | for (i = 0; i < pm8001_ha->number_of_intr; i++) | 970 | for (i = 0; i < pm8001_ha->number_of_intr; i++) |
| 966 | free_irq(pm8001_ha->msix_entries[i].vector, | 971 | free_irq(pm8001_ha->msix_entries[i].vector, |
| 967 | &pm8001_ha->outq[i]); | 972 | &(pm8001_ha->irq_vector[i])); |
| 968 | pci_disable_msix(pdev); | 973 | pci_disable_msix(pdev); |
| 969 | #else | 974 | #else |
| 970 | free_irq(pm8001_ha->irq, sha); | 975 | free_irq(pm8001_ha->irq, sha); |
| 971 | #endif | 976 | #endif |
| 972 | #ifdef PM8001_USE_TASKLET | 977 | #ifdef PM8001_USE_TASKLET |
| 973 | tasklet_kill(&pm8001_ha->tasklet); | 978 | /* For non-msix and msix interrupts */ |
| 979 | if ((!pdev->msix_cap) || (pm8001_ha->chip_id == chip_8001)) | ||
| 980 | tasklet_kill(&pm8001_ha->tasklet[0]); | ||
| 981 | else | ||
| 982 | for (j = 0; j < PM8001_MAX_MSIX_VEC; j++) | ||
| 983 | tasklet_kill(&pm8001_ha->tasklet[j]); | ||
| 974 | #endif | 984 | #endif |
| 975 | device_state = pci_choose_state(pdev, state); | 985 | device_state = pci_choose_state(pdev, state); |
| 976 | pm8001_printk("pdev=0x%p, slot=%s, entering " | 986 | pm8001_printk("pdev=0x%p, slot=%s, entering " |
| @@ -993,7 +1003,7 @@ static int pm8001_pci_resume(struct pci_dev *pdev) | |||
| 993 | struct sas_ha_struct *sha = pci_get_drvdata(pdev); | 1003 | struct sas_ha_struct *sha = pci_get_drvdata(pdev); |
| 994 | struct pm8001_hba_info *pm8001_ha; | 1004 | struct pm8001_hba_info *pm8001_ha; |
| 995 | int rc; | 1005 | int rc; |
| 996 | u8 i = 0; | 1006 | u8 i = 0, j; |
| 997 | u32 device_state; | 1007 | u32 device_state; |
| 998 | pm8001_ha = sha->lldd_ha; | 1008 | pm8001_ha = sha->lldd_ha; |
| 999 | device_state = pdev->current_state; | 1009 | device_state = pdev->current_state; |
| @@ -1033,10 +1043,14 @@ static int pm8001_pci_resume(struct pci_dev *pdev) | |||
| 1033 | if (rc) | 1043 | if (rc) |
| 1034 | goto err_out_disable; | 1044 | goto err_out_disable; |
| 1035 | #ifdef PM8001_USE_TASKLET | 1045 | #ifdef PM8001_USE_TASKLET |
| 1036 | /* default tasklet for non msi-x interrupt handler/first msi-x | 1046 | /* Tasklet for non msi-x interrupt handler */ |
| 1037 | * interrupt handler */ | 1047 | if ((!pdev->msix_cap) || (pm8001_ha->chip_id == chip_8001)) |
| 1038 | tasklet_init(&pm8001_ha->tasklet, pm8001_tasklet, | 1048 | tasklet_init(&pm8001_ha->tasklet[0], pm8001_tasklet, |
| 1039 | (unsigned long)pm8001_ha); | 1049 | (unsigned long)&(pm8001_ha->irq_vector[0])); |
| 1050 | else | ||
| 1051 | for (j = 0; j < PM8001_MAX_MSIX_VEC; j++) | ||
| 1052 | tasklet_init(&pm8001_ha->tasklet[j], pm8001_tasklet, | ||
| 1053 | (unsigned long)&(pm8001_ha->irq_vector[j])); | ||
| 1040 | #endif | 1054 | #endif |
| 1041 | PM8001_CHIP_DISP->interrupt_enable(pm8001_ha, 0); | 1055 | PM8001_CHIP_DISP->interrupt_enable(pm8001_ha, 0); |
| 1042 | if (pm8001_ha->chip_id != chip_8001) { | 1056 | if (pm8001_ha->chip_id != chip_8001) { |
| @@ -1169,6 +1183,7 @@ module_exit(pm8001_exit); | |||
| 1169 | MODULE_AUTHOR("Jack Wang <jack_wang@usish.com>"); | 1183 | MODULE_AUTHOR("Jack Wang <jack_wang@usish.com>"); |
| 1170 | MODULE_AUTHOR("Anand Kumar Santhanam <AnandKumar.Santhanam@pmcs.com>"); | 1184 | MODULE_AUTHOR("Anand Kumar Santhanam <AnandKumar.Santhanam@pmcs.com>"); |
| 1171 | MODULE_AUTHOR("Sangeetha Gnanasekaran <Sangeetha.Gnanasekaran@pmcs.com>"); | 1185 | MODULE_AUTHOR("Sangeetha Gnanasekaran <Sangeetha.Gnanasekaran@pmcs.com>"); |
| 1186 | MODULE_AUTHOR("Nikith Ganigarakoppal <Nikith.Ganigarakoppal@pmcs.com>"); | ||
| 1172 | MODULE_DESCRIPTION( | 1187 | MODULE_DESCRIPTION( |
| 1173 | "PMC-Sierra PM8001/8081/8088/8089/8074/8076/8077 " | 1188 | "PMC-Sierra PM8001/8081/8088/8089/8074/8076/8077 " |
| 1174 | "SAS/SATA controller driver"); | 1189 | "SAS/SATA controller driver"); |
diff --git a/drivers/scsi/pm8001/pm8001_sas.c b/drivers/scsi/pm8001/pm8001_sas.c index f4eb18e51631..f50ac44b950e 100644 --- a/drivers/scsi/pm8001/pm8001_sas.c +++ b/drivers/scsi/pm8001/pm8001_sas.c | |||
| @@ -1098,15 +1098,17 @@ int pm8001_lu_reset(struct domain_device *dev, u8 *lun) | |||
| 1098 | struct pm8001_tmf_task tmf_task; | 1098 | struct pm8001_tmf_task tmf_task; |
| 1099 | struct pm8001_device *pm8001_dev = dev->lldd_dev; | 1099 | struct pm8001_device *pm8001_dev = dev->lldd_dev; |
| 1100 | struct pm8001_hba_info *pm8001_ha = pm8001_find_ha_by_dev(dev); | 1100 | struct pm8001_hba_info *pm8001_ha = pm8001_find_ha_by_dev(dev); |
| 1101 | DECLARE_COMPLETION_ONSTACK(completion_setstate); | ||
| 1101 | if (dev_is_sata(dev)) { | 1102 | if (dev_is_sata(dev)) { |
| 1102 | struct sas_phy *phy = sas_get_local_phy(dev); | 1103 | struct sas_phy *phy = sas_get_local_phy(dev); |
| 1103 | rc = pm8001_exec_internal_task_abort(pm8001_ha, pm8001_dev , | 1104 | rc = pm8001_exec_internal_task_abort(pm8001_ha, pm8001_dev , |
| 1104 | dev, 1, 0); | 1105 | dev, 1, 0); |
| 1105 | rc = sas_phy_reset(phy, 1); | 1106 | rc = sas_phy_reset(phy, 1); |
| 1106 | sas_put_local_phy(phy); | 1107 | sas_put_local_phy(phy); |
| 1108 | pm8001_dev->setds_completion = &completion_setstate; | ||
| 1107 | rc = PM8001_CHIP_DISP->set_dev_state_req(pm8001_ha, | 1109 | rc = PM8001_CHIP_DISP->set_dev_state_req(pm8001_ha, |
| 1108 | pm8001_dev, 0x01); | 1110 | pm8001_dev, 0x01); |
| 1109 | msleep(2000); | 1111 | wait_for_completion(&completion_setstate); |
| 1110 | } else { | 1112 | } else { |
| 1111 | tmf_task.tmf = TMF_LU_RESET; | 1113 | tmf_task.tmf = TMF_LU_RESET; |
| 1112 | rc = pm8001_issue_ssp_tmf(dev, lun, &tmf_task); | 1114 | rc = pm8001_issue_ssp_tmf(dev, lun, &tmf_task); |
diff --git a/drivers/scsi/pm8001/pm8001_sas.h b/drivers/scsi/pm8001/pm8001_sas.h index 6037d477a183..6c5fd5ee22d3 100644 --- a/drivers/scsi/pm8001/pm8001_sas.h +++ b/drivers/scsi/pm8001/pm8001_sas.h | |||
| @@ -466,6 +466,10 @@ struct pm8001_hba_memspace { | |||
| 466 | u64 membase; | 466 | u64 membase; |
| 467 | u32 memsize; | 467 | u32 memsize; |
| 468 | }; | 468 | }; |
| 469 | struct isr_param { | ||
| 470 | struct pm8001_hba_info *drv_inst; | ||
| 471 | u32 irq_id; | ||
| 472 | }; | ||
| 469 | struct pm8001_hba_info { | 473 | struct pm8001_hba_info { |
| 470 | char name[PM8001_NAME_LENGTH]; | 474 | char name[PM8001_NAME_LENGTH]; |
| 471 | struct list_head list; | 475 | struct list_head list; |
| @@ -519,14 +523,13 @@ struct pm8001_hba_info { | |||
| 519 | int number_of_intr;/*will be used in remove()*/ | 523 | int number_of_intr;/*will be used in remove()*/ |
| 520 | #endif | 524 | #endif |
| 521 | #ifdef PM8001_USE_TASKLET | 525 | #ifdef PM8001_USE_TASKLET |
| 522 | struct tasklet_struct tasklet; | 526 | struct tasklet_struct tasklet[PM8001_MAX_MSIX_VEC]; |
| 523 | #endif | 527 | #endif |
| 524 | u32 logging_level; | 528 | u32 logging_level; |
| 525 | u32 fw_status; | 529 | u32 fw_status; |
| 526 | u32 smp_exp_mode; | 530 | u32 smp_exp_mode; |
| 527 | u32 int_vector; | ||
| 528 | const struct firmware *fw_image; | 531 | const struct firmware *fw_image; |
| 529 | u8 outq[PM8001_MAX_MSIX_VEC]; | 532 | struct isr_param irq_vector[PM8001_MAX_MSIX_VEC]; |
| 530 | }; | 533 | }; |
| 531 | 534 | ||
| 532 | struct pm8001_work { | 535 | struct pm8001_work { |
diff --git a/drivers/scsi/pm8001/pm80xx_hwi.c b/drivers/scsi/pm8001/pm80xx_hwi.c index 8987b1706216..c950dc5c9943 100644 --- a/drivers/scsi/pm8001/pm80xx_hwi.c +++ b/drivers/scsi/pm8001/pm80xx_hwi.c | |||
| @@ -2894,6 +2894,7 @@ hw_event_sas_phy_up(struct pm8001_hba_info *pm8001_ha, void *piomb) | |||
| 2894 | unsigned long flags; | 2894 | unsigned long flags; |
| 2895 | u8 deviceType = pPayload->sas_identify.dev_type; | 2895 | u8 deviceType = pPayload->sas_identify.dev_type; |
| 2896 | port->port_state = portstate; | 2896 | port->port_state = portstate; |
| 2897 | phy->phy_state = PHY_STATE_LINK_UP_SPCV; | ||
| 2897 | PM8001_MSG_DBG(pm8001_ha, pm8001_printk( | 2898 | PM8001_MSG_DBG(pm8001_ha, pm8001_printk( |
| 2898 | "portid:%d; phyid:%d; linkrate:%d; " | 2899 | "portid:%d; phyid:%d; linkrate:%d; " |
| 2899 | "portstate:%x; devicetype:%x\n", | 2900 | "portstate:%x; devicetype:%x\n", |
| @@ -2978,6 +2979,7 @@ hw_event_sata_phy_up(struct pm8001_hba_info *pm8001_ha, void *piomb) | |||
| 2978 | port_id, phy_id, link_rate, portstate)); | 2979 | port_id, phy_id, link_rate, portstate)); |
| 2979 | 2980 | ||
| 2980 | port->port_state = portstate; | 2981 | port->port_state = portstate; |
| 2982 | phy->phy_state = PHY_STATE_LINK_UP_SPCV; | ||
| 2981 | port->port_attached = 1; | 2983 | port->port_attached = 1; |
| 2982 | pm8001_get_lrate_mode(phy, link_rate); | 2984 | pm8001_get_lrate_mode(phy, link_rate); |
| 2983 | phy->phy_type |= PORT_TYPE_SATA; | 2985 | phy->phy_type |= PORT_TYPE_SATA; |
diff --git a/drivers/scsi/pm8001/pm80xx_hwi.h b/drivers/scsi/pm8001/pm80xx_hwi.h index c86816bea424..9970a385795d 100644 --- a/drivers/scsi/pm8001/pm80xx_hwi.h +++ b/drivers/scsi/pm8001/pm80xx_hwi.h | |||
| @@ -215,6 +215,8 @@ | |||
| 215 | #define SAS_DOPNRJT_RTRY_TMO 128 | 215 | #define SAS_DOPNRJT_RTRY_TMO 128 |
| 216 | #define SAS_COPNRJT_RTRY_TMO 128 | 216 | #define SAS_COPNRJT_RTRY_TMO 128 |
| 217 | 217 | ||
| 218 | /* for phy state */ | ||
| 219 | #define PHY_STATE_LINK_UP_SPCV 0x2 | ||
| 218 | /* | 220 | /* |
| 219 | Making ORR bigger than IT NEXUS LOSS which is 2000000us = 2 second. | 221 | Making ORR bigger than IT NEXUS LOSS which is 2000000us = 2 second. |
| 220 | Assuming a bigger value 3 second, 3000000/128 = 23437.5 where 128 | 222 | Assuming a bigger value 3 second, 3000000/128 = 23437.5 where 128 |
diff --git a/drivers/scsi/pmcraid.c b/drivers/scsi/pmcraid.c index bd6f743d87a7..be8ce54f99b2 100644 --- a/drivers/scsi/pmcraid.c +++ b/drivers/scsi/pmcraid.c | |||
| @@ -1404,11 +1404,22 @@ enum { | |||
| 1404 | }; | 1404 | }; |
| 1405 | #define PMCRAID_AEN_CMD_MAX (__PMCRAID_AEN_CMD_MAX - 1) | 1405 | #define PMCRAID_AEN_CMD_MAX (__PMCRAID_AEN_CMD_MAX - 1) |
| 1406 | 1406 | ||
| 1407 | static struct genl_multicast_group pmcraid_mcgrps[] = { | ||
| 1408 | { .name = "events", /* not really used - see ID discussion below */ }, | ||
| 1409 | }; | ||
| 1410 | |||
| 1407 | static struct genl_family pmcraid_event_family = { | 1411 | static struct genl_family pmcraid_event_family = { |
| 1408 | .id = GENL_ID_GENERATE, | 1412 | /* |
| 1413 | * Due to prior multicast group abuse (the code having assumed that | ||
| 1414 | * the family ID can be used as a multicast group ID) we need to | ||
| 1415 | * statically allocate a family (and thus group) ID. | ||
| 1416 | */ | ||
| 1417 | .id = GENL_ID_PMCRAID, | ||
| 1409 | .name = "pmcraid", | 1418 | .name = "pmcraid", |
| 1410 | .version = 1, | 1419 | .version = 1, |
| 1411 | .maxattr = PMCRAID_AEN_ATTR_MAX | 1420 | .maxattr = PMCRAID_AEN_ATTR_MAX, |
| 1421 | .mcgrps = pmcraid_mcgrps, | ||
| 1422 | .n_mcgrps = ARRAY_SIZE(pmcraid_mcgrps), | ||
| 1412 | }; | 1423 | }; |
| 1413 | 1424 | ||
| 1414 | /** | 1425 | /** |
| @@ -1511,9 +1522,8 @@ static int pmcraid_notify_aen( | |||
| 1511 | return result; | 1522 | return result; |
| 1512 | } | 1523 | } |
| 1513 | 1524 | ||
| 1514 | result = | 1525 | result = genlmsg_multicast(&pmcraid_event_family, skb, |
| 1515 | genlmsg_multicast(&pmcraid_event_family, skb, 0, | 1526 | 0, 0, GFP_ATOMIC); |
| 1516 | pmcraid_event_family.id, GFP_ATOMIC); | ||
| 1517 | 1527 | ||
| 1518 | /* If there are no listeners, genlmsg_multicast may return non-zero | 1528 | /* If there are no listeners, genlmsg_multicast may return non-zero |
| 1519 | * value. | 1529 | * value. |
| @@ -4315,6 +4325,7 @@ static struct scsi_host_template pmcraid_host_template = { | |||
| 4315 | .this_id = -1, | 4325 | .this_id = -1, |
| 4316 | .sg_tablesize = PMCRAID_MAX_IOADLS, | 4326 | .sg_tablesize = PMCRAID_MAX_IOADLS, |
| 4317 | .max_sectors = PMCRAID_IOA_MAX_SECTORS, | 4327 | .max_sectors = PMCRAID_IOA_MAX_SECTORS, |
| 4328 | .no_write_same = 1, | ||
| 4318 | .cmd_per_lun = PMCRAID_MAX_CMD_PER_LUN, | 4329 | .cmd_per_lun = PMCRAID_MAX_CMD_PER_LUN, |
| 4319 | .use_clustering = ENABLE_CLUSTERING, | 4330 | .use_clustering = ENABLE_CLUSTERING, |
| 4320 | .shost_attrs = pmcraid_host_attrs, | 4331 | .shost_attrs = pmcraid_host_attrs, |
diff --git a/drivers/scsi/sd.c b/drivers/scsi/sd.c index e6c4bff04339..69725f7c32c1 100644 --- a/drivers/scsi/sd.c +++ b/drivers/scsi/sd.c | |||
| @@ -2659,6 +2659,12 @@ static void sd_read_write_same(struct scsi_disk *sdkp, unsigned char *buffer) | |||
| 2659 | { | 2659 | { |
| 2660 | struct scsi_device *sdev = sdkp->device; | 2660 | struct scsi_device *sdev = sdkp->device; |
| 2661 | 2661 | ||
| 2662 | if (sdev->host->no_write_same) { | ||
| 2663 | sdev->no_write_same = 1; | ||
| 2664 | |||
| 2665 | return; | ||
| 2666 | } | ||
| 2667 | |||
| 2662 | if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, INQUIRY) < 0) { | 2668 | if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, INQUIRY) < 0) { |
| 2663 | /* too large values might cause issues with arcmsr */ | 2669 | /* too large values might cause issues with arcmsr */ |
| 2664 | int vpd_buf_len = 64; | 2670 | int vpd_buf_len = 64; |
diff --git a/drivers/scsi/storvsc_drv.c b/drivers/scsi/storvsc_drv.c index 1a28f5632797..17d740427240 100644 --- a/drivers/scsi/storvsc_drv.c +++ b/drivers/scsi/storvsc_drv.c | |||
| @@ -1697,6 +1697,7 @@ static struct scsi_host_template scsi_driver = { | |||
| 1697 | .use_clustering = DISABLE_CLUSTERING, | 1697 | .use_clustering = DISABLE_CLUSTERING, |
| 1698 | /* Make sure we dont get a sg segment crosses a page boundary */ | 1698 | /* Make sure we dont get a sg segment crosses a page boundary */ |
| 1699 | .dma_boundary = PAGE_SIZE-1, | 1699 | .dma_boundary = PAGE_SIZE-1, |
| 1700 | .no_write_same = 1, | ||
| 1700 | }; | 1701 | }; |
| 1701 | 1702 | ||
| 1702 | enum { | 1703 | enum { |
diff --git a/drivers/spi/spi-bcm2835.c b/drivers/spi/spi-bcm2835.c index 3ed666fe840a..9025edd7dc45 100644 --- a/drivers/spi/spi-bcm2835.c +++ b/drivers/spi/spi-bcm2835.c | |||
| @@ -377,7 +377,7 @@ out_master_put: | |||
| 377 | 377 | ||
| 378 | static int bcm2835_spi_remove(struct platform_device *pdev) | 378 | static int bcm2835_spi_remove(struct platform_device *pdev) |
| 379 | { | 379 | { |
| 380 | struct spi_master *master = spi_master_get(platform_get_drvdata(pdev)); | 380 | struct spi_master *master = platform_get_drvdata(pdev); |
| 381 | struct bcm2835_spi *bs = spi_master_get_devdata(master); | 381 | struct bcm2835_spi *bs = spi_master_get_devdata(master); |
| 382 | 382 | ||
| 383 | free_irq(bs->irq, master); | 383 | free_irq(bs->irq, master); |
diff --git a/drivers/spi/spi-bcm63xx.c b/drivers/spi/spi-bcm63xx.c index 80d56b214eb5..469ecd876358 100644 --- a/drivers/spi/spi-bcm63xx.c +++ b/drivers/spi/spi-bcm63xx.c | |||
| @@ -435,7 +435,7 @@ out: | |||
| 435 | 435 | ||
| 436 | static int bcm63xx_spi_remove(struct platform_device *pdev) | 436 | static int bcm63xx_spi_remove(struct platform_device *pdev) |
| 437 | { | 437 | { |
| 438 | struct spi_master *master = spi_master_get(platform_get_drvdata(pdev)); | 438 | struct spi_master *master = platform_get_drvdata(pdev); |
| 439 | struct bcm63xx_spi *bs = spi_master_get_devdata(master); | 439 | struct bcm63xx_spi *bs = spi_master_get_devdata(master); |
| 440 | 440 | ||
| 441 | /* reset spi block */ | 441 | /* reset spi block */ |
diff --git a/drivers/spi/spi-mpc512x-psc.c b/drivers/spi/spi-mpc512x-psc.c index 9602bbd8d7ea..87676587d783 100644 --- a/drivers/spi/spi-mpc512x-psc.c +++ b/drivers/spi/spi-mpc512x-psc.c | |||
| @@ -557,7 +557,7 @@ free_master: | |||
| 557 | 557 | ||
| 558 | static int mpc512x_psc_spi_do_remove(struct device *dev) | 558 | static int mpc512x_psc_spi_do_remove(struct device *dev) |
| 559 | { | 559 | { |
| 560 | struct spi_master *master = spi_master_get(dev_get_drvdata(dev)); | 560 | struct spi_master *master = dev_get_drvdata(dev); |
| 561 | struct mpc512x_psc_spi *mps = spi_master_get_devdata(master); | 561 | struct mpc512x_psc_spi *mps = spi_master_get_devdata(master); |
| 562 | 562 | ||
| 563 | clk_disable_unprepare(mps->clk_mclk); | 563 | clk_disable_unprepare(mps->clk_mclk); |
diff --git a/drivers/spi/spi-mxs.c b/drivers/spi/spi-mxs.c index 73afb56c08cc..3adebfa22e3d 100644 --- a/drivers/spi/spi-mxs.c +++ b/drivers/spi/spi-mxs.c | |||
| @@ -565,7 +565,7 @@ static int mxs_spi_remove(struct platform_device *pdev) | |||
| 565 | struct mxs_spi *spi; | 565 | struct mxs_spi *spi; |
| 566 | struct mxs_ssp *ssp; | 566 | struct mxs_ssp *ssp; |
| 567 | 567 | ||
| 568 | master = spi_master_get(platform_get_drvdata(pdev)); | 568 | master = platform_get_drvdata(pdev); |
| 569 | spi = spi_master_get_devdata(master); | 569 | spi = spi_master_get_devdata(master); |
| 570 | ssp = &spi->ssp; | 570 | ssp = &spi->ssp; |
| 571 | 571 | ||
diff --git a/drivers/spi/spi-pxa2xx.c b/drivers/spi/spi-pxa2xx.c index cb0e1f1137ad..7765b1999537 100644 --- a/drivers/spi/spi-pxa2xx.c +++ b/drivers/spi/spi-pxa2xx.c | |||
| @@ -1073,6 +1073,8 @@ pxa2xx_spi_acpi_get_pdata(struct platform_device *pdev) | |||
| 1073 | static struct acpi_device_id pxa2xx_spi_acpi_match[] = { | 1073 | static struct acpi_device_id pxa2xx_spi_acpi_match[] = { |
| 1074 | { "INT33C0", 0 }, | 1074 | { "INT33C0", 0 }, |
| 1075 | { "INT33C1", 0 }, | 1075 | { "INT33C1", 0 }, |
| 1076 | { "INT3430", 0 }, | ||
| 1077 | { "INT3431", 0 }, | ||
| 1076 | { "80860F0E", 0 }, | 1078 | { "80860F0E", 0 }, |
| 1077 | { }, | 1079 | { }, |
| 1078 | }; | 1080 | }; |
| @@ -1291,6 +1293,9 @@ static int pxa2xx_spi_resume(struct device *dev) | |||
| 1291 | /* Enable the SSP clock */ | 1293 | /* Enable the SSP clock */ |
| 1292 | clk_prepare_enable(ssp->clk); | 1294 | clk_prepare_enable(ssp->clk); |
| 1293 | 1295 | ||
| 1296 | /* Restore LPSS private register bits */ | ||
| 1297 | lpss_ssp_setup(drv_data); | ||
| 1298 | |||
| 1294 | /* Start the queue running */ | 1299 | /* Start the queue running */ |
| 1295 | status = spi_master_resume(drv_data->master); | 1300 | status = spi_master_resume(drv_data->master); |
| 1296 | if (status != 0) { | 1301 | if (status != 0) { |
diff --git a/drivers/spi/spi-rspi.c b/drivers/spi/spi-rspi.c index 58449ad4ad0d..9e829cee7357 100644 --- a/drivers/spi/spi-rspi.c +++ b/drivers/spi/spi-rspi.c | |||
| @@ -885,14 +885,13 @@ static void rspi_release_dma(struct rspi_data *rspi) | |||
| 885 | 885 | ||
| 886 | static int rspi_remove(struct platform_device *pdev) | 886 | static int rspi_remove(struct platform_device *pdev) |
| 887 | { | 887 | { |
| 888 | struct rspi_data *rspi = spi_master_get(platform_get_drvdata(pdev)); | 888 | struct rspi_data *rspi = platform_get_drvdata(pdev); |
| 889 | 889 | ||
| 890 | spi_unregister_master(rspi->master); | 890 | spi_unregister_master(rspi->master); |
| 891 | rspi_release_dma(rspi); | 891 | rspi_release_dma(rspi); |
| 892 | free_irq(platform_get_irq(pdev, 0), rspi); | 892 | free_irq(platform_get_irq(pdev, 0), rspi); |
| 893 | clk_put(rspi->clk); | 893 | clk_put(rspi->clk); |
| 894 | iounmap(rspi->addr); | 894 | iounmap(rspi->addr); |
| 895 | spi_master_put(rspi->master); | ||
| 896 | 895 | ||
| 897 | return 0; | 896 | return 0; |
| 898 | } | 897 | } |
diff --git a/drivers/spi/spi-ti-qspi.c b/drivers/spi/spi-ti-qspi.c index 0b71270fbf67..4396bd448540 100644 --- a/drivers/spi/spi-ti-qspi.c +++ b/drivers/spi/spi-ti-qspi.c | |||
| @@ -161,7 +161,7 @@ static int ti_qspi_setup(struct spi_device *spi) | |||
| 161 | qspi->spi_max_frequency, clk_div); | 161 | qspi->spi_max_frequency, clk_div); |
| 162 | 162 | ||
| 163 | ret = pm_runtime_get_sync(qspi->dev); | 163 | ret = pm_runtime_get_sync(qspi->dev); |
| 164 | if (ret) { | 164 | if (ret < 0) { |
| 165 | dev_err(qspi->dev, "pm_runtime_get_sync() failed\n"); | 165 | dev_err(qspi->dev, "pm_runtime_get_sync() failed\n"); |
| 166 | return ret; | 166 | return ret; |
| 167 | } | 167 | } |
| @@ -459,11 +459,10 @@ static int ti_qspi_probe(struct platform_device *pdev) | |||
| 459 | if (!of_property_read_u32(np, "num-cs", &num_cs)) | 459 | if (!of_property_read_u32(np, "num-cs", &num_cs)) |
| 460 | master->num_chipselect = num_cs; | 460 | master->num_chipselect = num_cs; |
| 461 | 461 | ||
| 462 | platform_set_drvdata(pdev, master); | ||
| 463 | |||
| 464 | qspi = spi_master_get_devdata(master); | 462 | qspi = spi_master_get_devdata(master); |
| 465 | qspi->master = master; | 463 | qspi->master = master; |
| 466 | qspi->dev = &pdev->dev; | 464 | qspi->dev = &pdev->dev; |
| 465 | platform_set_drvdata(pdev, qspi); | ||
| 467 | 466 | ||
| 468 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 467 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 469 | 468 | ||
| @@ -517,10 +516,26 @@ free_master: | |||
| 517 | 516 | ||
| 518 | static int ti_qspi_remove(struct platform_device *pdev) | 517 | static int ti_qspi_remove(struct platform_device *pdev) |
| 519 | { | 518 | { |
| 520 | struct ti_qspi *qspi = platform_get_drvdata(pdev); | 519 | struct spi_master *master; |
| 520 | struct ti_qspi *qspi; | ||
| 521 | int ret; | ||
| 522 | |||
| 523 | master = platform_get_drvdata(pdev); | ||
| 524 | qspi = spi_master_get_devdata(master); | ||
| 525 | |||
| 526 | ret = pm_runtime_get_sync(qspi->dev); | ||
| 527 | if (ret < 0) { | ||
| 528 | dev_err(qspi->dev, "pm_runtime_get_sync() failed\n"); | ||
| 529 | return ret; | ||
| 530 | } | ||
| 521 | 531 | ||
| 522 | ti_qspi_write(qspi, QSPI_WC_INT_DISABLE, QSPI_INTR_ENABLE_CLEAR_REG); | 532 | ti_qspi_write(qspi, QSPI_WC_INT_DISABLE, QSPI_INTR_ENABLE_CLEAR_REG); |
| 523 | 533 | ||
| 534 | pm_runtime_put(qspi->dev); | ||
| 535 | pm_runtime_disable(&pdev->dev); | ||
| 536 | |||
| 537 | spi_unregister_master(master); | ||
| 538 | |||
| 524 | return 0; | 539 | return 0; |
| 525 | } | 540 | } |
| 526 | 541 | ||
diff --git a/drivers/spi/spi-txx9.c b/drivers/spi/spi-txx9.c index 637cce2b8bdd..18c9bb2b5f39 100644 --- a/drivers/spi/spi-txx9.c +++ b/drivers/spi/spi-txx9.c | |||
| @@ -425,7 +425,7 @@ exit: | |||
| 425 | 425 | ||
| 426 | static int txx9spi_remove(struct platform_device *dev) | 426 | static int txx9spi_remove(struct platform_device *dev) |
| 427 | { | 427 | { |
| 428 | struct spi_master *master = spi_master_get(platform_get_drvdata(dev)); | 428 | struct spi_master *master = platform_get_drvdata(dev); |
| 429 | struct txx9spi *c = spi_master_get_devdata(master); | 429 | struct txx9spi *c = spi_master_get_devdata(master); |
| 430 | 430 | ||
| 431 | destroy_workqueue(c->workqueue); | 431 | destroy_workqueue(c->workqueue); |
diff --git a/drivers/spi/spi.c b/drivers/spi/spi.c index 18cc625d887f..349ebba4b199 100644 --- a/drivers/spi/spi.c +++ b/drivers/spi/spi.c | |||
| @@ -1415,7 +1415,7 @@ int devm_spi_register_master(struct device *dev, struct spi_master *master) | |||
| 1415 | return -ENOMEM; | 1415 | return -ENOMEM; |
| 1416 | 1416 | ||
| 1417 | ret = spi_register_master(master); | 1417 | ret = spi_register_master(master); |
| 1418 | if (ret != 0) { | 1418 | if (!ret) { |
| 1419 | *ptr = master; | 1419 | *ptr = master; |
| 1420 | devres_add(dev, ptr); | 1420 | devres_add(dev, ptr); |
| 1421 | } else { | 1421 | } else { |
diff --git a/drivers/staging/btmtk_usb/btmtk_usb.c b/drivers/staging/btmtk_usb/btmtk_usb.c index 7a9bf3b57810..9a5ebd6cc512 100644 --- a/drivers/staging/btmtk_usb/btmtk_usb.c +++ b/drivers/staging/btmtk_usb/btmtk_usb.c | |||
| @@ -1284,9 +1284,8 @@ done: | |||
| 1284 | kfree_skb(skb); | 1284 | kfree_skb(skb); |
| 1285 | } | 1285 | } |
| 1286 | 1286 | ||
| 1287 | static int btmtk_usb_send_frame(struct sk_buff *skb) | 1287 | static int btmtk_usb_send_frame(struct hci_dev *hdev, struct sk_buff *skb) |
| 1288 | { | 1288 | { |
| 1289 | struct hci_dev *hdev = (struct hci_dev *)skb->dev; | ||
| 1290 | struct btmtk_usb_data *data = hci_get_drvdata(hdev); | 1289 | struct btmtk_usb_data *data = hci_get_drvdata(hdev); |
| 1291 | struct usb_ctrlrequest *dr; | 1290 | struct usb_ctrlrequest *dr; |
| 1292 | struct urb *urb; | 1291 | struct urb *urb; |
diff --git a/drivers/staging/comedi/drivers/pcl730.c b/drivers/staging/comedi/drivers/pcl730.c index d041b714db29..2baaf1db6fbf 100644 --- a/drivers/staging/comedi/drivers/pcl730.c +++ b/drivers/staging/comedi/drivers/pcl730.c | |||
| @@ -173,11 +173,11 @@ static int pcl730_do_insn_bits(struct comedi_device *dev, | |||
| 173 | if (mask) { | 173 | if (mask) { |
| 174 | if (mask & 0x00ff) | 174 | if (mask & 0x00ff) |
| 175 | outb(s->state & 0xff, dev->iobase + reg); | 175 | outb(s->state & 0xff, dev->iobase + reg); |
| 176 | if ((mask & 0xff00) & (s->n_chan > 8)) | 176 | if ((mask & 0xff00) && (s->n_chan > 8)) |
| 177 | outb((s->state >> 8) & 0xff, dev->iobase + reg + 1); | 177 | outb((s->state >> 8) & 0xff, dev->iobase + reg + 1); |
| 178 | if ((mask & 0xff0000) & (s->n_chan > 16)) | 178 | if ((mask & 0xff0000) && (s->n_chan > 16)) |
| 179 | outb((s->state >> 16) & 0xff, dev->iobase + reg + 2); | 179 | outb((s->state >> 16) & 0xff, dev->iobase + reg + 2); |
| 180 | if ((mask & 0xff000000) & (s->n_chan > 24)) | 180 | if ((mask & 0xff000000) && (s->n_chan > 24)) |
| 181 | outb((s->state >> 24) & 0xff, dev->iobase + reg + 3); | 181 | outb((s->state >> 24) & 0xff, dev->iobase + reg + 3); |
| 182 | } | 182 | } |
| 183 | 183 | ||
diff --git a/drivers/staging/comedi/drivers/s626.c b/drivers/staging/comedi/drivers/s626.c index 6815cfe2664e..b486099b543d 100644 --- a/drivers/staging/comedi/drivers/s626.c +++ b/drivers/staging/comedi/drivers/s626.c | |||
| @@ -494,7 +494,7 @@ static void s626_send_dac(struct comedi_device *dev, uint32_t val) | |||
| 494 | * Private helper function: Write setpoint to an application DAC channel. | 494 | * Private helper function: Write setpoint to an application DAC channel. |
| 495 | */ | 495 | */ |
| 496 | static void s626_set_dac(struct comedi_device *dev, uint16_t chan, | 496 | static void s626_set_dac(struct comedi_device *dev, uint16_t chan, |
| 497 | unsigned short dacdata) | 497 | int16_t dacdata) |
| 498 | { | 498 | { |
| 499 | struct s626_private *devpriv = dev->private; | 499 | struct s626_private *devpriv = dev->private; |
| 500 | uint16_t signmask; | 500 | uint16_t signmask; |
diff --git a/drivers/staging/comedi/drivers/vmk80xx.c b/drivers/staging/comedi/drivers/vmk80xx.c index 933b01a0f03d..0adf3cffddb0 100644 --- a/drivers/staging/comedi/drivers/vmk80xx.c +++ b/drivers/staging/comedi/drivers/vmk80xx.c | |||
| @@ -465,7 +465,7 @@ static int vmk80xx_do_insn_bits(struct comedi_device *dev, | |||
| 465 | unsigned char *rx_buf = devpriv->usb_rx_buf; | 465 | unsigned char *rx_buf = devpriv->usb_rx_buf; |
| 466 | unsigned char *tx_buf = devpriv->usb_tx_buf; | 466 | unsigned char *tx_buf = devpriv->usb_tx_buf; |
| 467 | int reg, cmd; | 467 | int reg, cmd; |
| 468 | int ret; | 468 | int ret = 0; |
| 469 | 469 | ||
| 470 | if (devpriv->model == VMK8061_MODEL) { | 470 | if (devpriv->model == VMK8061_MODEL) { |
| 471 | reg = VMK8061_DO_REG; | 471 | reg = VMK8061_DO_REG; |
diff --git a/drivers/staging/ft1000/ft1000-usb/ft1000_download.c b/drivers/staging/ft1000/ft1000-usb/ft1000_download.c index 68ded17c0f5c..12f333fa59b5 100644 --- a/drivers/staging/ft1000/ft1000-usb/ft1000_download.c +++ b/drivers/staging/ft1000/ft1000-usb/ft1000_download.c | |||
| @@ -578,7 +578,7 @@ static int request_code_segment(struct ft1000_usb *ft1000dev, u16 **s_file, | |||
| 578 | u8 **c_file, const u8 *endpoint, bool boot_case) | 578 | u8 **c_file, const u8 *endpoint, bool boot_case) |
| 579 | { | 579 | { |
| 580 | long word_length; | 580 | long word_length; |
| 581 | int status; | 581 | int status = 0; |
| 582 | 582 | ||
| 583 | /*DEBUG("FT1000:REQUEST_CODE_SEGMENT\n");i*/ | 583 | /*DEBUG("FT1000:REQUEST_CODE_SEGMENT\n");i*/ |
| 584 | word_length = get_request_value(ft1000dev); | 584 | word_length = get_request_value(ft1000dev); |
| @@ -1074,4 +1074,3 @@ int scram_dnldr(struct ft1000_usb *ft1000dev, void *pFileStart, | |||
| 1074 | 1074 | ||
| 1075 | return status; | 1075 | return status; |
| 1076 | } | 1076 | } |
| 1077 | |||
diff --git a/drivers/staging/iio/magnetometer/Kconfig b/drivers/staging/iio/magnetometer/Kconfig index a3ea69e9d800..34634da1f9f7 100644 --- a/drivers/staging/iio/magnetometer/Kconfig +++ b/drivers/staging/iio/magnetometer/Kconfig | |||
| @@ -6,6 +6,8 @@ menu "Magnetometer sensors" | |||
| 6 | config SENSORS_HMC5843 | 6 | config SENSORS_HMC5843 |
| 7 | tristate "Honeywell HMC5843/5883/5883L 3-Axis Magnetometer" | 7 | tristate "Honeywell HMC5843/5883/5883L 3-Axis Magnetometer" |
| 8 | depends on I2C | 8 | depends on I2C |
| 9 | select IIO_BUFFER | ||
| 10 | select IIO_TRIGGERED_BUFFER | ||
| 9 | help | 11 | help |
| 10 | Say Y here to add support for the Honeywell HMC5843, HMC5883 and | 12 | Say Y here to add support for the Honeywell HMC5843, HMC5883 and |
| 11 | HMC5883L 3-Axis Magnetometer (digital compass). | 13 | HMC5883L 3-Axis Magnetometer (digital compass). |
diff --git a/drivers/staging/imx-drm/Makefile b/drivers/staging/imx-drm/Makefile index 2c3a9e178fb5..8742432d7b01 100644 --- a/drivers/staging/imx-drm/Makefile +++ b/drivers/staging/imx-drm/Makefile | |||
| @@ -8,4 +8,6 @@ obj-$(CONFIG_DRM_IMX_TVE) += imx-tve.o | |||
| 8 | obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o | 8 | obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o |
| 9 | obj-$(CONFIG_DRM_IMX_FB_HELPER) += imx-fbdev.o | 9 | obj-$(CONFIG_DRM_IMX_FB_HELPER) += imx-fbdev.o |
| 10 | obj-$(CONFIG_DRM_IMX_IPUV3_CORE) += ipu-v3/ | 10 | obj-$(CONFIG_DRM_IMX_IPUV3_CORE) += ipu-v3/ |
| 11 | obj-$(CONFIG_DRM_IMX_IPUV3) += ipuv3-crtc.o ipuv3-plane.o | 11 | |
| 12 | imx-ipuv3-crtc-objs := ipuv3-crtc.o ipuv3-plane.o | ||
| 13 | obj-$(CONFIG_DRM_IMX_IPUV3) += imx-ipuv3-crtc.o | ||
diff --git a/drivers/staging/imx-drm/imx-drm-core.c b/drivers/staging/imx-drm/imx-drm-core.c index 51aa9772f959..6bd015ac9d68 100644 --- a/drivers/staging/imx-drm/imx-drm-core.c +++ b/drivers/staging/imx-drm/imx-drm-core.c | |||
| @@ -72,6 +72,7 @@ int imx_drm_crtc_id(struct imx_drm_crtc *crtc) | |||
| 72 | { | 72 | { |
| 73 | return crtc->pipe; | 73 | return crtc->pipe; |
| 74 | } | 74 | } |
| 75 | EXPORT_SYMBOL_GPL(imx_drm_crtc_id); | ||
| 75 | 76 | ||
| 76 | static void imx_drm_driver_lastclose(struct drm_device *drm) | 77 | static void imx_drm_driver_lastclose(struct drm_device *drm) |
| 77 | { | 78 | { |
diff --git a/drivers/staging/lustre/lustre/ptlrpc/pinger.c b/drivers/staging/lustre/lustre/ptlrpc/pinger.c index 5dec771d70ee..4d340f4a2198 100644 --- a/drivers/staging/lustre/lustre/ptlrpc/pinger.c +++ b/drivers/staging/lustre/lustre/ptlrpc/pinger.c | |||
| @@ -409,8 +409,8 @@ int ptlrpc_stop_pinger(void) | |||
| 409 | struct l_wait_info lwi = { 0 }; | 409 | struct l_wait_info lwi = { 0 }; |
| 410 | int rc = 0; | 410 | int rc = 0; |
| 411 | 411 | ||
| 412 | if (!thread_is_init(&pinger_thread) && | 412 | if (thread_is_init(&pinger_thread) || |
| 413 | !thread_is_stopped(&pinger_thread)) | 413 | thread_is_stopped(&pinger_thread)) |
| 414 | return -EALREADY; | 414 | return -EALREADY; |
| 415 | 415 | ||
| 416 | ptlrpc_pinger_remove_timeouts(); | 416 | ptlrpc_pinger_remove_timeouts(); |
diff --git a/drivers/staging/media/go7007/go7007-usb.c b/drivers/staging/media/go7007/go7007-usb.c index 58684da45e6c..b658c2316df3 100644 --- a/drivers/staging/media/go7007/go7007-usb.c +++ b/drivers/staging/media/go7007/go7007-usb.c | |||
| @@ -15,6 +15,8 @@ | |||
| 15 | * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. | 15 | * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. |
| 16 | */ | 16 | */ |
| 17 | 17 | ||
| 18 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
| 19 | |||
| 18 | #include <linux/module.h> | 20 | #include <linux/module.h> |
| 19 | #include <linux/kernel.h> | 21 | #include <linux/kernel.h> |
| 20 | #include <linux/init.h> | 22 | #include <linux/init.h> |
| @@ -661,7 +663,7 @@ static int go7007_usb_interface_reset(struct go7007 *go) | |||
| 661 | 663 | ||
| 662 | if (usb->board->flags & GO7007_USB_EZUSB) { | 664 | if (usb->board->flags & GO7007_USB_EZUSB) { |
| 663 | /* Reset buffer in EZ-USB */ | 665 | /* Reset buffer in EZ-USB */ |
| 664 | dev_dbg(go->dev, "resetting EZ-USB buffers\n"); | 666 | pr_debug("resetting EZ-USB buffers\n"); |
| 665 | if (go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0 || | 667 | if (go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0 || |
| 666 | go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0) | 668 | go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0) |
| 667 | return -1; | 669 | return -1; |
| @@ -689,7 +691,7 @@ static int go7007_usb_ezusb_write_interrupt(struct go7007 *go, | |||
| 689 | u16 status_reg = 0; | 691 | u16 status_reg = 0; |
| 690 | int timeout = 500; | 692 | int timeout = 500; |
| 691 | 693 | ||
| 692 | dev_dbg(go->dev, "WriteInterrupt: %04x %04x\n", addr, data); | 694 | pr_debug("WriteInterrupt: %04x %04x\n", addr, data); |
| 693 | 695 | ||
| 694 | for (i = 0; i < 100; ++i) { | 696 | for (i = 0; i < 100; ++i) { |
| 695 | r = usb_control_msg(usb->usbdev, | 697 | r = usb_control_msg(usb->usbdev, |
| @@ -734,7 +736,7 @@ static int go7007_usb_onboard_write_interrupt(struct go7007 *go, | |||
| 734 | int r; | 736 | int r; |
| 735 | int timeout = 500; | 737 | int timeout = 500; |
| 736 | 738 | ||
| 737 | dev_dbg(go->dev, "WriteInterrupt: %04x %04x\n", addr, data); | 739 | pr_debug("WriteInterrupt: %04x %04x\n", addr, data); |
| 738 | 740 | ||
| 739 | go->usb_buf[0] = data & 0xff; | 741 | go->usb_buf[0] = data & 0xff; |
| 740 | go->usb_buf[1] = data >> 8; | 742 | go->usb_buf[1] = data >> 8; |
| @@ -771,7 +773,7 @@ static void go7007_usb_readinterrupt_complete(struct urb *urb) | |||
| 771 | go->interrupt_available = 1; | 773 | go->interrupt_available = 1; |
| 772 | go->interrupt_data = __le16_to_cpu(regs[0]); | 774 | go->interrupt_data = __le16_to_cpu(regs[0]); |
| 773 | go->interrupt_value = __le16_to_cpu(regs[1]); | 775 | go->interrupt_value = __le16_to_cpu(regs[1]); |
| 774 | dev_dbg(go->dev, "ReadInterrupt: %04x %04x\n", | 776 | pr_debug("ReadInterrupt: %04x %04x\n", |
| 775 | go->interrupt_value, go->interrupt_data); | 777 | go->interrupt_value, go->interrupt_data); |
| 776 | } | 778 | } |
| 777 | 779 | ||
| @@ -891,7 +893,7 @@ static int go7007_usb_send_firmware(struct go7007 *go, u8 *data, int len) | |||
| 891 | int transferred, pipe; | 893 | int transferred, pipe; |
| 892 | int timeout = 500; | 894 | int timeout = 500; |
| 893 | 895 | ||
| 894 | dev_dbg(go->dev, "DownloadBuffer sending %d bytes\n", len); | 896 | pr_debug("DownloadBuffer sending %d bytes\n", len); |
| 895 | 897 | ||
| 896 | if (usb->board->flags & GO7007_USB_EZUSB) | 898 | if (usb->board->flags & GO7007_USB_EZUSB) |
| 897 | pipe = usb_sndbulkpipe(usb->usbdev, 2); | 899 | pipe = usb_sndbulkpipe(usb->usbdev, 2); |
| @@ -977,7 +979,7 @@ static int go7007_usb_i2c_master_xfer(struct i2c_adapter *adapter, | |||
| 977 | !(msgs[i].flags & I2C_M_RD) && | 979 | !(msgs[i].flags & I2C_M_RD) && |
| 978 | (msgs[i + 1].flags & I2C_M_RD)) { | 980 | (msgs[i + 1].flags & I2C_M_RD)) { |
| 979 | #ifdef GO7007_I2C_DEBUG | 981 | #ifdef GO7007_I2C_DEBUG |
| 980 | dev_dbg(go->dev, "i2c write/read %d/%d bytes on %02x\n", | 982 | pr_debug("i2c write/read %d/%d bytes on %02x\n", |
| 981 | msgs[i].len, msgs[i + 1].len, msgs[i].addr); | 983 | msgs[i].len, msgs[i + 1].len, msgs[i].addr); |
| 982 | #endif | 984 | #endif |
| 983 | buf[0] = 0x01; | 985 | buf[0] = 0x01; |
| @@ -988,7 +990,7 @@ static int go7007_usb_i2c_master_xfer(struct i2c_adapter *adapter, | |||
| 988 | buf[buf_len++] = msgs[++i].len; | 990 | buf[buf_len++] = msgs[++i].len; |
| 989 | } else if (msgs[i].flags & I2C_M_RD) { | 991 | } else if (msgs[i].flags & I2C_M_RD) { |
| 990 | #ifdef GO7007_I2C_DEBUG | 992 | #ifdef GO7007_I2C_DEBUG |
| 991 | dev_dbg(go->dev, "i2c read %d bytes on %02x\n", | 993 | pr_debug("i2c read %d bytes on %02x\n", |
| 992 | msgs[i].len, msgs[i].addr); | 994 | msgs[i].len, msgs[i].addr); |
| 993 | #endif | 995 | #endif |
| 994 | buf[0] = 0x01; | 996 | buf[0] = 0x01; |
| @@ -998,7 +1000,7 @@ static int go7007_usb_i2c_master_xfer(struct i2c_adapter *adapter, | |||
| 998 | buf_len = 4; | 1000 | buf_len = 4; |
| 999 | } else { | 1001 | } else { |
| 1000 | #ifdef GO7007_I2C_DEBUG | 1002 | #ifdef GO7007_I2C_DEBUG |
| 1001 | dev_dbg(go->dev, "i2c write %d bytes on %02x\n", | 1003 | pr_debug("i2c write %d bytes on %02x\n", |
| 1002 | msgs[i].len, msgs[i].addr); | 1004 | msgs[i].len, msgs[i].addr); |
| 1003 | #endif | 1005 | #endif |
| 1004 | buf[0] = 0x00; | 1006 | buf[0] = 0x00; |
| @@ -1057,7 +1059,7 @@ static int go7007_usb_probe(struct usb_interface *intf, | |||
| 1057 | char *name; | 1059 | char *name; |
| 1058 | int video_pipe, i, v_urb_len; | 1060 | int video_pipe, i, v_urb_len; |
| 1059 | 1061 | ||
| 1060 | dev_dbg(go->dev, "probing new GO7007 USB board\n"); | 1062 | pr_debug("probing new GO7007 USB board\n"); |
| 1061 | 1063 | ||
| 1062 | switch (id->driver_info) { | 1064 | switch (id->driver_info) { |
| 1063 | case GO7007_BOARDID_MATRIX_II: | 1065 | case GO7007_BOARDID_MATRIX_II: |
| @@ -1097,13 +1099,13 @@ static int go7007_usb_probe(struct usb_interface *intf, | |||
| 1097 | board = &board_px_tv402u; | 1099 | board = &board_px_tv402u; |
| 1098 | break; | 1100 | break; |
| 1099 | case GO7007_BOARDID_LIFEVIEW_LR192: | 1101 | case GO7007_BOARDID_LIFEVIEW_LR192: |
| 1100 | dev_err(go->dev, "The Lifeview TV Walker Ultra is not supported. Sorry!\n"); | 1102 | dev_err(&intf->dev, "The Lifeview TV Walker Ultra is not supported. Sorry!\n"); |
| 1101 | return -ENODEV; | 1103 | return -ENODEV; |
| 1102 | name = "Lifeview TV Walker Ultra"; | 1104 | name = "Lifeview TV Walker Ultra"; |
| 1103 | board = &board_lifeview_lr192; | 1105 | board = &board_lifeview_lr192; |
| 1104 | break; | 1106 | break; |
| 1105 | case GO7007_BOARDID_SENSORAY_2250: | 1107 | case GO7007_BOARDID_SENSORAY_2250: |
| 1106 | dev_info(go->dev, "Sensoray 2250 found\n"); | 1108 | dev_info(&intf->dev, "Sensoray 2250 found\n"); |
| 1107 | name = "Sensoray 2250/2251"; | 1109 | name = "Sensoray 2250/2251"; |
| 1108 | board = &board_sensoray_2250; | 1110 | board = &board_sensoray_2250; |
| 1109 | break; | 1111 | break; |
| @@ -1112,7 +1114,7 @@ static int go7007_usb_probe(struct usb_interface *intf, | |||
| 1112 | board = &board_ads_usbav_709; | 1114 | board = &board_ads_usbav_709; |
| 1113 | break; | 1115 | break; |
| 1114 | default: | 1116 | default: |
| 1115 | dev_err(go->dev, "unknown board ID %d!\n", | 1117 | dev_err(&intf->dev, "unknown board ID %d!\n", |
| 1116 | (unsigned int)id->driver_info); | 1118 | (unsigned int)id->driver_info); |
| 1117 | return -ENODEV; | 1119 | return -ENODEV; |
| 1118 | } | 1120 | } |
| @@ -1247,7 +1249,7 @@ static int go7007_usb_probe(struct usb_interface *intf, | |||
| 1247 | sizeof(go->name)); | 1249 | sizeof(go->name)); |
| 1248 | break; | 1250 | break; |
| 1249 | default: | 1251 | default: |
| 1250 | dev_dbg(go->dev, "unable to detect tuner type!\n"); | 1252 | pr_debug("unable to detect tuner type!\n"); |
| 1251 | break; | 1253 | break; |
| 1252 | } | 1254 | } |
| 1253 | /* Configure tuner mode selection inputs connected | 1255 | /* Configure tuner mode selection inputs connected |
diff --git a/drivers/staging/nvec/nvec.c b/drivers/staging/nvec/nvec.c index 3066ee2e753b..49ea76b3435d 100644 --- a/drivers/staging/nvec/nvec.c +++ b/drivers/staging/nvec/nvec.c | |||
| @@ -681,7 +681,8 @@ static irqreturn_t nvec_interrupt(int irq, void *dev) | |||
| 681 | dev_err(nvec->dev, | 681 | dev_err(nvec->dev, |
| 682 | "RX buffer overflow on %p: " | 682 | "RX buffer overflow on %p: " |
| 683 | "Trying to write byte %u of %u\n", | 683 | "Trying to write byte %u of %u\n", |
| 684 | nvec->rx, nvec->rx->pos, NVEC_MSG_SIZE); | 684 | nvec->rx, nvec->rx ? nvec->rx->pos : 0, |
| 685 | NVEC_MSG_SIZE); | ||
| 685 | break; | 686 | break; |
| 686 | default: | 687 | default: |
| 687 | nvec->state = 0; | 688 | nvec->state = 0; |
diff --git a/drivers/staging/rtl8188eu/core/rtw_ap.c b/drivers/staging/rtl8188eu/core/rtw_ap.c index 2c678f409573..2f548ebada59 100644 --- a/drivers/staging/rtl8188eu/core/rtw_ap.c +++ b/drivers/staging/rtl8188eu/core/rtw_ap.c | |||
| @@ -1115,6 +1115,9 @@ int rtw_check_beacon_data(struct adapter *padapter, u8 *pbuf, int len) | |||
| 1115 | return _FAIL; | 1115 | return _FAIL; |
| 1116 | } | 1116 | } |
| 1117 | 1117 | ||
| 1118 | /* fix bug of flush_cam_entry at STOP AP mode */ | ||
| 1119 | psta->state |= WIFI_AP_STATE; | ||
| 1120 | rtw_indicate_connect(padapter); | ||
| 1118 | pmlmepriv->cur_network.join_res = true;/* for check if already set beacon */ | 1121 | pmlmepriv->cur_network.join_res = true;/* for check if already set beacon */ |
| 1119 | return ret; | 1122 | return ret; |
| 1120 | } | 1123 | } |
diff --git a/drivers/staging/tidspbridge/Kconfig b/drivers/staging/tidspbridge/Kconfig index 165b918b8171..1b6d581c438b 100644 --- a/drivers/staging/tidspbridge/Kconfig +++ b/drivers/staging/tidspbridge/Kconfig | |||
| @@ -4,7 +4,7 @@ | |||
| 4 | 4 | ||
| 5 | menuconfig TIDSPBRIDGE | 5 | menuconfig TIDSPBRIDGE |
| 6 | tristate "DSP Bridge driver" | 6 | tristate "DSP Bridge driver" |
| 7 | depends on ARCH_OMAP3 && !ARCH_MULTIPLATFORM | 7 | depends on ARCH_OMAP3 && !ARCH_MULTIPLATFORM && BROKEN |
| 8 | select MAILBOX | 8 | select MAILBOX |
| 9 | select OMAP2PLUS_MBOX | 9 | select OMAP2PLUS_MBOX |
| 10 | help | 10 | help |
diff --git a/drivers/staging/tidspbridge/rmgr/drv_interface.c b/drivers/staging/tidspbridge/rmgr/drv_interface.c index 1aa4a3fd0f1b..56e355b3e7fa 100644 --- a/drivers/staging/tidspbridge/rmgr/drv_interface.c +++ b/drivers/staging/tidspbridge/rmgr/drv_interface.c | |||
| @@ -258,7 +258,8 @@ err: | |||
| 258 | /* This function maps kernel space memory to user space memory. */ | 258 | /* This function maps kernel space memory to user space memory. */ |
| 259 | static int bridge_mmap(struct file *filp, struct vm_area_struct *vma) | 259 | static int bridge_mmap(struct file *filp, struct vm_area_struct *vma) |
| 260 | { | 260 | { |
| 261 | u32 status; | 261 | struct omap_dsp_platform_data *pdata = |
| 262 | omap_dspbridge_dev->dev.platform_data; | ||
| 262 | 263 | ||
| 263 | /* VM_IO | VM_DONTEXPAND | VM_DONTDUMP are set by remap_pfn_range() */ | 264 | /* VM_IO | VM_DONTEXPAND | VM_DONTDUMP are set by remap_pfn_range() */ |
| 264 | vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); | 265 | vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); |
| @@ -268,13 +269,9 @@ static int bridge_mmap(struct file *filp, struct vm_area_struct *vma) | |||
| 268 | vma->vm_start, vma->vm_end, vma->vm_page_prot, | 269 | vma->vm_start, vma->vm_end, vma->vm_page_prot, |
| 269 | vma->vm_flags); | 270 | vma->vm_flags); |
| 270 | 271 | ||
| 271 | status = remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff, | 272 | return vm_iomap_memory(vma, |
| 272 | vma->vm_end - vma->vm_start, | 273 | pdata->phys_mempool_base, |
| 273 | vma->vm_page_prot); | 274 | pdata->phys_mempool_size); |
| 274 | if (status != 0) | ||
| 275 | status = -EAGAIN; | ||
| 276 | |||
| 277 | return status; | ||
| 278 | } | 275 | } |
| 279 | 276 | ||
| 280 | static const struct file_operations bridge_fops = { | 277 | static const struct file_operations bridge_fops = { |
diff --git a/drivers/staging/vt6655/hostap.c b/drivers/staging/vt6655/hostap.c index aab0012bba92..ab8b2ba6eedd 100644 --- a/drivers/staging/vt6655/hostap.c +++ b/drivers/staging/vt6655/hostap.c | |||
| @@ -143,7 +143,8 @@ static int hostap_disable_hostapd(PSDevice pDevice, int rtnl_locked) | |||
| 143 | DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Netdevice %s unregistered\n", | 143 | DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Netdevice %s unregistered\n", |
| 144 | pDevice->dev->name, pDevice->apdev->name); | 144 | pDevice->dev->name, pDevice->apdev->name); |
| 145 | } | 145 | } |
| 146 | free_netdev(pDevice->apdev); | 146 | if (pDevice->apdev) |
| 147 | free_netdev(pDevice->apdev); | ||
| 147 | pDevice->apdev = NULL; | 148 | pDevice->apdev = NULL; |
| 148 | pDevice->bEnable8021x = false; | 149 | pDevice->bEnable8021x = false; |
| 149 | pDevice->bEnableHostWEP = false; | 150 | pDevice->bEnableHostWEP = false; |
diff --git a/drivers/staging/vt6656/baseband.c b/drivers/staging/vt6656/baseband.c index 1e8b8412e67e..4aa5ef54b683 100644 --- a/drivers/staging/vt6656/baseband.c +++ b/drivers/staging/vt6656/baseband.c | |||
| @@ -939,6 +939,7 @@ int BBbVT3184Init(struct vnt_private *pDevice) | |||
| 939 | u8 * pbyAgc; | 939 | u8 * pbyAgc; |
| 940 | u16 wLengthAgc; | 940 | u16 wLengthAgc; |
| 941 | u8 abyArray[256]; | 941 | u8 abyArray[256]; |
| 942 | u8 data; | ||
| 942 | 943 | ||
| 943 | ntStatus = CONTROLnsRequestIn(pDevice, | 944 | ntStatus = CONTROLnsRequestIn(pDevice, |
| 944 | MESSAGE_TYPE_READ, | 945 | MESSAGE_TYPE_READ, |
| @@ -1104,6 +1105,16 @@ else { | |||
| 1104 | ControlvWriteByte(pDevice,MESSAGE_REQUEST_BBREG,0x0D,0x01); | 1105 | ControlvWriteByte(pDevice,MESSAGE_REQUEST_BBREG,0x0D,0x01); |
| 1105 | 1106 | ||
| 1106 | RFbRFTableDownload(pDevice); | 1107 | RFbRFTableDownload(pDevice); |
| 1108 | |||
| 1109 | /* Fix for TX USB resets from vendors driver */ | ||
| 1110 | CONTROLnsRequestIn(pDevice, MESSAGE_TYPE_READ, USB_REG4, | ||
| 1111 | MESSAGE_REQUEST_MEM, sizeof(data), &data); | ||
| 1112 | |||
| 1113 | data |= 0x2; | ||
| 1114 | |||
| 1115 | CONTROLnsRequestOut(pDevice, MESSAGE_TYPE_WRITE, USB_REG4, | ||
| 1116 | MESSAGE_REQUEST_MEM, sizeof(data), &data); | ||
| 1117 | |||
| 1107 | return true;//ntStatus; | 1118 | return true;//ntStatus; |
| 1108 | } | 1119 | } |
| 1109 | 1120 | ||
diff --git a/drivers/staging/vt6656/hostap.c b/drivers/staging/vt6656/hostap.c index ae1676d190c5..67ba48b9a8d9 100644 --- a/drivers/staging/vt6656/hostap.c +++ b/drivers/staging/vt6656/hostap.c | |||
| @@ -133,7 +133,8 @@ static int hostap_disable_hostapd(struct vnt_private *pDevice, int rtnl_locked) | |||
| 133 | DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Netdevice %s unregistered\n", | 133 | DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: Netdevice %s unregistered\n", |
| 134 | pDevice->dev->name, pDevice->apdev->name); | 134 | pDevice->dev->name, pDevice->apdev->name); |
| 135 | } | 135 | } |
| 136 | free_netdev(pDevice->apdev); | 136 | if (pDevice->apdev) |
| 137 | free_netdev(pDevice->apdev); | ||
| 137 | pDevice->apdev = NULL; | 138 | pDevice->apdev = NULL; |
| 138 | pDevice->bEnable8021x = false; | 139 | pDevice->bEnable8021x = false; |
| 139 | pDevice->bEnableHostWEP = false; | 140 | pDevice->bEnableHostWEP = false; |
diff --git a/drivers/staging/vt6656/rndis.h b/drivers/staging/vt6656/rndis.h index 5e073062017a..5cf5e732a36f 100644 --- a/drivers/staging/vt6656/rndis.h +++ b/drivers/staging/vt6656/rndis.h | |||
| @@ -66,6 +66,8 @@ | |||
| 66 | 66 | ||
| 67 | #define VIAUSB20_PACKET_HEADER 0x04 | 67 | #define VIAUSB20_PACKET_HEADER 0x04 |
| 68 | 68 | ||
| 69 | #define USB_REG4 0x604 | ||
| 70 | |||
| 69 | typedef struct _CMD_MESSAGE | 71 | typedef struct _CMD_MESSAGE |
| 70 | { | 72 | { |
| 71 | u8 byData[256]; | 73 | u8 byData[256]; |
diff --git a/drivers/staging/zram/zram_drv.c b/drivers/staging/zram/zram_drv.c index 79ce363b2ea9..3277d9838f4e 100644 --- a/drivers/staging/zram/zram_drv.c +++ b/drivers/staging/zram/zram_drv.c | |||
| @@ -652,21 +652,30 @@ static ssize_t reset_store(struct device *dev, | |||
| 652 | return -ENOMEM; | 652 | return -ENOMEM; |
| 653 | 653 | ||
| 654 | /* Do not reset an active device! */ | 654 | /* Do not reset an active device! */ |
| 655 | if (bdev->bd_holders) | 655 | if (bdev->bd_holders) { |
| 656 | return -EBUSY; | 656 | ret = -EBUSY; |
| 657 | goto out; | ||
| 658 | } | ||
| 657 | 659 | ||
| 658 | ret = kstrtou16(buf, 10, &do_reset); | 660 | ret = kstrtou16(buf, 10, &do_reset); |
| 659 | if (ret) | 661 | if (ret) |
| 660 | return ret; | 662 | goto out; |
| 661 | 663 | ||
| 662 | if (!do_reset) | 664 | if (!do_reset) { |
| 663 | return -EINVAL; | 665 | ret = -EINVAL; |
| 666 | goto out; | ||
| 667 | } | ||
| 664 | 668 | ||
| 665 | /* Make sure all pending I/O is finished */ | 669 | /* Make sure all pending I/O is finished */ |
| 666 | fsync_bdev(bdev); | 670 | fsync_bdev(bdev); |
| 671 | bdput(bdev); | ||
| 667 | 672 | ||
| 668 | zram_reset_device(zram, true); | 673 | zram_reset_device(zram, true); |
| 669 | return len; | 674 | return len; |
| 675 | |||
| 676 | out: | ||
| 677 | bdput(bdev); | ||
| 678 | return ret; | ||
| 670 | } | 679 | } |
| 671 | 680 | ||
| 672 | static void __zram_make_request(struct zram *zram, struct bio *bio, int rw) | 681 | static void __zram_make_request(struct zram *zram, struct bio *bio, int rw) |
diff --git a/drivers/staging/zsmalloc/zsmalloc-main.c b/drivers/staging/zsmalloc/zsmalloc-main.c index 1a67537dbc56..3b950e5a918f 100644 --- a/drivers/staging/zsmalloc/zsmalloc-main.c +++ b/drivers/staging/zsmalloc/zsmalloc-main.c | |||
| @@ -430,7 +430,12 @@ static struct page *get_next_page(struct page *page) | |||
| 430 | return next; | 430 | return next; |
| 431 | } | 431 | } |
| 432 | 432 | ||
| 433 | /* Encode <page, obj_idx> as a single handle value */ | 433 | /* |
| 434 | * Encode <page, obj_idx> as a single handle value. | ||
| 435 | * On hardware platforms with physical memory starting at 0x0 the pfn | ||
| 436 | * could be 0 so we ensure that the handle will never be 0 by adjusting the | ||
| 437 | * encoded obj_idx value before encoding. | ||
| 438 | */ | ||
| 434 | static void *obj_location_to_handle(struct page *page, unsigned long obj_idx) | 439 | static void *obj_location_to_handle(struct page *page, unsigned long obj_idx) |
| 435 | { | 440 | { |
| 436 | unsigned long handle; | 441 | unsigned long handle; |
| @@ -441,17 +446,21 @@ static void *obj_location_to_handle(struct page *page, unsigned long obj_idx) | |||
| 441 | } | 446 | } |
| 442 | 447 | ||
| 443 | handle = page_to_pfn(page) << OBJ_INDEX_BITS; | 448 | handle = page_to_pfn(page) << OBJ_INDEX_BITS; |
| 444 | handle |= (obj_idx & OBJ_INDEX_MASK); | 449 | handle |= ((obj_idx + 1) & OBJ_INDEX_MASK); |
| 445 | 450 | ||
| 446 | return (void *)handle; | 451 | return (void *)handle; |
| 447 | } | 452 | } |
| 448 | 453 | ||
| 449 | /* Decode <page, obj_idx> pair from the given object handle */ | 454 | /* |
| 455 | * Decode <page, obj_idx> pair from the given object handle. We adjust the | ||
| 456 | * decoded obj_idx back to its original value since it was adjusted in | ||
| 457 | * obj_location_to_handle(). | ||
| 458 | */ | ||
| 450 | static void obj_handle_to_location(unsigned long handle, struct page **page, | 459 | static void obj_handle_to_location(unsigned long handle, struct page **page, |
| 451 | unsigned long *obj_idx) | 460 | unsigned long *obj_idx) |
| 452 | { | 461 | { |
| 453 | *page = pfn_to_page(handle >> OBJ_INDEX_BITS); | 462 | *page = pfn_to_page(handle >> OBJ_INDEX_BITS); |
| 454 | *obj_idx = handle & OBJ_INDEX_MASK; | 463 | *obj_idx = (handle & OBJ_INDEX_MASK) - 1; |
| 455 | } | 464 | } |
| 456 | 465 | ||
| 457 | static unsigned long obj_idx_to_offset(struct page *page, | 466 | static unsigned long obj_idx_to_offset(struct page *page, |
diff --git a/drivers/tty/amiserial.c b/drivers/tty/amiserial.c index 2b86f8e0fb58..71630a2af42c 100644 --- a/drivers/tty/amiserial.c +++ b/drivers/tty/amiserial.c | |||
| @@ -1855,6 +1855,9 @@ static struct console sercons = { | |||
| 1855 | */ | 1855 | */ |
| 1856 | static int __init amiserial_console_init(void) | 1856 | static int __init amiserial_console_init(void) |
| 1857 | { | 1857 | { |
| 1858 | if (!MACH_IS_AMIGA) | ||
| 1859 | return -ENODEV; | ||
| 1860 | |||
| 1858 | register_console(&sercons); | 1861 | register_console(&sercons); |
| 1859 | return 0; | 1862 | return 0; |
| 1860 | } | 1863 | } |
diff --git a/drivers/tty/n_tty.c b/drivers/tty/n_tty.c index 7cdd1eb9406c..268b62768f2b 100644 --- a/drivers/tty/n_tty.c +++ b/drivers/tty/n_tty.c | |||
| @@ -768,7 +768,7 @@ static size_t __process_echoes(struct tty_struct *tty) | |||
| 768 | * data at the tail to prevent a subsequent overrun */ | 768 | * data at the tail to prevent a subsequent overrun */ |
| 769 | while (ldata->echo_commit - tail >= ECHO_DISCARD_WATERMARK) { | 769 | while (ldata->echo_commit - tail >= ECHO_DISCARD_WATERMARK) { |
| 770 | if (echo_buf(ldata, tail) == ECHO_OP_START) { | 770 | if (echo_buf(ldata, tail) == ECHO_OP_START) { |
| 771 | if (echo_buf(ldata, tail) == ECHO_OP_ERASE_TAB) | 771 | if (echo_buf(ldata, tail + 1) == ECHO_OP_ERASE_TAB) |
| 772 | tail += 3; | 772 | tail += 3; |
| 773 | else | 773 | else |
| 774 | tail += 2; | 774 | tail += 2; |
| @@ -810,7 +810,8 @@ static void process_echoes(struct tty_struct *tty) | |||
| 810 | struct n_tty_data *ldata = tty->disc_data; | 810 | struct n_tty_data *ldata = tty->disc_data; |
| 811 | size_t echoed; | 811 | size_t echoed; |
| 812 | 812 | ||
| 813 | if (!L_ECHO(tty) || ldata->echo_commit == ldata->echo_tail) | 813 | if ((!L_ECHO(tty) && !L_ECHONL(tty)) || |
| 814 | ldata->echo_commit == ldata->echo_tail) | ||
| 814 | return; | 815 | return; |
| 815 | 816 | ||
| 816 | mutex_lock(&ldata->output_lock); | 817 | mutex_lock(&ldata->output_lock); |
| @@ -825,7 +826,8 @@ static void flush_echoes(struct tty_struct *tty) | |||
| 825 | { | 826 | { |
| 826 | struct n_tty_data *ldata = tty->disc_data; | 827 | struct n_tty_data *ldata = tty->disc_data; |
| 827 | 828 | ||
| 828 | if (!L_ECHO(tty) || ldata->echo_commit == ldata->echo_head) | 829 | if ((!L_ECHO(tty) && !L_ECHONL(tty)) || |
| 830 | ldata->echo_commit == ldata->echo_head) | ||
| 829 | return; | 831 | return; |
| 830 | 832 | ||
| 831 | mutex_lock(&ldata->output_lock); | 833 | mutex_lock(&ldata->output_lock); |
| @@ -1998,7 +2000,10 @@ static int canon_copy_from_read_buf(struct tty_struct *tty, | |||
| 1998 | found = 1; | 2000 | found = 1; |
| 1999 | 2001 | ||
| 2000 | size = N_TTY_BUF_SIZE - tail; | 2002 | size = N_TTY_BUF_SIZE - tail; |
| 2001 | n = (found + eol + size) & (N_TTY_BUF_SIZE - 1); | 2003 | n = eol - tail; |
| 2004 | if (n > 4096) | ||
| 2005 | n += 4096; | ||
| 2006 | n += found; | ||
| 2002 | c = n; | 2007 | c = n; |
| 2003 | 2008 | ||
| 2004 | if (found && read_buf(ldata, eol) == __DISABLED_CHAR) { | 2009 | if (found && read_buf(ldata, eol) == __DISABLED_CHAR) { |
| @@ -2243,18 +2248,19 @@ static ssize_t n_tty_read(struct tty_struct *tty, struct file *file, | |||
| 2243 | if (time) | 2248 | if (time) |
| 2244 | timeout = time; | 2249 | timeout = time; |
| 2245 | } | 2250 | } |
| 2246 | mutex_unlock(&ldata->atomic_read_lock); | 2251 | n_tty_set_room(tty); |
| 2247 | remove_wait_queue(&tty->read_wait, &wait); | 2252 | up_read(&tty->termios_rwsem); |
| 2248 | 2253 | ||
| 2254 | remove_wait_queue(&tty->read_wait, &wait); | ||
| 2249 | if (!waitqueue_active(&tty->read_wait)) | 2255 | if (!waitqueue_active(&tty->read_wait)) |
| 2250 | ldata->minimum_to_wake = minimum; | 2256 | ldata->minimum_to_wake = minimum; |
| 2251 | 2257 | ||
| 2258 | mutex_unlock(&ldata->atomic_read_lock); | ||
| 2259 | |||
| 2252 | __set_current_state(TASK_RUNNING); | 2260 | __set_current_state(TASK_RUNNING); |
| 2253 | if (b - buf) | 2261 | if (b - buf) |
| 2254 | retval = b - buf; | 2262 | retval = b - buf; |
| 2255 | 2263 | ||
| 2256 | n_tty_set_room(tty); | ||
| 2257 | up_read(&tty->termios_rwsem); | ||
| 2258 | return retval; | 2264 | return retval; |
| 2259 | } | 2265 | } |
| 2260 | 2266 | ||
diff --git a/drivers/tty/serial/8250/Kconfig b/drivers/tty/serial/8250/Kconfig index f3b306efaa59..23329918f229 100644 --- a/drivers/tty/serial/8250/Kconfig +++ b/drivers/tty/serial/8250/Kconfig | |||
| @@ -41,7 +41,7 @@ config SERIAL_8250_DEPRECATED_OPTIONS | |||
| 41 | accept kernel parameters in both forms like 8250_core.nr_uarts=4 and | 41 | accept kernel parameters in both forms like 8250_core.nr_uarts=4 and |
| 42 | 8250.nr_uarts=4. We now renamed the module back to 8250, but if | 42 | 8250.nr_uarts=4. We now renamed the module back to 8250, but if |
| 43 | anybody noticed in 3.7 and changed their userspace we still have to | 43 | anybody noticed in 3.7 and changed their userspace we still have to |
| 44 | keep the 8350_core.* options around until they revert the changes | 44 | keep the 8250_core.* options around until they revert the changes |
| 45 | they already did. | 45 | they already did. |
| 46 | 46 | ||
| 47 | If 8250 is built as a module, this adds 8250_core alias instead. | 47 | If 8250 is built as a module, this adds 8250_core alias instead. |
diff --git a/drivers/tty/serial/pmac_zilog.c b/drivers/tty/serial/pmac_zilog.c index 481b781b26e3..e9d420ff3931 100644 --- a/drivers/tty/serial/pmac_zilog.c +++ b/drivers/tty/serial/pmac_zilog.c | |||
| @@ -2052,6 +2052,9 @@ static int __init pmz_console_init(void) | |||
| 2052 | /* Probe ports */ | 2052 | /* Probe ports */ |
| 2053 | pmz_probe(); | 2053 | pmz_probe(); |
| 2054 | 2054 | ||
| 2055 | if (pmz_ports_count == 0) | ||
| 2056 | return -ENODEV; | ||
| 2057 | |||
| 2055 | /* TODO: Autoprobe console based on OF */ | 2058 | /* TODO: Autoprobe console based on OF */ |
| 2056 | /* pmz_console.index = i; */ | 2059 | /* pmz_console.index = i; */ |
| 2057 | register_console(&pmz_console); | 2060 | register_console(&pmz_console); |
diff --git a/drivers/tty/tty_io.c b/drivers/tty/tty_io.c index 3a1a01af9a80..c74a00ad7add 100644 --- a/drivers/tty/tty_io.c +++ b/drivers/tty/tty_io.c | |||
| @@ -2086,6 +2086,7 @@ retry_open: | |||
| 2086 | filp->f_op = &tty_fops; | 2086 | filp->f_op = &tty_fops; |
| 2087 | goto retry_open; | 2087 | goto retry_open; |
| 2088 | } | 2088 | } |
| 2089 | clear_bit(TTY_HUPPED, &tty->flags); | ||
| 2089 | tty_unlock(tty); | 2090 | tty_unlock(tty); |
| 2090 | 2091 | ||
| 2091 | 2092 | ||
diff --git a/drivers/uio/uio.c b/drivers/uio/uio.c index 67beb8444930..f7beb6eb40c7 100644 --- a/drivers/uio/uio.c +++ b/drivers/uio/uio.c | |||
| @@ -653,6 +653,8 @@ static int uio_mmap_physical(struct vm_area_struct *vma) | |||
| 653 | return -EINVAL; | 653 | return -EINVAL; |
| 654 | mem = idev->info->mem + mi; | 654 | mem = idev->info->mem + mi; |
| 655 | 655 | ||
| 656 | if (mem->addr & ~PAGE_MASK) | ||
| 657 | return -ENODEV; | ||
| 656 | if (vma->vm_end - vma->vm_start > mem->size) | 658 | if (vma->vm_end - vma->vm_start > mem->size) |
| 657 | return -EINVAL; | 659 | return -EINVAL; |
| 658 | 660 | ||
diff --git a/drivers/usb/class/cdc-acm.c b/drivers/usb/class/cdc-acm.c index 3e7560f004f8..e8404319ca68 100644 --- a/drivers/usb/class/cdc-acm.c +++ b/drivers/usb/class/cdc-acm.c | |||
| @@ -1515,6 +1515,8 @@ static int acm_reset_resume(struct usb_interface *intf) | |||
| 1515 | 1515 | ||
| 1516 | static const struct usb_device_id acm_ids[] = { | 1516 | static const struct usb_device_id acm_ids[] = { |
| 1517 | /* quirky and broken devices */ | 1517 | /* quirky and broken devices */ |
| 1518 | { USB_DEVICE(0x17ef, 0x7000), /* Lenovo USB modem */ | ||
| 1519 | .driver_info = NO_UNION_NORMAL, },/* has no union descriptor */ | ||
| 1518 | { USB_DEVICE(0x0870, 0x0001), /* Metricom GS Modem */ | 1520 | { USB_DEVICE(0x0870, 0x0001), /* Metricom GS Modem */ |
| 1519 | .driver_info = NO_UNION_NORMAL, /* has no union descriptor */ | 1521 | .driver_info = NO_UNION_NORMAL, /* has no union descriptor */ |
| 1520 | }, | 1522 | }, |
diff --git a/drivers/usb/core/hub.c b/drivers/usb/core/hub.c index a7c04e24ca48..bd9dc3504b51 100644 --- a/drivers/usb/core/hub.c +++ b/drivers/usb/core/hub.c | |||
| @@ -4832,8 +4832,9 @@ static void hub_events(void) | |||
| 4832 | hub->ports[i - 1]->child; | 4832 | hub->ports[i - 1]->child; |
| 4833 | 4833 | ||
| 4834 | dev_dbg(hub_dev, "warm reset port %d\n", i); | 4834 | dev_dbg(hub_dev, "warm reset port %d\n", i); |
| 4835 | if (!udev || !(portstatus & | 4835 | if (!udev || |
| 4836 | USB_PORT_STAT_CONNECTION)) { | 4836 | !(portstatus & USB_PORT_STAT_CONNECTION) || |
| 4837 | udev->state == USB_STATE_NOTATTACHED) { | ||
| 4837 | status = hub_port_reset(hub, i, | 4838 | status = hub_port_reset(hub, i, |
| 4838 | NULL, HUB_BH_RESET_TIME, | 4839 | NULL, HUB_BH_RESET_TIME, |
| 4839 | true); | 4840 | true); |
diff --git a/drivers/usb/dwc3/ep0.c b/drivers/usb/dwc3/ep0.c index 95f7649c71a7..21a352079bc2 100644 --- a/drivers/usb/dwc3/ep0.c +++ b/drivers/usb/dwc3/ep0.c | |||
| @@ -459,6 +459,8 @@ static int dwc3_ep0_handle_feature(struct dwc3 *dwc, | |||
| 459 | dep = dwc3_wIndex_to_dep(dwc, wIndex); | 459 | dep = dwc3_wIndex_to_dep(dwc, wIndex); |
| 460 | if (!dep) | 460 | if (!dep) |
| 461 | return -EINVAL; | 461 | return -EINVAL; |
| 462 | if (set == 0 && (dep->flags & DWC3_EP_WEDGE)) | ||
| 463 | break; | ||
| 462 | ret = __dwc3_gadget_ep_set_halt(dep, set); | 464 | ret = __dwc3_gadget_ep_set_halt(dep, set); |
| 463 | if (ret) | 465 | if (ret) |
| 464 | return -EINVAL; | 466 | return -EINVAL; |
diff --git a/drivers/usb/dwc3/gadget.c b/drivers/usb/dwc3/gadget.c index 5452c0fce360..02e44fcaf205 100644 --- a/drivers/usb/dwc3/gadget.c +++ b/drivers/usb/dwc3/gadget.c | |||
| @@ -1200,9 +1200,6 @@ int __dwc3_gadget_ep_set_halt(struct dwc3_ep *dep, int value) | |||
| 1200 | else | 1200 | else |
| 1201 | dep->flags |= DWC3_EP_STALL; | 1201 | dep->flags |= DWC3_EP_STALL; |
| 1202 | } else { | 1202 | } else { |
| 1203 | if (dep->flags & DWC3_EP_WEDGE) | ||
| 1204 | return 0; | ||
| 1205 | |||
| 1206 | ret = dwc3_send_gadget_ep_cmd(dwc, dep->number, | 1203 | ret = dwc3_send_gadget_ep_cmd(dwc, dep->number, |
| 1207 | DWC3_DEPCMD_CLEARSTALL, ¶ms); | 1204 | DWC3_DEPCMD_CLEARSTALL, ¶ms); |
| 1208 | if (ret) | 1205 | if (ret) |
| @@ -1210,7 +1207,7 @@ int __dwc3_gadget_ep_set_halt(struct dwc3_ep *dep, int value) | |||
| 1210 | value ? "set" : "clear", | 1207 | value ? "set" : "clear", |
| 1211 | dep->name); | 1208 | dep->name); |
| 1212 | else | 1209 | else |
| 1213 | dep->flags &= ~DWC3_EP_STALL; | 1210 | dep->flags &= ~(DWC3_EP_STALL | DWC3_EP_WEDGE); |
| 1214 | } | 1211 | } |
| 1215 | 1212 | ||
| 1216 | return ret; | 1213 | return ret; |
diff --git a/drivers/usb/gadget/Kconfig b/drivers/usb/gadget/Kconfig index a91e6422f930..f66d96ad1f51 100644 --- a/drivers/usb/gadget/Kconfig +++ b/drivers/usb/gadget/Kconfig | |||
| @@ -682,6 +682,7 @@ config USB_CONFIGFS_PHONET | |||
| 682 | config USB_CONFIGFS_MASS_STORAGE | 682 | config USB_CONFIGFS_MASS_STORAGE |
| 683 | boolean "Mass storage" | 683 | boolean "Mass storage" |
| 684 | depends on USB_CONFIGFS | 684 | depends on USB_CONFIGFS |
| 685 | depends on BLOCK | ||
| 685 | select USB_F_MASS_STORAGE | 686 | select USB_F_MASS_STORAGE |
| 686 | help | 687 | help |
| 687 | The Mass Storage Gadget acts as a USB Mass Storage disk drive. | 688 | The Mass Storage Gadget acts as a USB Mass Storage disk drive. |
diff --git a/drivers/usb/gadget/composite.c b/drivers/usb/gadget/composite.c index 3e7ae707f691..2018ba1a2172 100644 --- a/drivers/usb/gadget/composite.c +++ b/drivers/usb/gadget/composite.c | |||
| @@ -593,6 +593,7 @@ static void reset_config(struct usb_composite_dev *cdev) | |||
| 593 | bitmap_zero(f->endpoints, 32); | 593 | bitmap_zero(f->endpoints, 32); |
| 594 | } | 594 | } |
| 595 | cdev->config = NULL; | 595 | cdev->config = NULL; |
| 596 | cdev->delayed_status = 0; | ||
| 596 | } | 597 | } |
| 597 | 598 | ||
| 598 | static int set_config(struct usb_composite_dev *cdev, | 599 | static int set_config(struct usb_composite_dev *cdev, |
diff --git a/drivers/usb/gadget/f_fs.c b/drivers/usb/gadget/f_fs.c index 774e8b89cdb5..241fc873ffa4 100644 --- a/drivers/usb/gadget/f_fs.c +++ b/drivers/usb/gadget/f_fs.c | |||
| @@ -1304,7 +1304,7 @@ static struct ffs_data *ffs_data_new(void) | |||
| 1304 | { | 1304 | { |
| 1305 | struct ffs_data *ffs = kzalloc(sizeof *ffs, GFP_KERNEL); | 1305 | struct ffs_data *ffs = kzalloc(sizeof *ffs, GFP_KERNEL); |
| 1306 | if (unlikely(!ffs)) | 1306 | if (unlikely(!ffs)) |
| 1307 | return 0; | 1307 | return NULL; |
| 1308 | 1308 | ||
| 1309 | ENTER(); | 1309 | ENTER(); |
| 1310 | 1310 | ||
diff --git a/drivers/usb/gadget/f_mass_storage.c b/drivers/usb/gadget/f_mass_storage.c index a03ba2c83589..b96393908860 100644 --- a/drivers/usb/gadget/f_mass_storage.c +++ b/drivers/usb/gadget/f_mass_storage.c | |||
| @@ -523,7 +523,7 @@ static int fsg_setup(struct usb_function *f, | |||
| 523 | */ | 523 | */ |
| 524 | DBG(fsg, "bulk reset request\n"); | 524 | DBG(fsg, "bulk reset request\n"); |
| 525 | raise_exception(fsg->common, FSG_STATE_RESET); | 525 | raise_exception(fsg->common, FSG_STATE_RESET); |
| 526 | return DELAYED_STATUS; | 526 | return USB_GADGET_DELAYED_STATUS; |
| 527 | 527 | ||
| 528 | case US_BULK_GET_MAX_LUN: | 528 | case US_BULK_GET_MAX_LUN: |
| 529 | if (ctrl->bRequestType != | 529 | if (ctrl->bRequestType != |
| @@ -602,13 +602,14 @@ static bool start_out_transfer(struct fsg_common *common, struct fsg_buffhd *bh) | |||
| 602 | return true; | 602 | return true; |
| 603 | } | 603 | } |
| 604 | 604 | ||
| 605 | static int sleep_thread(struct fsg_common *common) | 605 | static int sleep_thread(struct fsg_common *common, bool can_freeze) |
| 606 | { | 606 | { |
| 607 | int rc = 0; | 607 | int rc = 0; |
| 608 | 608 | ||
| 609 | /* Wait until a signal arrives or we are woken up */ | 609 | /* Wait until a signal arrives or we are woken up */ |
| 610 | for (;;) { | 610 | for (;;) { |
| 611 | try_to_freeze(); | 611 | if (can_freeze) |
| 612 | try_to_freeze(); | ||
| 612 | set_current_state(TASK_INTERRUPTIBLE); | 613 | set_current_state(TASK_INTERRUPTIBLE); |
| 613 | if (signal_pending(current)) { | 614 | if (signal_pending(current)) { |
| 614 | rc = -EINTR; | 615 | rc = -EINTR; |
| @@ -682,7 +683,7 @@ static int do_read(struct fsg_common *common) | |||
| 682 | /* Wait for the next buffer to become available */ | 683 | /* Wait for the next buffer to become available */ |
| 683 | bh = common->next_buffhd_to_fill; | 684 | bh = common->next_buffhd_to_fill; |
| 684 | while (bh->state != BUF_STATE_EMPTY) { | 685 | while (bh->state != BUF_STATE_EMPTY) { |
| 685 | rc = sleep_thread(common); | 686 | rc = sleep_thread(common, false); |
| 686 | if (rc) | 687 | if (rc) |
| 687 | return rc; | 688 | return rc; |
| 688 | } | 689 | } |
| @@ -937,7 +938,7 @@ static int do_write(struct fsg_common *common) | |||
| 937 | } | 938 | } |
| 938 | 939 | ||
| 939 | /* Wait for something to happen */ | 940 | /* Wait for something to happen */ |
| 940 | rc = sleep_thread(common); | 941 | rc = sleep_thread(common, false); |
| 941 | if (rc) | 942 | if (rc) |
| 942 | return rc; | 943 | return rc; |
| 943 | } | 944 | } |
| @@ -1504,7 +1505,7 @@ static int throw_away_data(struct fsg_common *common) | |||
| 1504 | } | 1505 | } |
| 1505 | 1506 | ||
| 1506 | /* Otherwise wait for something to happen */ | 1507 | /* Otherwise wait for something to happen */ |
| 1507 | rc = sleep_thread(common); | 1508 | rc = sleep_thread(common, true); |
| 1508 | if (rc) | 1509 | if (rc) |
| 1509 | return rc; | 1510 | return rc; |
| 1510 | } | 1511 | } |
| @@ -1625,7 +1626,7 @@ static int send_status(struct fsg_common *common) | |||
| 1625 | /* Wait for the next buffer to become available */ | 1626 | /* Wait for the next buffer to become available */ |
| 1626 | bh = common->next_buffhd_to_fill; | 1627 | bh = common->next_buffhd_to_fill; |
| 1627 | while (bh->state != BUF_STATE_EMPTY) { | 1628 | while (bh->state != BUF_STATE_EMPTY) { |
| 1628 | rc = sleep_thread(common); | 1629 | rc = sleep_thread(common, true); |
| 1629 | if (rc) | 1630 | if (rc) |
| 1630 | return rc; | 1631 | return rc; |
| 1631 | } | 1632 | } |
| @@ -1828,7 +1829,7 @@ static int do_scsi_command(struct fsg_common *common) | |||
| 1828 | bh = common->next_buffhd_to_fill; | 1829 | bh = common->next_buffhd_to_fill; |
| 1829 | common->next_buffhd_to_drain = bh; | 1830 | common->next_buffhd_to_drain = bh; |
| 1830 | while (bh->state != BUF_STATE_EMPTY) { | 1831 | while (bh->state != BUF_STATE_EMPTY) { |
| 1831 | rc = sleep_thread(common); | 1832 | rc = sleep_thread(common, true); |
| 1832 | if (rc) | 1833 | if (rc) |
| 1833 | return rc; | 1834 | return rc; |
| 1834 | } | 1835 | } |
| @@ -2174,7 +2175,7 @@ static int get_next_command(struct fsg_common *common) | |||
| 2174 | /* Wait for the next buffer to become available */ | 2175 | /* Wait for the next buffer to become available */ |
| 2175 | bh = common->next_buffhd_to_fill; | 2176 | bh = common->next_buffhd_to_fill; |
| 2176 | while (bh->state != BUF_STATE_EMPTY) { | 2177 | while (bh->state != BUF_STATE_EMPTY) { |
| 2177 | rc = sleep_thread(common); | 2178 | rc = sleep_thread(common, true); |
| 2178 | if (rc) | 2179 | if (rc) |
| 2179 | return rc; | 2180 | return rc; |
| 2180 | } | 2181 | } |
| @@ -2193,7 +2194,7 @@ static int get_next_command(struct fsg_common *common) | |||
| 2193 | 2194 | ||
| 2194 | /* Wait for the CBW to arrive */ | 2195 | /* Wait for the CBW to arrive */ |
| 2195 | while (bh->state != BUF_STATE_FULL) { | 2196 | while (bh->state != BUF_STATE_FULL) { |
| 2196 | rc = sleep_thread(common); | 2197 | rc = sleep_thread(common, true); |
| 2197 | if (rc) | 2198 | if (rc) |
| 2198 | return rc; | 2199 | return rc; |
| 2199 | } | 2200 | } |
| @@ -2379,7 +2380,7 @@ static void handle_exception(struct fsg_common *common) | |||
| 2379 | } | 2380 | } |
| 2380 | if (num_active == 0) | 2381 | if (num_active == 0) |
| 2381 | break; | 2382 | break; |
| 2382 | if (sleep_thread(common)) | 2383 | if (sleep_thread(common, true)) |
| 2383 | return; | 2384 | return; |
| 2384 | } | 2385 | } |
| 2385 | 2386 | ||
| @@ -2516,7 +2517,7 @@ static int fsg_main_thread(void *common_) | |||
| 2516 | } | 2517 | } |
| 2517 | 2518 | ||
| 2518 | if (!common->running) { | 2519 | if (!common->running) { |
| 2519 | sleep_thread(common); | 2520 | sleep_thread(common, true); |
| 2520 | continue; | 2521 | continue; |
| 2521 | } | 2522 | } |
| 2522 | 2523 | ||
| @@ -3111,7 +3112,7 @@ static int fsg_bind(struct usb_configuration *c, struct usb_function *f) | |||
| 3111 | fsg->common->can_stall); | 3112 | fsg->common->can_stall); |
| 3112 | if (ret) | 3113 | if (ret) |
| 3113 | return ret; | 3114 | return ret; |
| 3114 | fsg_common_set_inquiry_string(fsg->common, 0, 0); | 3115 | fsg_common_set_inquiry_string(fsg->common, NULL, NULL); |
| 3115 | ret = fsg_common_run_thread(fsg->common); | 3116 | ret = fsg_common_run_thread(fsg->common); |
| 3116 | if (ret) | 3117 | if (ret) |
| 3117 | return ret; | 3118 | return ret; |
diff --git a/drivers/usb/gadget/pxa25x_udc.c b/drivers/usb/gadget/pxa25x_udc.c index 0ac6064aa3b8..409a3c45a36a 100644 --- a/drivers/usb/gadget/pxa25x_udc.c +++ b/drivers/usb/gadget/pxa25x_udc.c | |||
| @@ -54,6 +54,7 @@ | |||
| 54 | */ | 54 | */ |
| 55 | #ifdef CONFIG_ARCH_PXA | 55 | #ifdef CONFIG_ARCH_PXA |
| 56 | #include <mach/pxa25x-udc.h> | 56 | #include <mach/pxa25x-udc.h> |
| 57 | #include <mach/hardware.h> | ||
| 57 | #endif | 58 | #endif |
| 58 | 59 | ||
| 59 | #ifdef CONFIG_ARCH_LUBBOCK | 60 | #ifdef CONFIG_ARCH_LUBBOCK |
diff --git a/drivers/usb/gadget/s3c-hsotg.c b/drivers/usb/gadget/s3c-hsotg.c index 9875d9c0823f..e20bc109fdd7 100644 --- a/drivers/usb/gadget/s3c-hsotg.c +++ b/drivers/usb/gadget/s3c-hsotg.c | |||
| @@ -1180,6 +1180,7 @@ static int s3c_hsotg_process_req_feature(struct s3c_hsotg *hsotg, | |||
| 1180 | } | 1180 | } |
| 1181 | 1181 | ||
| 1182 | static void s3c_hsotg_enqueue_setup(struct s3c_hsotg *hsotg); | 1182 | static void s3c_hsotg_enqueue_setup(struct s3c_hsotg *hsotg); |
| 1183 | static void s3c_hsotg_disconnect(struct s3c_hsotg *hsotg); | ||
| 1183 | 1184 | ||
| 1184 | /** | 1185 | /** |
| 1185 | * s3c_hsotg_process_control - process a control request | 1186 | * s3c_hsotg_process_control - process a control request |
| @@ -1221,6 +1222,7 @@ static void s3c_hsotg_process_control(struct s3c_hsotg *hsotg, | |||
| 1221 | if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { | 1222 | if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { |
| 1222 | switch (ctrl->bRequest) { | 1223 | switch (ctrl->bRequest) { |
| 1223 | case USB_REQ_SET_ADDRESS: | 1224 | case USB_REQ_SET_ADDRESS: |
| 1225 | s3c_hsotg_disconnect(hsotg); | ||
| 1224 | dcfg = readl(hsotg->regs + DCFG); | 1226 | dcfg = readl(hsotg->regs + DCFG); |
| 1225 | dcfg &= ~DCFG_DevAddr_MASK; | 1227 | dcfg &= ~DCFG_DevAddr_MASK; |
| 1226 | dcfg |= ctrl->wValue << DCFG_DevAddr_SHIFT; | 1228 | dcfg |= ctrl->wValue << DCFG_DevAddr_SHIFT; |
| @@ -1245,7 +1247,9 @@ static void s3c_hsotg_process_control(struct s3c_hsotg *hsotg, | |||
| 1245 | /* as a fallback, try delivering it to the driver to deal with */ | 1247 | /* as a fallback, try delivering it to the driver to deal with */ |
| 1246 | 1248 | ||
| 1247 | if (ret == 0 && hsotg->driver) { | 1249 | if (ret == 0 && hsotg->driver) { |
| 1250 | spin_unlock(&hsotg->lock); | ||
| 1248 | ret = hsotg->driver->setup(&hsotg->gadget, ctrl); | 1251 | ret = hsotg->driver->setup(&hsotg->gadget, ctrl); |
| 1252 | spin_lock(&hsotg->lock); | ||
| 1249 | if (ret < 0) | 1253 | if (ret < 0) |
| 1250 | dev_dbg(hsotg->dev, "driver->setup() ret %d\n", ret); | 1254 | dev_dbg(hsotg->dev, "driver->setup() ret %d\n", ret); |
| 1251 | } | 1255 | } |
| @@ -1308,10 +1312,12 @@ static void s3c_hsotg_complete_setup(struct usb_ep *ep, | |||
| 1308 | return; | 1312 | return; |
| 1309 | } | 1313 | } |
| 1310 | 1314 | ||
| 1315 | spin_lock(&hsotg->lock); | ||
| 1311 | if (req->actual == 0) | 1316 | if (req->actual == 0) |
| 1312 | s3c_hsotg_enqueue_setup(hsotg); | 1317 | s3c_hsotg_enqueue_setup(hsotg); |
| 1313 | else | 1318 | else |
| 1314 | s3c_hsotg_process_control(hsotg, req->buf); | 1319 | s3c_hsotg_process_control(hsotg, req->buf); |
| 1320 | spin_unlock(&hsotg->lock); | ||
| 1315 | } | 1321 | } |
| 1316 | 1322 | ||
| 1317 | /** | 1323 | /** |
| @@ -2533,7 +2539,6 @@ irq_retry: | |||
| 2533 | writel(GINTSTS_USBSusp, hsotg->regs + GINTSTS); | 2539 | writel(GINTSTS_USBSusp, hsotg->regs + GINTSTS); |
| 2534 | 2540 | ||
| 2535 | call_gadget(hsotg, suspend); | 2541 | call_gadget(hsotg, suspend); |
| 2536 | s3c_hsotg_disconnect(hsotg); | ||
| 2537 | } | 2542 | } |
| 2538 | 2543 | ||
| 2539 | if (gintsts & GINTSTS_WkUpInt) { | 2544 | if (gintsts & GINTSTS_WkUpInt) { |
diff --git a/drivers/usb/gadget/storage_common.h b/drivers/usb/gadget/storage_common.h index c74c2fdbd56e..70c891469f57 100644 --- a/drivers/usb/gadget/storage_common.h +++ b/drivers/usb/gadget/storage_common.h | |||
| @@ -119,10 +119,6 @@ static inline bool fsg_lun_is_open(struct fsg_lun *curlun) | |||
| 119 | return curlun->filp != NULL; | 119 | return curlun->filp != NULL; |
| 120 | } | 120 | } |
| 121 | 121 | ||
| 122 | /* Big enough to hold our biggest descriptor */ | ||
| 123 | #define EP0_BUFSIZE 256 | ||
| 124 | #define DELAYED_STATUS (EP0_BUFSIZE + 999) /* An impossibly large value */ | ||
| 125 | |||
| 126 | /* Default size of buffer length. */ | 122 | /* Default size of buffer length. */ |
| 127 | #define FSG_BUFLEN ((u32)16384) | 123 | #define FSG_BUFLEN ((u32)16384) |
| 128 | 124 | ||
diff --git a/drivers/usb/gadget/tcm_usb_gadget.c b/drivers/usb/gadget/tcm_usb_gadget.c index 6c3d7950d2a9..0f8aad78b54f 100644 --- a/drivers/usb/gadget/tcm_usb_gadget.c +++ b/drivers/usb/gadget/tcm_usb_gadget.c | |||
| @@ -370,7 +370,7 @@ err: | |||
| 370 | return -ENOMEM; | 370 | return -ENOMEM; |
| 371 | } | 371 | } |
| 372 | 372 | ||
| 373 | void bot_cleanup_old_alt(struct f_uas *fu) | 373 | static void bot_cleanup_old_alt(struct f_uas *fu) |
| 374 | { | 374 | { |
| 375 | if (!(fu->flags & USBG_ENABLED)) | 375 | if (!(fu->flags & USBG_ENABLED)) |
| 376 | return; | 376 | return; |
diff --git a/drivers/usb/gadget/zero.c b/drivers/usb/gadget/zero.c index 0dd07ae1555d..f49b0b61ecc8 100644 --- a/drivers/usb/gadget/zero.c +++ b/drivers/usb/gadget/zero.c | |||
| @@ -91,17 +91,17 @@ static struct usb_zero_options gzero_options = { | |||
| 91 | * functional coverage for the "USBCV" test harness from USB-IF. | 91 | * functional coverage for the "USBCV" test harness from USB-IF. |
| 92 | * It's always set if OTG mode is enabled. | 92 | * It's always set if OTG mode is enabled. |
| 93 | */ | 93 | */ |
| 94 | unsigned autoresume = DEFAULT_AUTORESUME; | 94 | static unsigned autoresume = DEFAULT_AUTORESUME; |
| 95 | module_param(autoresume, uint, S_IRUGO); | 95 | module_param(autoresume, uint, S_IRUGO); |
| 96 | MODULE_PARM_DESC(autoresume, "zero, or seconds before remote wakeup"); | 96 | MODULE_PARM_DESC(autoresume, "zero, or seconds before remote wakeup"); |
| 97 | 97 | ||
| 98 | /* Maximum Autoresume time */ | 98 | /* Maximum Autoresume time */ |
| 99 | unsigned max_autoresume; | 99 | static unsigned max_autoresume; |
| 100 | module_param(max_autoresume, uint, S_IRUGO); | 100 | module_param(max_autoresume, uint, S_IRUGO); |
| 101 | MODULE_PARM_DESC(max_autoresume, "maximum seconds before remote wakeup"); | 101 | MODULE_PARM_DESC(max_autoresume, "maximum seconds before remote wakeup"); |
| 102 | 102 | ||
| 103 | /* Interval between two remote wakeups */ | 103 | /* Interval between two remote wakeups */ |
| 104 | unsigned autoresume_interval_ms; | 104 | static unsigned autoresume_interval_ms; |
| 105 | module_param(autoresume_interval_ms, uint, S_IRUGO); | 105 | module_param(autoresume_interval_ms, uint, S_IRUGO); |
| 106 | MODULE_PARM_DESC(autoresume_interval_ms, | 106 | MODULE_PARM_DESC(autoresume_interval_ms, |
| 107 | "milliseconds to increase successive wakeup delays"); | 107 | "milliseconds to increase successive wakeup delays"); |
diff --git a/drivers/usb/host/ohci-pxa27x.c b/drivers/usb/host/ohci-pxa27x.c index e89ac4d4b87e..9b7435f0dcd6 100644 --- a/drivers/usb/host/ohci-pxa27x.c +++ b/drivers/usb/host/ohci-pxa27x.c | |||
| @@ -21,6 +21,7 @@ | |||
| 21 | 21 | ||
| 22 | #include <linux/clk.h> | 22 | #include <linux/clk.h> |
| 23 | #include <linux/device.h> | 23 | #include <linux/device.h> |
| 24 | #include <linux/dma-mapping.h> | ||
| 24 | #include <linux/io.h> | 25 | #include <linux/io.h> |
| 25 | #include <linux/kernel.h> | 26 | #include <linux/kernel.h> |
| 26 | #include <linux/module.h> | 27 | #include <linux/module.h> |
diff --git a/drivers/usb/host/xhci-ring.c b/drivers/usb/host/xhci-ring.c index 1e2f3f495843..53c2e296467f 100644 --- a/drivers/usb/host/xhci-ring.c +++ b/drivers/usb/host/xhci-ring.c | |||
| @@ -2973,8 +2973,58 @@ static int prepare_ring(struct xhci_hcd *xhci, struct xhci_ring *ep_ring, | |||
| 2973 | } | 2973 | } |
| 2974 | 2974 | ||
| 2975 | while (1) { | 2975 | while (1) { |
| 2976 | if (room_on_ring(xhci, ep_ring, num_trbs)) | 2976 | if (room_on_ring(xhci, ep_ring, num_trbs)) { |
| 2977 | break; | 2977 | union xhci_trb *trb = ep_ring->enqueue; |
| 2978 | unsigned int usable = ep_ring->enq_seg->trbs + | ||
| 2979 | TRBS_PER_SEGMENT - 1 - trb; | ||
| 2980 | u32 nop_cmd; | ||
| 2981 | |||
| 2982 | /* | ||
| 2983 | * Section 4.11.7.1 TD Fragments states that a link | ||
| 2984 | * TRB must only occur at the boundary between | ||
| 2985 | * data bursts (eg 512 bytes for 480M). | ||
| 2986 | * While it is possible to split a large fragment | ||
| 2987 | * we don't know the size yet. | ||
| 2988 | * Simplest solution is to fill the trb before the | ||
| 2989 | * LINK with nop commands. | ||
| 2990 | */ | ||
| 2991 | if (num_trbs == 1 || num_trbs <= usable || usable == 0) | ||
| 2992 | break; | ||
| 2993 | |||
| 2994 | if (ep_ring->type != TYPE_BULK) | ||
| 2995 | /* | ||
| 2996 | * While isoc transfers might have a buffer that | ||
| 2997 | * crosses a 64k boundary it is unlikely. | ||
| 2998 | * Since we can't add NOPs without generating | ||
| 2999 | * gaps in the traffic just hope it never | ||
| 3000 | * happens at the end of the ring. | ||
| 3001 | * This could be fixed by writing a LINK TRB | ||
| 3002 | * instead of the first NOP - however the | ||
| 3003 | * TRB_TYPE_LINK_LE32() calls would all need | ||
| 3004 | * changing to check the ring length. | ||
| 3005 | */ | ||
| 3006 | break; | ||
| 3007 | |||
| 3008 | if (num_trbs >= TRBS_PER_SEGMENT) { | ||
| 3009 | xhci_err(xhci, "Too many fragments %d, max %d\n", | ||
| 3010 | num_trbs, TRBS_PER_SEGMENT - 1); | ||
| 3011 | return -ENOMEM; | ||
| 3012 | } | ||
| 3013 | |||
| 3014 | nop_cmd = cpu_to_le32(TRB_TYPE(TRB_TR_NOOP) | | ||
| 3015 | ep_ring->cycle_state); | ||
| 3016 | ep_ring->num_trbs_free -= usable; | ||
| 3017 | do { | ||
| 3018 | trb->generic.field[0] = 0; | ||
| 3019 | trb->generic.field[1] = 0; | ||
| 3020 | trb->generic.field[2] = 0; | ||
| 3021 | trb->generic.field[3] = nop_cmd; | ||
| 3022 | trb++; | ||
| 3023 | } while (--usable); | ||
| 3024 | ep_ring->enqueue = trb; | ||
| 3025 | if (room_on_ring(xhci, ep_ring, num_trbs)) | ||
| 3026 | break; | ||
| 3027 | } | ||
| 2978 | 3028 | ||
| 2979 | if (ep_ring == xhci->cmd_ring) { | 3029 | if (ep_ring == xhci->cmd_ring) { |
| 2980 | xhci_err(xhci, "Do not support expand command ring\n"); | 3030 | xhci_err(xhci, "Do not support expand command ring\n"); |
diff --git a/drivers/usb/musb/musb_core.c b/drivers/usb/musb/musb_core.c index 0a43329569d1..4d4499b80449 100644 --- a/drivers/usb/musb/musb_core.c +++ b/drivers/usb/musb/musb_core.c | |||
| @@ -1809,7 +1809,6 @@ static void musb_free(struct musb *musb) | |||
| 1809 | disable_irq_wake(musb->nIrq); | 1809 | disable_irq_wake(musb->nIrq); |
| 1810 | free_irq(musb->nIrq, musb); | 1810 | free_irq(musb->nIrq, musb); |
| 1811 | } | 1811 | } |
| 1812 | cancel_work_sync(&musb->irq_work); | ||
| 1813 | 1812 | ||
| 1814 | musb_host_free(musb); | 1813 | musb_host_free(musb); |
| 1815 | } | 1814 | } |
| @@ -1896,6 +1895,9 @@ musb_init_controller(struct device *dev, int nIrq, void __iomem *ctrl) | |||
| 1896 | musb_platform_disable(musb); | 1895 | musb_platform_disable(musb); |
| 1897 | musb_generic_disable(musb); | 1896 | musb_generic_disable(musb); |
| 1898 | 1897 | ||
| 1898 | /* Init IRQ workqueue before request_irq */ | ||
| 1899 | INIT_WORK(&musb->irq_work, musb_irq_work); | ||
| 1900 | |||
| 1899 | /* setup musb parts of the core (especially endpoints) */ | 1901 | /* setup musb parts of the core (especially endpoints) */ |
| 1900 | status = musb_core_init(plat->config->multipoint | 1902 | status = musb_core_init(plat->config->multipoint |
| 1901 | ? MUSB_CONTROLLER_MHDRC | 1903 | ? MUSB_CONTROLLER_MHDRC |
| @@ -1905,9 +1907,6 @@ musb_init_controller(struct device *dev, int nIrq, void __iomem *ctrl) | |||
| 1905 | 1907 | ||
| 1906 | setup_timer(&musb->otg_timer, musb_otg_timer_func, (unsigned long) musb); | 1908 | setup_timer(&musb->otg_timer, musb_otg_timer_func, (unsigned long) musb); |
| 1907 | 1909 | ||
| 1908 | /* Init IRQ workqueue before request_irq */ | ||
| 1909 | INIT_WORK(&musb->irq_work, musb_irq_work); | ||
| 1910 | |||
| 1911 | /* attach to the IRQ */ | 1910 | /* attach to the IRQ */ |
| 1912 | if (request_irq(nIrq, musb->isr, 0, dev_name(dev), musb)) { | 1911 | if (request_irq(nIrq, musb->isr, 0, dev_name(dev), musb)) { |
| 1913 | dev_err(dev, "request_irq %d failed!\n", nIrq); | 1912 | dev_err(dev, "request_irq %d failed!\n", nIrq); |
| @@ -1981,6 +1980,7 @@ fail4: | |||
| 1981 | musb_host_cleanup(musb); | 1980 | musb_host_cleanup(musb); |
| 1982 | 1981 | ||
| 1983 | fail3: | 1982 | fail3: |
| 1983 | cancel_work_sync(&musb->irq_work); | ||
| 1984 | if (musb->dma_controller) | 1984 | if (musb->dma_controller) |
| 1985 | dma_controller_destroy(musb->dma_controller); | 1985 | dma_controller_destroy(musb->dma_controller); |
| 1986 | fail2_5: | 1986 | fail2_5: |
| @@ -2043,6 +2043,7 @@ static int musb_remove(struct platform_device *pdev) | |||
| 2043 | if (musb->dma_controller) | 2043 | if (musb->dma_controller) |
| 2044 | dma_controller_destroy(musb->dma_controller); | 2044 | dma_controller_destroy(musb->dma_controller); |
| 2045 | 2045 | ||
| 2046 | cancel_work_sync(&musb->irq_work); | ||
| 2046 | musb_free(musb); | 2047 | musb_free(musb); |
| 2047 | device_init_wakeup(dev, 0); | 2048 | device_init_wakeup(dev, 0); |
| 2048 | return 0; | 2049 | return 0; |
diff --git a/drivers/usb/musb/musb_cppi41.c b/drivers/usb/musb/musb_cppi41.c index ff9d6de2b746..a12bd30401e0 100644 --- a/drivers/usb/musb/musb_cppi41.c +++ b/drivers/usb/musb/musb_cppi41.c | |||
| @@ -38,6 +38,7 @@ struct cppi41_dma_channel { | |||
| 38 | u32 prog_len; | 38 | u32 prog_len; |
| 39 | u32 transferred; | 39 | u32 transferred; |
| 40 | u32 packet_sz; | 40 | u32 packet_sz; |
| 41 | struct list_head tx_check; | ||
| 41 | }; | 42 | }; |
| 42 | 43 | ||
| 43 | #define MUSB_DMA_NUM_CHANNELS 15 | 44 | #define MUSB_DMA_NUM_CHANNELS 15 |
| @@ -47,6 +48,8 @@ struct cppi41_dma_controller { | |||
| 47 | struct cppi41_dma_channel rx_channel[MUSB_DMA_NUM_CHANNELS]; | 48 | struct cppi41_dma_channel rx_channel[MUSB_DMA_NUM_CHANNELS]; |
| 48 | struct cppi41_dma_channel tx_channel[MUSB_DMA_NUM_CHANNELS]; | 49 | struct cppi41_dma_channel tx_channel[MUSB_DMA_NUM_CHANNELS]; |
| 49 | struct musb *musb; | 50 | struct musb *musb; |
| 51 | struct hrtimer early_tx; | ||
| 52 | struct list_head early_tx_list; | ||
| 50 | u32 rx_mode; | 53 | u32 rx_mode; |
| 51 | u32 tx_mode; | 54 | u32 tx_mode; |
| 52 | u32 auto_req; | 55 | u32 auto_req; |
| @@ -96,31 +99,27 @@ static void update_rx_toggle(struct cppi41_dma_channel *cppi41_channel) | |||
| 96 | cppi41_channel->usb_toggle = toggle; | 99 | cppi41_channel->usb_toggle = toggle; |
| 97 | } | 100 | } |
| 98 | 101 | ||
| 99 | static void cppi41_dma_callback(void *private_data) | 102 | static bool musb_is_tx_fifo_empty(struct musb_hw_ep *hw_ep) |
| 100 | { | 103 | { |
| 101 | struct dma_channel *channel = private_data; | 104 | u8 epnum = hw_ep->epnum; |
| 102 | struct cppi41_dma_channel *cppi41_channel = channel->private_data; | 105 | struct musb *musb = hw_ep->musb; |
| 103 | struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep; | 106 | void __iomem *epio = musb->endpoints[epnum].regs; |
| 104 | struct musb *musb = hw_ep->musb; | 107 | u16 csr; |
| 105 | unsigned long flags; | ||
| 106 | struct dma_tx_state txstate; | ||
| 107 | u32 transferred; | ||
| 108 | 108 | ||
| 109 | spin_lock_irqsave(&musb->lock, flags); | 109 | csr = musb_readw(epio, MUSB_TXCSR); |
| 110 | if (csr & MUSB_TXCSR_TXPKTRDY) | ||
| 111 | return false; | ||
| 112 | return true; | ||
| 113 | } | ||
| 110 | 114 | ||
| 111 | dmaengine_tx_status(cppi41_channel->dc, cppi41_channel->cookie, | 115 | static void cppi41_dma_callback(void *private_data); |
| 112 | &txstate); | ||
| 113 | transferred = cppi41_channel->prog_len - txstate.residue; | ||
| 114 | cppi41_channel->transferred += transferred; | ||
| 115 | 116 | ||
| 116 | dev_dbg(musb->controller, "DMA transfer done on hw_ep=%d bytes=%d/%d\n", | 117 | static void cppi41_trans_done(struct cppi41_dma_channel *cppi41_channel) |
| 117 | hw_ep->epnum, cppi41_channel->transferred, | 118 | { |
| 118 | cppi41_channel->total_len); | 119 | struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep; |
| 120 | struct musb *musb = hw_ep->musb; | ||
| 119 | 121 | ||
| 120 | update_rx_toggle(cppi41_channel); | 122 | if (!cppi41_channel->prog_len) { |
| 121 | |||
| 122 | if (cppi41_channel->transferred == cppi41_channel->total_len || | ||
| 123 | transferred < cppi41_channel->packet_sz) { | ||
| 124 | 123 | ||
| 125 | /* done, complete */ | 124 | /* done, complete */ |
| 126 | cppi41_channel->channel.actual_len = | 125 | cppi41_channel->channel.actual_len = |
| @@ -150,13 +149,11 @@ static void cppi41_dma_callback(void *private_data) | |||
| 150 | remain_bytes, | 149 | remain_bytes, |
| 151 | direction, | 150 | direction, |
| 152 | DMA_PREP_INTERRUPT | DMA_CTRL_ACK); | 151 | DMA_PREP_INTERRUPT | DMA_CTRL_ACK); |
| 153 | if (WARN_ON(!dma_desc)) { | 152 | if (WARN_ON(!dma_desc)) |
| 154 | spin_unlock_irqrestore(&musb->lock, flags); | ||
| 155 | return; | 153 | return; |
| 156 | } | ||
| 157 | 154 | ||
| 158 | dma_desc->callback = cppi41_dma_callback; | 155 | dma_desc->callback = cppi41_dma_callback; |
| 159 | dma_desc->callback_param = channel; | 156 | dma_desc->callback_param = &cppi41_channel->channel; |
| 160 | cppi41_channel->cookie = dma_desc->tx_submit(dma_desc); | 157 | cppi41_channel->cookie = dma_desc->tx_submit(dma_desc); |
| 161 | dma_async_issue_pending(dc); | 158 | dma_async_issue_pending(dc); |
| 162 | 159 | ||
| @@ -166,6 +163,117 @@ static void cppi41_dma_callback(void *private_data) | |||
| 166 | musb_writew(epio, MUSB_RXCSR, csr); | 163 | musb_writew(epio, MUSB_RXCSR, csr); |
| 167 | } | 164 | } |
| 168 | } | 165 | } |
| 166 | } | ||
| 167 | |||
| 168 | static enum hrtimer_restart cppi41_recheck_tx_req(struct hrtimer *timer) | ||
| 169 | { | ||
| 170 | struct cppi41_dma_controller *controller; | ||
| 171 | struct cppi41_dma_channel *cppi41_channel, *n; | ||
| 172 | struct musb *musb; | ||
| 173 | unsigned long flags; | ||
| 174 | enum hrtimer_restart ret = HRTIMER_NORESTART; | ||
| 175 | |||
| 176 | controller = container_of(timer, struct cppi41_dma_controller, | ||
| 177 | early_tx); | ||
| 178 | musb = controller->musb; | ||
| 179 | |||
| 180 | spin_lock_irqsave(&musb->lock, flags); | ||
| 181 | list_for_each_entry_safe(cppi41_channel, n, &controller->early_tx_list, | ||
| 182 | tx_check) { | ||
| 183 | bool empty; | ||
| 184 | struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep; | ||
| 185 | |||
| 186 | empty = musb_is_tx_fifo_empty(hw_ep); | ||
| 187 | if (empty) { | ||
| 188 | list_del_init(&cppi41_channel->tx_check); | ||
| 189 | cppi41_trans_done(cppi41_channel); | ||
| 190 | } | ||
| 191 | } | ||
| 192 | |||
| 193 | if (!list_empty(&controller->early_tx_list)) { | ||
| 194 | ret = HRTIMER_RESTART; | ||
| 195 | hrtimer_forward_now(&controller->early_tx, | ||
| 196 | ktime_set(0, 150 * NSEC_PER_USEC)); | ||
| 197 | } | ||
| 198 | |||
| 199 | spin_unlock_irqrestore(&musb->lock, flags); | ||
| 200 | return ret; | ||
| 201 | } | ||
| 202 | |||
| 203 | static void cppi41_dma_callback(void *private_data) | ||
| 204 | { | ||
| 205 | struct dma_channel *channel = private_data; | ||
| 206 | struct cppi41_dma_channel *cppi41_channel = channel->private_data; | ||
| 207 | struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep; | ||
| 208 | struct musb *musb = hw_ep->musb; | ||
| 209 | unsigned long flags; | ||
| 210 | struct dma_tx_state txstate; | ||
| 211 | u32 transferred; | ||
| 212 | bool empty; | ||
| 213 | |||
| 214 | spin_lock_irqsave(&musb->lock, flags); | ||
| 215 | |||
| 216 | dmaengine_tx_status(cppi41_channel->dc, cppi41_channel->cookie, | ||
| 217 | &txstate); | ||
| 218 | transferred = cppi41_channel->prog_len - txstate.residue; | ||
| 219 | cppi41_channel->transferred += transferred; | ||
| 220 | |||
| 221 | dev_dbg(musb->controller, "DMA transfer done on hw_ep=%d bytes=%d/%d\n", | ||
| 222 | hw_ep->epnum, cppi41_channel->transferred, | ||
| 223 | cppi41_channel->total_len); | ||
| 224 | |||
| 225 | update_rx_toggle(cppi41_channel); | ||
| 226 | |||
| 227 | if (cppi41_channel->transferred == cppi41_channel->total_len || | ||
| 228 | transferred < cppi41_channel->packet_sz) | ||
| 229 | cppi41_channel->prog_len = 0; | ||
| 230 | |||
| 231 | empty = musb_is_tx_fifo_empty(hw_ep); | ||
| 232 | if (empty) { | ||
| 233 | cppi41_trans_done(cppi41_channel); | ||
| 234 | } else { | ||
| 235 | struct cppi41_dma_controller *controller; | ||
| 236 | /* | ||
| 237 | * On AM335x it has been observed that the TX interrupt fires | ||
| 238 | * too early that means the TXFIFO is not yet empty but the DMA | ||
| 239 | * engine says that it is done with the transfer. We don't | ||
| 240 | * receive a FIFO empty interrupt so the only thing we can do is | ||
| 241 | * to poll for the bit. On HS it usually takes 2us, on FS around | ||
| 242 | * 110us - 150us depending on the transfer size. | ||
| 243 | * We spin on HS (no longer than than 25us and setup a timer on | ||
| 244 | * FS to check for the bit and complete the transfer. | ||
| 245 | */ | ||
| 246 | controller = cppi41_channel->controller; | ||
| 247 | |||
| 248 | if (musb->g.speed == USB_SPEED_HIGH) { | ||
| 249 | unsigned wait = 25; | ||
| 250 | |||
| 251 | do { | ||
| 252 | empty = musb_is_tx_fifo_empty(hw_ep); | ||
| 253 | if (empty) | ||
| 254 | break; | ||
| 255 | wait--; | ||
| 256 | if (!wait) | ||
| 257 | break; | ||
| 258 | udelay(1); | ||
| 259 | } while (1); | ||
| 260 | |||
| 261 | empty = musb_is_tx_fifo_empty(hw_ep); | ||
| 262 | if (empty) { | ||
| 263 | cppi41_trans_done(cppi41_channel); | ||
| 264 | goto out; | ||
| 265 | } | ||
| 266 | } | ||
| 267 | list_add_tail(&cppi41_channel->tx_check, | ||
| 268 | &controller->early_tx_list); | ||
| 269 | if (!hrtimer_active(&controller->early_tx)) { | ||
| 270 | hrtimer_start_range_ns(&controller->early_tx, | ||
| 271 | ktime_set(0, 140 * NSEC_PER_USEC), | ||
| 272 | 40 * NSEC_PER_USEC, | ||
| 273 | HRTIMER_MODE_REL); | ||
| 274 | } | ||
| 275 | } | ||
| 276 | out: | ||
| 169 | spin_unlock_irqrestore(&musb->lock, flags); | 277 | spin_unlock_irqrestore(&musb->lock, flags); |
| 170 | } | 278 | } |
| 171 | 279 | ||
| @@ -364,6 +472,8 @@ static int cppi41_is_compatible(struct dma_channel *channel, u16 maxpacket, | |||
| 364 | WARN_ON(1); | 472 | WARN_ON(1); |
| 365 | return 1; | 473 | return 1; |
| 366 | } | 474 | } |
| 475 | if (cppi41_channel->hw_ep->ep_in.type != USB_ENDPOINT_XFER_BULK) | ||
| 476 | return 0; | ||
| 367 | if (cppi41_channel->is_tx) | 477 | if (cppi41_channel->is_tx) |
| 368 | return 1; | 478 | return 1; |
| 369 | /* AM335x Advisory 1.0.13. No workaround for device RX mode */ | 479 | /* AM335x Advisory 1.0.13. No workaround for device RX mode */ |
| @@ -388,6 +498,7 @@ static int cppi41_dma_channel_abort(struct dma_channel *channel) | |||
| 388 | if (cppi41_channel->channel.status == MUSB_DMA_STATUS_FREE) | 498 | if (cppi41_channel->channel.status == MUSB_DMA_STATUS_FREE) |
| 389 | return 0; | 499 | return 0; |
| 390 | 500 | ||
| 501 | list_del_init(&cppi41_channel->tx_check); | ||
| 391 | if (is_tx) { | 502 | if (is_tx) { |
| 392 | csr = musb_readw(epio, MUSB_TXCSR); | 503 | csr = musb_readw(epio, MUSB_TXCSR); |
| 393 | csr &= ~MUSB_TXCSR_DMAENAB; | 504 | csr &= ~MUSB_TXCSR_DMAENAB; |
| @@ -495,6 +606,7 @@ static int cppi41_dma_controller_start(struct cppi41_dma_controller *controller) | |||
| 495 | cppi41_channel->controller = controller; | 606 | cppi41_channel->controller = controller; |
| 496 | cppi41_channel->port_num = port; | 607 | cppi41_channel->port_num = port; |
| 497 | cppi41_channel->is_tx = is_tx; | 608 | cppi41_channel->is_tx = is_tx; |
| 609 | INIT_LIST_HEAD(&cppi41_channel->tx_check); | ||
| 498 | 610 | ||
| 499 | musb_dma = &cppi41_channel->channel; | 611 | musb_dma = &cppi41_channel->channel; |
| 500 | musb_dma->private_data = cppi41_channel; | 612 | musb_dma->private_data = cppi41_channel; |
| @@ -520,6 +632,7 @@ void dma_controller_destroy(struct dma_controller *c) | |||
| 520 | struct cppi41_dma_controller *controller = container_of(c, | 632 | struct cppi41_dma_controller *controller = container_of(c, |
| 521 | struct cppi41_dma_controller, controller); | 633 | struct cppi41_dma_controller, controller); |
| 522 | 634 | ||
| 635 | hrtimer_cancel(&controller->early_tx); | ||
| 523 | cppi41_dma_controller_stop(controller); | 636 | cppi41_dma_controller_stop(controller); |
| 524 | kfree(controller); | 637 | kfree(controller); |
| 525 | } | 638 | } |
| @@ -539,6 +652,9 @@ struct dma_controller *dma_controller_create(struct musb *musb, | |||
| 539 | if (!controller) | 652 | if (!controller) |
| 540 | goto kzalloc_fail; | 653 | goto kzalloc_fail; |
| 541 | 654 | ||
| 655 | hrtimer_init(&controller->early_tx, CLOCK_MONOTONIC, HRTIMER_MODE_REL); | ||
| 656 | controller->early_tx.function = cppi41_recheck_tx_req; | ||
| 657 | INIT_LIST_HEAD(&controller->early_tx_list); | ||
| 542 | controller->musb = musb; | 658 | controller->musb = musb; |
| 543 | 659 | ||
| 544 | controller->controller.channel_alloc = cppi41_dma_channel_allocate; | 660 | controller->controller.channel_alloc = cppi41_dma_channel_allocate; |
diff --git a/drivers/usb/musb/musb_gadget.c b/drivers/usb/musb/musb_gadget.c index d2d3a173b315..32fb057c03f5 100644 --- a/drivers/usb/musb/musb_gadget.c +++ b/drivers/usb/musb/musb_gadget.c | |||
| @@ -1796,7 +1796,11 @@ int musb_gadget_setup(struct musb *musb) | |||
| 1796 | 1796 | ||
| 1797 | /* this "gadget" abstracts/virtualizes the controller */ | 1797 | /* this "gadget" abstracts/virtualizes the controller */ |
| 1798 | musb->g.name = musb_driver_name; | 1798 | musb->g.name = musb_driver_name; |
| 1799 | #if IS_ENABLED(CONFIG_USB_MUSB_DUAL_ROLE) | ||
| 1799 | musb->g.is_otg = 1; | 1800 | musb->g.is_otg = 1; |
| 1801 | #elif IS_ENABLED(CONFIG_USB_MUSB_GADGET) | ||
| 1802 | musb->g.is_otg = 0; | ||
| 1803 | #endif | ||
| 1800 | 1804 | ||
| 1801 | musb_g_init_endpoints(musb); | 1805 | musb_g_init_endpoints(musb); |
| 1802 | 1806 | ||
diff --git a/drivers/usb/phy/phy-am335x.c b/drivers/usb/phy/phy-am335x.c index 6370e50649d7..0e3c60cb669a 100644 --- a/drivers/usb/phy/phy-am335x.c +++ b/drivers/usb/phy/phy-am335x.c | |||
| @@ -52,8 +52,7 @@ static int am335x_phy_probe(struct platform_device *pdev) | |||
| 52 | return am_phy->id; | 52 | return am_phy->id; |
| 53 | } | 53 | } |
| 54 | 54 | ||
| 55 | ret = usb_phy_gen_create_phy(dev, &am_phy->usb_phy_gen, | 55 | ret = usb_phy_gen_create_phy(dev, &am_phy->usb_phy_gen, NULL); |
| 56 | USB_PHY_TYPE_USB2, 0, false); | ||
| 57 | if (ret) | 56 | if (ret) |
| 58 | return ret; | 57 | return ret; |
| 59 | 58 | ||
| @@ -66,8 +65,6 @@ static int am335x_phy_probe(struct platform_device *pdev) | |||
| 66 | platform_set_drvdata(pdev, am_phy); | 65 | platform_set_drvdata(pdev, am_phy); |
| 67 | 66 | ||
| 68 | return 0; | 67 | return 0; |
| 69 | |||
| 70 | return ret; | ||
| 71 | } | 68 | } |
| 72 | 69 | ||
| 73 | static int am335x_phy_remove(struct platform_device *pdev) | 70 | static int am335x_phy_remove(struct platform_device *pdev) |
diff --git a/drivers/usb/phy/phy-generic.c b/drivers/usb/phy/phy-generic.c index fce3a9e9bb5d..aa6d37b3378a 100644 --- a/drivers/usb/phy/phy-generic.c +++ b/drivers/usb/phy/phy-generic.c | |||
| @@ -48,8 +48,9 @@ void usb_nop_xceiv_register(void) | |||
| 48 | if (pd) | 48 | if (pd) |
| 49 | return; | 49 | return; |
| 50 | pd = platform_device_register_simple("usb_phy_gen_xceiv", -1, NULL, 0); | 50 | pd = platform_device_register_simple("usb_phy_gen_xceiv", -1, NULL, 0); |
| 51 | if (!pd) { | 51 | if (IS_ERR(pd)) { |
| 52 | pr_err("Unable to register generic usb transceiver\n"); | 52 | pr_err("Unable to register generic usb transceiver\n"); |
| 53 | pd = NULL; | ||
| 53 | return; | 54 | return; |
| 54 | } | 55 | } |
| 55 | } | 56 | } |
| @@ -150,10 +151,40 @@ static int nop_set_host(struct usb_otg *otg, struct usb_bus *host) | |||
| 150 | } | 151 | } |
| 151 | 152 | ||
| 152 | int usb_phy_gen_create_phy(struct device *dev, struct usb_phy_gen_xceiv *nop, | 153 | int usb_phy_gen_create_phy(struct device *dev, struct usb_phy_gen_xceiv *nop, |
| 153 | enum usb_phy_type type, u32 clk_rate, bool needs_vcc) | 154 | struct usb_phy_gen_xceiv_platform_data *pdata) |
| 154 | { | 155 | { |
| 156 | enum usb_phy_type type = USB_PHY_TYPE_USB2; | ||
| 155 | int err; | 157 | int err; |
| 156 | 158 | ||
| 159 | u32 clk_rate = 0; | ||
| 160 | bool needs_vcc = false; | ||
| 161 | |||
| 162 | nop->reset_active_low = true; /* default behaviour */ | ||
| 163 | |||
| 164 | if (dev->of_node) { | ||
| 165 | struct device_node *node = dev->of_node; | ||
| 166 | enum of_gpio_flags flags = 0; | ||
| 167 | |||
| 168 | if (of_property_read_u32(node, "clock-frequency", &clk_rate)) | ||
| 169 | clk_rate = 0; | ||
| 170 | |||
| 171 | needs_vcc = of_property_read_bool(node, "vcc-supply"); | ||
| 172 | nop->gpio_reset = of_get_named_gpio_flags(node, "reset-gpios", | ||
| 173 | 0, &flags); | ||
| 174 | if (nop->gpio_reset == -EPROBE_DEFER) | ||
| 175 | return -EPROBE_DEFER; | ||
| 176 | |||
| 177 | nop->reset_active_low = flags & OF_GPIO_ACTIVE_LOW; | ||
| 178 | |||
| 179 | } else if (pdata) { | ||
| 180 | type = pdata->type; | ||
| 181 | clk_rate = pdata->clk_rate; | ||
| 182 | needs_vcc = pdata->needs_vcc; | ||
| 183 | nop->gpio_reset = pdata->gpio_reset; | ||
| 184 | } else { | ||
| 185 | nop->gpio_reset = -1; | ||
| 186 | } | ||
| 187 | |||
| 157 | nop->phy.otg = devm_kzalloc(dev, sizeof(*nop->phy.otg), | 188 | nop->phy.otg = devm_kzalloc(dev, sizeof(*nop->phy.otg), |
| 158 | GFP_KERNEL); | 189 | GFP_KERNEL); |
| 159 | if (!nop->phy.otg) | 190 | if (!nop->phy.otg) |
| @@ -218,43 +249,14 @@ EXPORT_SYMBOL_GPL(usb_phy_gen_create_phy); | |||
| 218 | static int usb_phy_gen_xceiv_probe(struct platform_device *pdev) | 249 | static int usb_phy_gen_xceiv_probe(struct platform_device *pdev) |
| 219 | { | 250 | { |
| 220 | struct device *dev = &pdev->dev; | 251 | struct device *dev = &pdev->dev; |
| 221 | struct usb_phy_gen_xceiv_platform_data *pdata = | ||
| 222 | dev_get_platdata(&pdev->dev); | ||
| 223 | struct usb_phy_gen_xceiv *nop; | 252 | struct usb_phy_gen_xceiv *nop; |
| 224 | enum usb_phy_type type = USB_PHY_TYPE_USB2; | ||
| 225 | int err; | 253 | int err; |
| 226 | u32 clk_rate = 0; | ||
| 227 | bool needs_vcc = false; | ||
| 228 | 254 | ||
| 229 | nop = devm_kzalloc(dev, sizeof(*nop), GFP_KERNEL); | 255 | nop = devm_kzalloc(dev, sizeof(*nop), GFP_KERNEL); |
| 230 | if (!nop) | 256 | if (!nop) |
| 231 | return -ENOMEM; | 257 | return -ENOMEM; |
| 232 | 258 | ||
| 233 | nop->reset_active_low = true; /* default behaviour */ | 259 | err = usb_phy_gen_create_phy(dev, nop, dev_get_platdata(&pdev->dev)); |
| 234 | |||
| 235 | if (dev->of_node) { | ||
| 236 | struct device_node *node = dev->of_node; | ||
| 237 | enum of_gpio_flags flags; | ||
| 238 | |||
| 239 | if (of_property_read_u32(node, "clock-frequency", &clk_rate)) | ||
| 240 | clk_rate = 0; | ||
| 241 | |||
| 242 | needs_vcc = of_property_read_bool(node, "vcc-supply"); | ||
| 243 | nop->gpio_reset = of_get_named_gpio_flags(node, "reset-gpios", | ||
| 244 | 0, &flags); | ||
| 245 | if (nop->gpio_reset == -EPROBE_DEFER) | ||
| 246 | return -EPROBE_DEFER; | ||
| 247 | |||
| 248 | nop->reset_active_low = flags & OF_GPIO_ACTIVE_LOW; | ||
| 249 | |||
| 250 | } else if (pdata) { | ||
| 251 | type = pdata->type; | ||
| 252 | clk_rate = pdata->clk_rate; | ||
| 253 | needs_vcc = pdata->needs_vcc; | ||
| 254 | nop->gpio_reset = pdata->gpio_reset; | ||
| 255 | } | ||
| 256 | |||
| 257 | err = usb_phy_gen_create_phy(dev, nop, type, clk_rate, needs_vcc); | ||
| 258 | if (err) | 260 | if (err) |
| 259 | return err; | 261 | return err; |
| 260 | 262 | ||
| @@ -271,8 +273,6 @@ static int usb_phy_gen_xceiv_probe(struct platform_device *pdev) | |||
| 271 | platform_set_drvdata(pdev, nop); | 273 | platform_set_drvdata(pdev, nop); |
| 272 | 274 | ||
| 273 | return 0; | 275 | return 0; |
| 274 | |||
| 275 | return err; | ||
| 276 | } | 276 | } |
| 277 | 277 | ||
| 278 | static int usb_phy_gen_xceiv_remove(struct platform_device *pdev) | 278 | static int usb_phy_gen_xceiv_remove(struct platform_device *pdev) |
diff --git a/drivers/usb/phy/phy-generic.h b/drivers/usb/phy/phy-generic.h index d2a220d81734..38a81f307b82 100644 --- a/drivers/usb/phy/phy-generic.h +++ b/drivers/usb/phy/phy-generic.h | |||
| @@ -1,6 +1,8 @@ | |||
| 1 | #ifndef _PHY_GENERIC_H_ | 1 | #ifndef _PHY_GENERIC_H_ |
| 2 | #define _PHY_GENERIC_H_ | 2 | #define _PHY_GENERIC_H_ |
| 3 | 3 | ||
| 4 | #include <linux/usb/usb_phy_gen_xceiv.h> | ||
| 5 | |||
| 4 | struct usb_phy_gen_xceiv { | 6 | struct usb_phy_gen_xceiv { |
| 5 | struct usb_phy phy; | 7 | struct usb_phy phy; |
| 6 | struct device *dev; | 8 | struct device *dev; |
| @@ -14,6 +16,6 @@ int usb_gen_phy_init(struct usb_phy *phy); | |||
| 14 | void usb_gen_phy_shutdown(struct usb_phy *phy); | 16 | void usb_gen_phy_shutdown(struct usb_phy *phy); |
| 15 | 17 | ||
| 16 | int usb_phy_gen_create_phy(struct device *dev, struct usb_phy_gen_xceiv *nop, | 18 | int usb_phy_gen_create_phy(struct device *dev, struct usb_phy_gen_xceiv *nop, |
| 17 | enum usb_phy_type type, u32 clk_rate, bool needs_vcc); | 19 | struct usb_phy_gen_xceiv_platform_data *pdata); |
| 18 | 20 | ||
| 19 | #endif | 21 | #endif |
diff --git a/drivers/usb/phy/phy-mxs-usb.c b/drivers/usb/phy/phy-mxs-usb.c index fdd33b44dbd3..545844b7e796 100644 --- a/drivers/usb/phy/phy-mxs-usb.c +++ b/drivers/usb/phy/phy-mxs-usb.c | |||
| @@ -164,7 +164,7 @@ static int mxs_phy_probe(struct platform_device *pdev) | |||
| 164 | 164 | ||
| 165 | mxs_phy->clk = clk; | 165 | mxs_phy->clk = clk; |
| 166 | 166 | ||
| 167 | platform_set_drvdata(pdev, &mxs_phy->phy); | 167 | platform_set_drvdata(pdev, mxs_phy); |
| 168 | 168 | ||
| 169 | ret = usb_add_phy_dev(&mxs_phy->phy); | 169 | ret = usb_add_phy_dev(&mxs_phy->phy); |
| 170 | if (ret) | 170 | if (ret) |
diff --git a/drivers/usb/phy/phy-rcar-gen2-usb.c b/drivers/usb/phy/phy-rcar-gen2-usb.c index a99a6953f11c..db3ab34cddb4 100644 --- a/drivers/usb/phy/phy-rcar-gen2-usb.c +++ b/drivers/usb/phy/phy-rcar-gen2-usb.c | |||
| @@ -107,10 +107,10 @@ static void __rcar_gen2_usb_phy_init(struct rcar_gen2_usb_phy_priv *priv) | |||
| 107 | clk_prepare_enable(priv->clk); | 107 | clk_prepare_enable(priv->clk); |
| 108 | 108 | ||
| 109 | /* Set USB channels in the USBHS UGCTRL2 register */ | 109 | /* Set USB channels in the USBHS UGCTRL2 register */ |
| 110 | val = ioread32(priv->base); | 110 | val = ioread32(priv->base + USBHS_UGCTRL2_REG); |
| 111 | val &= ~(USBHS_UGCTRL2_USB0_HS | USBHS_UGCTRL2_USB2_SS); | 111 | val &= ~(USBHS_UGCTRL2_USB0_HS | USBHS_UGCTRL2_USB2_SS); |
| 112 | val |= priv->ugctrl2; | 112 | val |= priv->ugctrl2; |
| 113 | iowrite32(val, priv->base); | 113 | iowrite32(val, priv->base + USBHS_UGCTRL2_REG); |
| 114 | } | 114 | } |
| 115 | 115 | ||
| 116 | /* Shutdown USB channels */ | 116 | /* Shutdown USB channels */ |
diff --git a/drivers/usb/serial/ftdi_sio.c b/drivers/usb/serial/ftdi_sio.c index 9ced8937a8f3..fb0d537435eb 100644 --- a/drivers/usb/serial/ftdi_sio.c +++ b/drivers/usb/serial/ftdi_sio.c | |||
| @@ -2123,6 +2123,20 @@ static void ftdi_set_termios(struct tty_struct *tty, | |||
| 2123 | termios->c_cflag |= CRTSCTS; | 2123 | termios->c_cflag |= CRTSCTS; |
| 2124 | } | 2124 | } |
| 2125 | 2125 | ||
| 2126 | /* | ||
| 2127 | * All FTDI UART chips are limited to CS7/8. We won't pretend to | ||
| 2128 | * support CS5/6 and revert the CSIZE setting instead. | ||
| 2129 | */ | ||
| 2130 | if ((C_CSIZE(tty) != CS8) && (C_CSIZE(tty) != CS7)) { | ||
| 2131 | dev_warn(ddev, "requested CSIZE setting not supported\n"); | ||
| 2132 | |||
| 2133 | termios->c_cflag &= ~CSIZE; | ||
| 2134 | if (old_termios) | ||
| 2135 | termios->c_cflag |= old_termios->c_cflag & CSIZE; | ||
| 2136 | else | ||
| 2137 | termios->c_cflag |= CS8; | ||
| 2138 | } | ||
| 2139 | |||
| 2126 | cflag = termios->c_cflag; | 2140 | cflag = termios->c_cflag; |
| 2127 | 2141 | ||
| 2128 | if (!old_termios) | 2142 | if (!old_termios) |
| @@ -2159,19 +2173,16 @@ no_skip: | |||
| 2159 | } else { | 2173 | } else { |
| 2160 | urb_value |= FTDI_SIO_SET_DATA_PARITY_NONE; | 2174 | urb_value |= FTDI_SIO_SET_DATA_PARITY_NONE; |
| 2161 | } | 2175 | } |
| 2162 | if (cflag & CSIZE) { | 2176 | switch (cflag & CSIZE) { |
| 2163 | switch (cflag & CSIZE) { | 2177 | case CS7: |
| 2164 | case CS7: | 2178 | urb_value |= 7; |
| 2165 | urb_value |= 7; | 2179 | dev_dbg(ddev, "Setting CS7\n"); |
| 2166 | dev_dbg(ddev, "Setting CS7\n"); | 2180 | break; |
| 2167 | break; | 2181 | default: |
| 2168 | case CS8: | 2182 | case CS8: |
| 2169 | urb_value |= 8; | 2183 | urb_value |= 8; |
| 2170 | dev_dbg(ddev, "Setting CS8\n"); | 2184 | dev_dbg(ddev, "Setting CS8\n"); |
| 2171 | break; | 2185 | break; |
| 2172 | default: | ||
| 2173 | dev_err(ddev, "CSIZE was set but not CS7-CS8\n"); | ||
| 2174 | } | ||
| 2175 | } | 2186 | } |
| 2176 | 2187 | ||
| 2177 | /* This is needed by the break command since it uses the same command | 2188 | /* This is needed by the break command since it uses the same command |
diff --git a/drivers/usb/serial/generic.c b/drivers/usb/serial/generic.c index 2b01ec8651c2..b63ce023f96f 100644 --- a/drivers/usb/serial/generic.c +++ b/drivers/usb/serial/generic.c | |||
| @@ -173,16 +173,8 @@ retry: | |||
| 173 | clear_bit_unlock(USB_SERIAL_WRITE_BUSY, &port->flags); | 173 | clear_bit_unlock(USB_SERIAL_WRITE_BUSY, &port->flags); |
| 174 | return result; | 174 | return result; |
| 175 | } | 175 | } |
| 176 | /* | ||
| 177 | * Try sending off another urb, unless called from completion handler | ||
| 178 | * (in which case there will be no free urb or no data). | ||
| 179 | */ | ||
| 180 | if (mem_flags != GFP_ATOMIC) | ||
| 181 | goto retry; | ||
| 182 | 176 | ||
| 183 | clear_bit_unlock(USB_SERIAL_WRITE_BUSY, &port->flags); | 177 | goto retry; /* try sending off another urb */ |
| 184 | |||
| 185 | return 0; | ||
| 186 | } | 178 | } |
| 187 | EXPORT_SYMBOL_GPL(usb_serial_generic_write_start); | 179 | EXPORT_SYMBOL_GPL(usb_serial_generic_write_start); |
| 188 | 180 | ||
| @@ -208,7 +200,7 @@ int usb_serial_generic_write(struct tty_struct *tty, | |||
| 208 | return 0; | 200 | return 0; |
| 209 | 201 | ||
| 210 | count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock); | 202 | count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock); |
| 211 | result = usb_serial_generic_write_start(port, GFP_KERNEL); | 203 | result = usb_serial_generic_write_start(port, GFP_ATOMIC); |
| 212 | if (result) | 204 | if (result) |
| 213 | return result; | 205 | return result; |
| 214 | 206 | ||
diff --git a/drivers/usb/serial/mos7840.c b/drivers/usb/serial/mos7840.c index e5bdd987b9e8..a69da83604c0 100644 --- a/drivers/usb/serial/mos7840.c +++ b/drivers/usb/serial/mos7840.c | |||
| @@ -1813,25 +1813,25 @@ static void mos7840_change_port_settings(struct tty_struct *tty, | |||
| 1813 | iflag = tty->termios.c_iflag; | 1813 | iflag = tty->termios.c_iflag; |
| 1814 | 1814 | ||
| 1815 | /* Change the number of bits */ | 1815 | /* Change the number of bits */ |
| 1816 | if (cflag & CSIZE) { | 1816 | switch (cflag & CSIZE) { |
| 1817 | switch (cflag & CSIZE) { | 1817 | case CS5: |
| 1818 | case CS5: | 1818 | lData = LCR_BITS_5; |
| 1819 | lData = LCR_BITS_5; | 1819 | break; |
| 1820 | break; | ||
| 1821 | 1820 | ||
| 1822 | case CS6: | 1821 | case CS6: |
| 1823 | lData = LCR_BITS_6; | 1822 | lData = LCR_BITS_6; |
| 1824 | break; | 1823 | break; |
| 1825 | 1824 | ||
| 1826 | case CS7: | 1825 | case CS7: |
| 1827 | lData = LCR_BITS_7; | 1826 | lData = LCR_BITS_7; |
| 1828 | break; | 1827 | break; |
| 1829 | default: | 1828 | |
| 1830 | case CS8: | 1829 | default: |
| 1831 | lData = LCR_BITS_8; | 1830 | case CS8: |
| 1832 | break; | 1831 | lData = LCR_BITS_8; |
| 1833 | } | 1832 | break; |
| 1834 | } | 1833 | } |
| 1834 | |||
| 1835 | /* Change the Parity bit */ | 1835 | /* Change the Parity bit */ |
| 1836 | if (cflag & PARENB) { | 1836 | if (cflag & PARENB) { |
| 1837 | if (cflag & PARODD) { | 1837 | if (cflag & PARODD) { |
diff --git a/drivers/usb/serial/option.c b/drivers/usb/serial/option.c index c3d94853b4ab..496b7e39d5be 100644 --- a/drivers/usb/serial/option.c +++ b/drivers/usb/serial/option.c | |||
| @@ -85,6 +85,7 @@ static void option_instat_callback(struct urb *urb); | |||
| 85 | #define HUAWEI_PRODUCT_K4505 0x1464 | 85 | #define HUAWEI_PRODUCT_K4505 0x1464 |
| 86 | #define HUAWEI_PRODUCT_K3765 0x1465 | 86 | #define HUAWEI_PRODUCT_K3765 0x1465 |
| 87 | #define HUAWEI_PRODUCT_K4605 0x14C6 | 87 | #define HUAWEI_PRODUCT_K4605 0x14C6 |
| 88 | #define HUAWEI_PRODUCT_E173S6 0x1C07 | ||
| 88 | 89 | ||
| 89 | #define QUANTA_VENDOR_ID 0x0408 | 90 | #define QUANTA_VENDOR_ID 0x0408 |
| 90 | #define QUANTA_PRODUCT_Q101 0xEA02 | 91 | #define QUANTA_PRODUCT_Q101 0xEA02 |
| @@ -572,6 +573,8 @@ static const struct usb_device_id option_ids[] = { | |||
| 572 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0x1c23, USB_CLASS_COMM, 0x02, 0xff) }, | 573 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0x1c23, USB_CLASS_COMM, 0x02, 0xff) }, |
| 573 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E173, 0xff, 0xff, 0xff), | 574 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E173, 0xff, 0xff, 0xff), |
| 574 | .driver_info = (kernel_ulong_t) &net_intf1_blacklist }, | 575 | .driver_info = (kernel_ulong_t) &net_intf1_blacklist }, |
| 576 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E173S6, 0xff, 0xff, 0xff), | ||
| 577 | .driver_info = (kernel_ulong_t) &net_intf1_blacklist }, | ||
| 575 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E1750, 0xff, 0xff, 0xff), | 578 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E1750, 0xff, 0xff, 0xff), |
| 576 | .driver_info = (kernel_ulong_t) &net_intf2_blacklist }, | 579 | .driver_info = (kernel_ulong_t) &net_intf2_blacklist }, |
| 577 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0x1441, USB_CLASS_COMM, 0x02, 0xff) }, | 580 | { USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0x1441, USB_CLASS_COMM, 0x02, 0xff) }, |
| @@ -634,6 +637,10 @@ static const struct usb_device_id option_ids[] = { | |||
| 634 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x6D) }, | 637 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x6D) }, |
| 635 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x6E) }, | 638 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x6E) }, |
| 636 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x6F) }, | 639 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x6F) }, |
| 640 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x72) }, | ||
| 641 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x73) }, | ||
| 642 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x74) }, | ||
| 643 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x75) }, | ||
| 637 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x78) }, | 644 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x78) }, |
| 638 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x79) }, | 645 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x79) }, |
| 639 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x7A) }, | 646 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x01, 0x7A) }, |
| @@ -688,6 +695,10 @@ static const struct usb_device_id option_ids[] = { | |||
| 688 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x6D) }, | 695 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x6D) }, |
| 689 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x6E) }, | 696 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x6E) }, |
| 690 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x6F) }, | 697 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x6F) }, |
| 698 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x72) }, | ||
| 699 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x73) }, | ||
| 700 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x74) }, | ||
| 701 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x75) }, | ||
| 691 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x78) }, | 702 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x78) }, |
| 692 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x79) }, | 703 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x79) }, |
| 693 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x7A) }, | 704 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x02, 0x7A) }, |
| @@ -742,6 +753,10 @@ static const struct usb_device_id option_ids[] = { | |||
| 742 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x6D) }, | 753 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x6D) }, |
| 743 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x6E) }, | 754 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x6E) }, |
| 744 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x6F) }, | 755 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x6F) }, |
| 756 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x72) }, | ||
| 757 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x73) }, | ||
| 758 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x74) }, | ||
| 759 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x75) }, | ||
| 745 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x78) }, | 760 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x78) }, |
| 746 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x79) }, | 761 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x79) }, |
| 747 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x7A) }, | 762 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x03, 0x7A) }, |
| @@ -796,6 +811,10 @@ static const struct usb_device_id option_ids[] = { | |||
| 796 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x6D) }, | 811 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x6D) }, |
| 797 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x6E) }, | 812 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x6E) }, |
| 798 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x6F) }, | 813 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x6F) }, |
| 814 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x72) }, | ||
| 815 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x73) }, | ||
| 816 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x74) }, | ||
| 817 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x75) }, | ||
| 799 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x78) }, | 818 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x78) }, |
| 800 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x79) }, | 819 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x79) }, |
| 801 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x7A) }, | 820 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x04, 0x7A) }, |
| @@ -850,6 +869,10 @@ static const struct usb_device_id option_ids[] = { | |||
| 850 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x6D) }, | 869 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x6D) }, |
| 851 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x6E) }, | 870 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x6E) }, |
| 852 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x6F) }, | 871 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x6F) }, |
| 872 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x72) }, | ||
| 873 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x73) }, | ||
| 874 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x74) }, | ||
| 875 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x75) }, | ||
| 853 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x78) }, | 876 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x78) }, |
| 854 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x79) }, | 877 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x79) }, |
| 855 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x7A) }, | 878 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x05, 0x7A) }, |
| @@ -904,6 +927,10 @@ static const struct usb_device_id option_ids[] = { | |||
| 904 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x6D) }, | 927 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x6D) }, |
| 905 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x6E) }, | 928 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x6E) }, |
| 906 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x6F) }, | 929 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x6F) }, |
| 930 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x72) }, | ||
| 931 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x73) }, | ||
| 932 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x74) }, | ||
| 933 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x75) }, | ||
| 907 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x78) }, | 934 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x78) }, |
| 908 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x79) }, | 935 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x79) }, |
| 909 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x7A) }, | 936 | { USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, 0xff, 0x06, 0x7A) }, |
diff --git a/drivers/usb/serial/pl2303.c b/drivers/usb/serial/pl2303.c index 1e6de4cd079d..1e3318dfa1cb 100644 --- a/drivers/usb/serial/pl2303.c +++ b/drivers/usb/serial/pl2303.c | |||
| @@ -361,23 +361,21 @@ static void pl2303_set_termios(struct tty_struct *tty, | |||
| 361 | 0, 0, buf, 7, 100); | 361 | 0, 0, buf, 7, 100); |
| 362 | dev_dbg(&port->dev, "0xa1:0x21:0:0 %d - %7ph\n", i, buf); | 362 | dev_dbg(&port->dev, "0xa1:0x21:0:0 %d - %7ph\n", i, buf); |
| 363 | 363 | ||
| 364 | if (C_CSIZE(tty)) { | 364 | switch (C_CSIZE(tty)) { |
| 365 | switch (C_CSIZE(tty)) { | 365 | case CS5: |
| 366 | case CS5: | 366 | buf[6] = 5; |
| 367 | buf[6] = 5; | 367 | break; |
| 368 | break; | 368 | case CS6: |
| 369 | case CS6: | 369 | buf[6] = 6; |
| 370 | buf[6] = 6; | 370 | break; |
| 371 | break; | 371 | case CS7: |
| 372 | case CS7: | 372 | buf[6] = 7; |
| 373 | buf[6] = 7; | 373 | break; |
| 374 | break; | 374 | default: |
| 375 | default: | 375 | case CS8: |
| 376 | case CS8: | 376 | buf[6] = 8; |
| 377 | buf[6] = 8; | ||
| 378 | } | ||
| 379 | dev_dbg(&port->dev, "data bits = %d\n", buf[6]); | ||
| 380 | } | 377 | } |
| 378 | dev_dbg(&port->dev, "data bits = %d\n", buf[6]); | ||
| 381 | 379 | ||
| 382 | /* For reference buf[0]:buf[3] baud rate value */ | 380 | /* For reference buf[0]:buf[3] baud rate value */ |
| 383 | pl2303_encode_baudrate(tty, port, &buf[0]); | 381 | pl2303_encode_baudrate(tty, port, &buf[0]); |
diff --git a/drivers/usb/serial/spcp8x5.c b/drivers/usb/serial/spcp8x5.c index 4abac28b5992..5b793c352267 100644 --- a/drivers/usb/serial/spcp8x5.c +++ b/drivers/usb/serial/spcp8x5.c | |||
| @@ -348,22 +348,20 @@ static void spcp8x5_set_termios(struct tty_struct *tty, | |||
| 348 | } | 348 | } |
| 349 | 349 | ||
| 350 | /* Set Data Length : 00:5bit, 01:6bit, 10:7bit, 11:8bit */ | 350 | /* Set Data Length : 00:5bit, 01:6bit, 10:7bit, 11:8bit */ |
| 351 | if (cflag & CSIZE) { | 351 | switch (cflag & CSIZE) { |
| 352 | switch (cflag & CSIZE) { | 352 | case CS5: |
| 353 | case CS5: | 353 | buf[1] |= SET_UART_FORMAT_SIZE_5; |
| 354 | buf[1] |= SET_UART_FORMAT_SIZE_5; | 354 | break; |
| 355 | break; | 355 | case CS6: |
| 356 | case CS6: | 356 | buf[1] |= SET_UART_FORMAT_SIZE_6; |
| 357 | buf[1] |= SET_UART_FORMAT_SIZE_6; | 357 | break; |
| 358 | break; | 358 | case CS7: |
| 359 | case CS7: | 359 | buf[1] |= SET_UART_FORMAT_SIZE_7; |
| 360 | buf[1] |= SET_UART_FORMAT_SIZE_7; | 360 | break; |
| 361 | break; | 361 | default: |
| 362 | default: | 362 | case CS8: |
| 363 | case CS8: | 363 | buf[1] |= SET_UART_FORMAT_SIZE_8; |
| 364 | buf[1] |= SET_UART_FORMAT_SIZE_8; | 364 | break; |
| 365 | break; | ||
| 366 | } | ||
| 367 | } | 365 | } |
| 368 | 366 | ||
| 369 | /* Set Stop bit2 : 0:1bit 1:2bit */ | 367 | /* Set Stop bit2 : 0:1bit 1:2bit */ |
diff --git a/drivers/usb/wusbcore/devconnect.c b/drivers/usb/wusbcore/devconnect.c index e538b72c4e3a..f14e7929ba22 100644 --- a/drivers/usb/wusbcore/devconnect.c +++ b/drivers/usb/wusbcore/devconnect.c | |||
| @@ -97,18 +97,12 @@ static void wusbhc_devconnect_acked_work(struct work_struct *work); | |||
| 97 | 97 | ||
| 98 | static void wusb_dev_free(struct wusb_dev *wusb_dev) | 98 | static void wusb_dev_free(struct wusb_dev *wusb_dev) |
| 99 | { | 99 | { |
| 100 | if (wusb_dev) { | 100 | kfree(wusb_dev); |
| 101 | kfree(wusb_dev->set_gtk_req); | ||
| 102 | usb_free_urb(wusb_dev->set_gtk_urb); | ||
| 103 | kfree(wusb_dev); | ||
| 104 | } | ||
| 105 | } | 101 | } |
| 106 | 102 | ||
| 107 | static struct wusb_dev *wusb_dev_alloc(struct wusbhc *wusbhc) | 103 | static struct wusb_dev *wusb_dev_alloc(struct wusbhc *wusbhc) |
| 108 | { | 104 | { |
| 109 | struct wusb_dev *wusb_dev; | 105 | struct wusb_dev *wusb_dev; |
| 110 | struct urb *urb; | ||
| 111 | struct usb_ctrlrequest *req; | ||
| 112 | 106 | ||
| 113 | wusb_dev = kzalloc(sizeof(*wusb_dev), GFP_KERNEL); | 107 | wusb_dev = kzalloc(sizeof(*wusb_dev), GFP_KERNEL); |
| 114 | if (wusb_dev == NULL) | 108 | if (wusb_dev == NULL) |
| @@ -118,22 +112,6 @@ static struct wusb_dev *wusb_dev_alloc(struct wusbhc *wusbhc) | |||
| 118 | 112 | ||
| 119 | INIT_WORK(&wusb_dev->devconnect_acked_work, wusbhc_devconnect_acked_work); | 113 | INIT_WORK(&wusb_dev->devconnect_acked_work, wusbhc_devconnect_acked_work); |
| 120 | 114 | ||
| 121 | urb = usb_alloc_urb(0, GFP_KERNEL); | ||
| 122 | if (urb == NULL) | ||
| 123 | goto err; | ||
| 124 | wusb_dev->set_gtk_urb = urb; | ||
| 125 | |||
| 126 | req = kmalloc(sizeof(*req), GFP_KERNEL); | ||
| 127 | if (req == NULL) | ||
| 128 | goto err; | ||
| 129 | wusb_dev->set_gtk_req = req; | ||
| 130 | |||
| 131 | req->bRequestType = USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE; | ||
| 132 | req->bRequest = USB_REQ_SET_DESCRIPTOR; | ||
| 133 | req->wValue = cpu_to_le16(USB_DT_KEY << 8 | wusbhc->gtk_index); | ||
| 134 | req->wIndex = 0; | ||
| 135 | req->wLength = cpu_to_le16(wusbhc->gtk.descr.bLength); | ||
| 136 | |||
| 137 | return wusb_dev; | 115 | return wusb_dev; |
| 138 | err: | 116 | err: |
| 139 | wusb_dev_free(wusb_dev); | 117 | wusb_dev_free(wusb_dev); |
| @@ -411,9 +389,6 @@ static void __wusbhc_dev_disconnect(struct wusbhc *wusbhc, | |||
| 411 | /* | 389 | /* |
| 412 | * Refresh the list of keep alives to emit in the MMC | 390 | * Refresh the list of keep alives to emit in the MMC |
| 413 | * | 391 | * |
| 414 | * Some devices don't respond to keep alives unless they've been | ||
| 415 | * authenticated, so skip unauthenticated devices. | ||
| 416 | * | ||
| 417 | * We only publish the first four devices that have a coming timeout | 392 | * We only publish the first four devices that have a coming timeout |
| 418 | * condition. Then when we are done processing those, we go for the | 393 | * condition. Then when we are done processing those, we go for the |
| 419 | * next ones. We ignore the ones that have timed out already (they'll | 394 | * next ones. We ignore the ones that have timed out already (they'll |
| @@ -448,7 +423,7 @@ static void __wusbhc_keep_alive(struct wusbhc *wusbhc) | |||
| 448 | 423 | ||
| 449 | if (wusb_dev == NULL) | 424 | if (wusb_dev == NULL) |
| 450 | continue; | 425 | continue; |
| 451 | if (wusb_dev->usb_dev == NULL || !wusb_dev->usb_dev->authenticated) | 426 | if (wusb_dev->usb_dev == NULL) |
| 452 | continue; | 427 | continue; |
| 453 | 428 | ||
| 454 | if (time_after(jiffies, wusb_dev->entry_ts + tt)) { | 429 | if (time_after(jiffies, wusb_dev->entry_ts + tt)) { |
| @@ -524,11 +499,19 @@ static struct wusb_dev *wusbhc_find_dev_by_addr(struct wusbhc *wusbhc, u8 addr) | |||
| 524 | * | 499 | * |
| 525 | * @wusbhc shall be referenced and unlocked | 500 | * @wusbhc shall be referenced and unlocked |
| 526 | */ | 501 | */ |
| 527 | static void wusbhc_handle_dn_alive(struct wusbhc *wusbhc, struct wusb_dev *wusb_dev) | 502 | static void wusbhc_handle_dn_alive(struct wusbhc *wusbhc, u8 srcaddr) |
| 528 | { | 503 | { |
| 504 | struct wusb_dev *wusb_dev; | ||
| 505 | |||
| 529 | mutex_lock(&wusbhc->mutex); | 506 | mutex_lock(&wusbhc->mutex); |
| 530 | wusb_dev->entry_ts = jiffies; | 507 | wusb_dev = wusbhc_find_dev_by_addr(wusbhc, srcaddr); |
| 531 | __wusbhc_keep_alive(wusbhc); | 508 | if (wusb_dev == NULL) { |
| 509 | dev_dbg(wusbhc->dev, "ignoring DN_Alive from unconnected device %02x\n", | ||
| 510 | srcaddr); | ||
| 511 | } else { | ||
| 512 | wusb_dev->entry_ts = jiffies; | ||
| 513 | __wusbhc_keep_alive(wusbhc); | ||
| 514 | } | ||
| 532 | mutex_unlock(&wusbhc->mutex); | 515 | mutex_unlock(&wusbhc->mutex); |
| 533 | } | 516 | } |
| 534 | 517 | ||
| @@ -582,14 +565,22 @@ static void wusbhc_handle_dn_connect(struct wusbhc *wusbhc, | |||
| 582 | * | 565 | * |
| 583 | * @wusbhc shall be referenced and unlocked | 566 | * @wusbhc shall be referenced and unlocked |
| 584 | */ | 567 | */ |
| 585 | static void wusbhc_handle_dn_disconnect(struct wusbhc *wusbhc, struct wusb_dev *wusb_dev) | 568 | static void wusbhc_handle_dn_disconnect(struct wusbhc *wusbhc, u8 srcaddr) |
| 586 | { | 569 | { |
| 587 | struct device *dev = wusbhc->dev; | 570 | struct device *dev = wusbhc->dev; |
| 588 | 571 | struct wusb_dev *wusb_dev; | |
| 589 | dev_info(dev, "DN DISCONNECT: device 0x%02x going down\n", wusb_dev->addr); | ||
| 590 | 572 | ||
| 591 | mutex_lock(&wusbhc->mutex); | 573 | mutex_lock(&wusbhc->mutex); |
| 592 | __wusbhc_dev_disconnect(wusbhc, wusb_port_by_idx(wusbhc, wusb_dev->port_idx)); | 574 | wusb_dev = wusbhc_find_dev_by_addr(wusbhc, srcaddr); |
| 575 | if (wusb_dev == NULL) { | ||
| 576 | dev_dbg(dev, "ignoring DN DISCONNECT from unconnected device %02x\n", | ||
| 577 | srcaddr); | ||
| 578 | } else { | ||
| 579 | dev_info(dev, "DN DISCONNECT: device 0x%02x going down\n", | ||
| 580 | wusb_dev->addr); | ||
| 581 | __wusbhc_dev_disconnect(wusbhc, wusb_port_by_idx(wusbhc, | ||
| 582 | wusb_dev->port_idx)); | ||
| 583 | } | ||
| 593 | mutex_unlock(&wusbhc->mutex); | 584 | mutex_unlock(&wusbhc->mutex); |
| 594 | } | 585 | } |
| 595 | 586 | ||
| @@ -611,30 +602,21 @@ void wusbhc_handle_dn(struct wusbhc *wusbhc, u8 srcaddr, | |||
| 611 | struct wusb_dn_hdr *dn_hdr, size_t size) | 602 | struct wusb_dn_hdr *dn_hdr, size_t size) |
| 612 | { | 603 | { |
| 613 | struct device *dev = wusbhc->dev; | 604 | struct device *dev = wusbhc->dev; |
| 614 | struct wusb_dev *wusb_dev; | ||
| 615 | 605 | ||
| 616 | if (size < sizeof(struct wusb_dn_hdr)) { | 606 | if (size < sizeof(struct wusb_dn_hdr)) { |
| 617 | dev_err(dev, "DN data shorter than DN header (%d < %d)\n", | 607 | dev_err(dev, "DN data shorter than DN header (%d < %d)\n", |
| 618 | (int)size, (int)sizeof(struct wusb_dn_hdr)); | 608 | (int)size, (int)sizeof(struct wusb_dn_hdr)); |
| 619 | return; | 609 | return; |
| 620 | } | 610 | } |
| 621 | |||
| 622 | wusb_dev = wusbhc_find_dev_by_addr(wusbhc, srcaddr); | ||
| 623 | if (wusb_dev == NULL && dn_hdr->bType != WUSB_DN_CONNECT) { | ||
| 624 | dev_dbg(dev, "ignoring DN %d from unconnected device %02x\n", | ||
| 625 | dn_hdr->bType, srcaddr); | ||
| 626 | return; | ||
| 627 | } | ||
| 628 | |||
| 629 | switch (dn_hdr->bType) { | 611 | switch (dn_hdr->bType) { |
| 630 | case WUSB_DN_CONNECT: | 612 | case WUSB_DN_CONNECT: |
| 631 | wusbhc_handle_dn_connect(wusbhc, dn_hdr, size); | 613 | wusbhc_handle_dn_connect(wusbhc, dn_hdr, size); |
| 632 | break; | 614 | break; |
| 633 | case WUSB_DN_ALIVE: | 615 | case WUSB_DN_ALIVE: |
| 634 | wusbhc_handle_dn_alive(wusbhc, wusb_dev); | 616 | wusbhc_handle_dn_alive(wusbhc, srcaddr); |
| 635 | break; | 617 | break; |
| 636 | case WUSB_DN_DISCONNECT: | 618 | case WUSB_DN_DISCONNECT: |
| 637 | wusbhc_handle_dn_disconnect(wusbhc, wusb_dev); | 619 | wusbhc_handle_dn_disconnect(wusbhc, srcaddr); |
| 638 | break; | 620 | break; |
| 639 | case WUSB_DN_MASAVAILCHANGED: | 621 | case WUSB_DN_MASAVAILCHANGED: |
| 640 | case WUSB_DN_RWAKE: | 622 | case WUSB_DN_RWAKE: |
diff --git a/drivers/usb/wusbcore/security.c b/drivers/usb/wusbcore/security.c index dd88441c8f78..4c40d0dbf53d 100644 --- a/drivers/usb/wusbcore/security.c +++ b/drivers/usb/wusbcore/security.c | |||
| @@ -29,19 +29,16 @@ | |||
| 29 | #include <linux/export.h> | 29 | #include <linux/export.h> |
| 30 | #include "wusbhc.h" | 30 | #include "wusbhc.h" |
| 31 | 31 | ||
| 32 | static void wusbhc_set_gtk_callback(struct urb *urb); | 32 | static void wusbhc_gtk_rekey_work(struct work_struct *work); |
| 33 | static void wusbhc_gtk_rekey_done_work(struct work_struct *work); | ||
| 34 | 33 | ||
| 35 | int wusbhc_sec_create(struct wusbhc *wusbhc) | 34 | int wusbhc_sec_create(struct wusbhc *wusbhc) |
| 36 | { | 35 | { |
| 37 | wusbhc->gtk.descr.bLength = sizeof(wusbhc->gtk.descr) + sizeof(wusbhc->gtk.data); | 36 | wusbhc->gtk.descr.bLength = sizeof(wusbhc->gtk.descr) + sizeof(wusbhc->gtk.data); |
| 38 | wusbhc->gtk.descr.bDescriptorType = USB_DT_KEY; | 37 | wusbhc->gtk.descr.bDescriptorType = USB_DT_KEY; |
| 39 | wusbhc->gtk.descr.bReserved = 0; | 38 | wusbhc->gtk.descr.bReserved = 0; |
| 39 | wusbhc->gtk_index = 0; | ||
| 40 | 40 | ||
| 41 | wusbhc->gtk_index = wusb_key_index(0, WUSB_KEY_INDEX_TYPE_GTK, | 41 | INIT_WORK(&wusbhc->gtk_rekey_work, wusbhc_gtk_rekey_work); |
| 42 | WUSB_KEY_INDEX_ORIGINATOR_HOST); | ||
| 43 | |||
| 44 | INIT_WORK(&wusbhc->gtk_rekey_done_work, wusbhc_gtk_rekey_done_work); | ||
| 45 | 42 | ||
| 46 | return 0; | 43 | return 0; |
| 47 | } | 44 | } |
| @@ -113,7 +110,7 @@ int wusbhc_sec_start(struct wusbhc *wusbhc) | |||
| 113 | wusbhc_generate_gtk(wusbhc); | 110 | wusbhc_generate_gtk(wusbhc); |
| 114 | 111 | ||
| 115 | result = wusbhc->set_gtk(wusbhc, wusbhc->gtk_tkid, | 112 | result = wusbhc->set_gtk(wusbhc, wusbhc->gtk_tkid, |
| 116 | &wusbhc->gtk.descr.bKeyData, key_size); | 113 | &wusbhc->gtk.descr.bKeyData, key_size); |
| 117 | if (result < 0) | 114 | if (result < 0) |
| 118 | dev_err(wusbhc->dev, "cannot set GTK for the host: %d\n", | 115 | dev_err(wusbhc->dev, "cannot set GTK for the host: %d\n", |
| 119 | result); | 116 | result); |
| @@ -129,7 +126,7 @@ int wusbhc_sec_start(struct wusbhc *wusbhc) | |||
| 129 | */ | 126 | */ |
| 130 | void wusbhc_sec_stop(struct wusbhc *wusbhc) | 127 | void wusbhc_sec_stop(struct wusbhc *wusbhc) |
| 131 | { | 128 | { |
| 132 | cancel_work_sync(&wusbhc->gtk_rekey_done_work); | 129 | cancel_work_sync(&wusbhc->gtk_rekey_work); |
| 133 | } | 130 | } |
| 134 | 131 | ||
| 135 | 132 | ||
| @@ -185,12 +182,14 @@ static int wusb_dev_set_encryption(struct usb_device *usb_dev, int value) | |||
| 185 | static int wusb_dev_set_gtk(struct wusbhc *wusbhc, struct wusb_dev *wusb_dev) | 182 | static int wusb_dev_set_gtk(struct wusbhc *wusbhc, struct wusb_dev *wusb_dev) |
| 186 | { | 183 | { |
| 187 | struct usb_device *usb_dev = wusb_dev->usb_dev; | 184 | struct usb_device *usb_dev = wusb_dev->usb_dev; |
| 185 | u8 key_index = wusb_key_index(wusbhc->gtk_index, | ||
| 186 | WUSB_KEY_INDEX_TYPE_GTK, WUSB_KEY_INDEX_ORIGINATOR_HOST); | ||
| 188 | 187 | ||
| 189 | return usb_control_msg( | 188 | return usb_control_msg( |
| 190 | usb_dev, usb_sndctrlpipe(usb_dev, 0), | 189 | usb_dev, usb_sndctrlpipe(usb_dev, 0), |
| 191 | USB_REQ_SET_DESCRIPTOR, | 190 | USB_REQ_SET_DESCRIPTOR, |
| 192 | USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE, | 191 | USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE, |
| 193 | USB_DT_KEY << 8 | wusbhc->gtk_index, 0, | 192 | USB_DT_KEY << 8 | key_index, 0, |
| 194 | &wusbhc->gtk.descr, wusbhc->gtk.descr.bLength, | 193 | &wusbhc->gtk.descr, wusbhc->gtk.descr.bLength, |
| 195 | 1000); | 194 | 1000); |
| 196 | } | 195 | } |
| @@ -520,24 +519,55 @@ error_kzalloc: | |||
| 520 | * Once all connected and authenticated devices have received the new | 519 | * Once all connected and authenticated devices have received the new |
| 521 | * GTK, switch the host to using it. | 520 | * GTK, switch the host to using it. |
| 522 | */ | 521 | */ |
| 523 | static void wusbhc_gtk_rekey_done_work(struct work_struct *work) | 522 | static void wusbhc_gtk_rekey_work(struct work_struct *work) |
| 524 | { | 523 | { |
| 525 | struct wusbhc *wusbhc = container_of(work, struct wusbhc, gtk_rekey_done_work); | 524 | struct wusbhc *wusbhc = container_of(work, |
| 525 | struct wusbhc, gtk_rekey_work); | ||
| 526 | size_t key_size = sizeof(wusbhc->gtk.data); | 526 | size_t key_size = sizeof(wusbhc->gtk.data); |
| 527 | int port_idx; | ||
| 528 | struct wusb_dev *wusb_dev, *wusb_dev_next; | ||
| 529 | LIST_HEAD(rekey_list); | ||
| 527 | 530 | ||
| 528 | mutex_lock(&wusbhc->mutex); | 531 | mutex_lock(&wusbhc->mutex); |
| 532 | /* generate the new key */ | ||
| 533 | wusbhc_generate_gtk(wusbhc); | ||
| 534 | /* roll the gtk index. */ | ||
| 535 | wusbhc->gtk_index = (wusbhc->gtk_index + 1) % (WUSB_KEY_INDEX_MAX + 1); | ||
| 536 | /* | ||
| 537 | * Save all connected devices on a list while holding wusbhc->mutex and | ||
| 538 | * take a reference to each one. Then submit the set key request to | ||
| 539 | * them after releasing the lock in order to avoid a deadlock. | ||
| 540 | */ | ||
| 541 | for (port_idx = 0; port_idx < wusbhc->ports_max; port_idx++) { | ||
| 542 | wusb_dev = wusbhc->port[port_idx].wusb_dev; | ||
| 543 | if (!wusb_dev || !wusb_dev->usb_dev | ||
| 544 | || !wusb_dev->usb_dev->authenticated) | ||
| 545 | continue; | ||
| 529 | 546 | ||
| 530 | if (--wusbhc->pending_set_gtks == 0) | 547 | wusb_dev_get(wusb_dev); |
| 531 | wusbhc->set_gtk(wusbhc, wusbhc->gtk_tkid, &wusbhc->gtk.descr.bKeyData, key_size); | 548 | list_add_tail(&wusb_dev->rekey_node, &rekey_list); |
| 532 | 549 | } | |
| 533 | mutex_unlock(&wusbhc->mutex); | 550 | mutex_unlock(&wusbhc->mutex); |
| 534 | } | ||
| 535 | 551 | ||
| 536 | static void wusbhc_set_gtk_callback(struct urb *urb) | 552 | /* Submit the rekey requests without holding wusbhc->mutex. */ |
| 537 | { | 553 | list_for_each_entry_safe(wusb_dev, wusb_dev_next, &rekey_list, |
| 538 | struct wusbhc *wusbhc = urb->context; | 554 | rekey_node) { |
| 555 | list_del_init(&wusb_dev->rekey_node); | ||
| 556 | dev_dbg(&wusb_dev->usb_dev->dev, "%s: rekey device at port %d\n", | ||
| 557 | __func__, wusb_dev->port_idx); | ||
| 558 | |||
| 559 | if (wusb_dev_set_gtk(wusbhc, wusb_dev) < 0) { | ||
| 560 | dev_err(&wusb_dev->usb_dev->dev, "%s: rekey device at port %d failed\n", | ||
| 561 | __func__, wusb_dev->port_idx); | ||
| 562 | } | ||
| 563 | wusb_dev_put(wusb_dev); | ||
| 564 | } | ||
| 539 | 565 | ||
| 540 | queue_work(wusbd, &wusbhc->gtk_rekey_done_work); | 566 | /* Switch the host controller to use the new GTK. */ |
| 567 | mutex_lock(&wusbhc->mutex); | ||
| 568 | wusbhc->set_gtk(wusbhc, wusbhc->gtk_tkid, | ||
| 569 | &wusbhc->gtk.descr.bKeyData, key_size); | ||
| 570 | mutex_unlock(&wusbhc->mutex); | ||
| 541 | } | 571 | } |
| 542 | 572 | ||
| 543 | /** | 573 | /** |
| @@ -553,26 +583,12 @@ static void wusbhc_set_gtk_callback(struct urb *urb) | |||
| 553 | */ | 583 | */ |
| 554 | void wusbhc_gtk_rekey(struct wusbhc *wusbhc) | 584 | void wusbhc_gtk_rekey(struct wusbhc *wusbhc) |
| 555 | { | 585 | { |
| 556 | static const size_t key_size = sizeof(wusbhc->gtk.data); | 586 | /* |
| 557 | int p; | 587 | * We need to submit a URB to the downstream WUSB devices in order to |
| 558 | 588 | * change the group key. This can't be done while holding the | |
| 559 | wusbhc_generate_gtk(wusbhc); | 589 | * wusbhc->mutex since that is also taken in the urb_enqueue routine |
| 560 | 590 | * and will cause a deadlock. Instead, queue a work item to do | |
| 561 | for (p = 0; p < wusbhc->ports_max; p++) { | 591 | * it when the lock is not held |
| 562 | struct wusb_dev *wusb_dev; | 592 | */ |
| 563 | 593 | queue_work(wusbd, &wusbhc->gtk_rekey_work); | |
| 564 | wusb_dev = wusbhc->port[p].wusb_dev; | ||
| 565 | if (!wusb_dev || !wusb_dev->usb_dev || !wusb_dev->usb_dev->authenticated) | ||
| 566 | continue; | ||
| 567 | |||
| 568 | usb_fill_control_urb(wusb_dev->set_gtk_urb, wusb_dev->usb_dev, | ||
| 569 | usb_sndctrlpipe(wusb_dev->usb_dev, 0), | ||
| 570 | (void *)wusb_dev->set_gtk_req, | ||
| 571 | &wusbhc->gtk.descr, wusbhc->gtk.descr.bLength, | ||
| 572 | wusbhc_set_gtk_callback, wusbhc); | ||
| 573 | if (usb_submit_urb(wusb_dev->set_gtk_urb, GFP_KERNEL) == 0) | ||
| 574 | wusbhc->pending_set_gtks++; | ||
| 575 | } | ||
| 576 | if (wusbhc->pending_set_gtks == 0) | ||
| 577 | wusbhc->set_gtk(wusbhc, wusbhc->gtk_tkid, &wusbhc->gtk.descr.bKeyData, key_size); | ||
| 578 | } | 594 | } |
diff --git a/drivers/usb/wusbcore/wusbhc.h b/drivers/usb/wusbcore/wusbhc.h index 711b1952b114..6bd3b819a6b5 100644 --- a/drivers/usb/wusbcore/wusbhc.h +++ b/drivers/usb/wusbcore/wusbhc.h | |||
| @@ -97,6 +97,7 @@ struct wusb_dev { | |||
| 97 | struct kref refcnt; | 97 | struct kref refcnt; |
| 98 | struct wusbhc *wusbhc; | 98 | struct wusbhc *wusbhc; |
| 99 | struct list_head cack_node; /* Connect-Ack list */ | 99 | struct list_head cack_node; /* Connect-Ack list */ |
| 100 | struct list_head rekey_node; /* GTK rekey list */ | ||
| 100 | u8 port_idx; | 101 | u8 port_idx; |
| 101 | u8 addr; | 102 | u8 addr; |
| 102 | u8 beacon_type:4; | 103 | u8 beacon_type:4; |
| @@ -107,8 +108,6 @@ struct wusb_dev { | |||
| 107 | struct usb_wireless_cap_descriptor *wusb_cap_descr; | 108 | struct usb_wireless_cap_descriptor *wusb_cap_descr; |
| 108 | struct uwb_mas_bm availability; | 109 | struct uwb_mas_bm availability; |
| 109 | struct work_struct devconnect_acked_work; | 110 | struct work_struct devconnect_acked_work; |
| 110 | struct urb *set_gtk_urb; | ||
| 111 | struct usb_ctrlrequest *set_gtk_req; | ||
| 112 | struct usb_device *usb_dev; | 111 | struct usb_device *usb_dev; |
| 113 | }; | 112 | }; |
| 114 | 113 | ||
| @@ -296,8 +295,7 @@ struct wusbhc { | |||
| 296 | } __attribute__((packed)) gtk; | 295 | } __attribute__((packed)) gtk; |
| 297 | u8 gtk_index; | 296 | u8 gtk_index; |
| 298 | u32 gtk_tkid; | 297 | u32 gtk_tkid; |
| 299 | struct work_struct gtk_rekey_done_work; | 298 | struct work_struct gtk_rekey_work; |
| 300 | int pending_set_gtks; | ||
| 301 | 299 | ||
| 302 | struct usb_encryption_descriptor *ccm1_etd; | 300 | struct usb_encryption_descriptor *ccm1_etd; |
| 303 | }; | 301 | }; |
diff --git a/drivers/video/atmel_lcdfb.c b/drivers/video/atmel_lcdfb.c index 8521051cf946..cd961622f9c1 100644 --- a/drivers/video/atmel_lcdfb.c +++ b/drivers/video/atmel_lcdfb.c | |||
| @@ -131,6 +131,7 @@ static const struct platform_device_id atmel_lcdfb_devtypes[] = { | |||
| 131 | /* terminator */ | 131 | /* terminator */ |
| 132 | } | 132 | } |
| 133 | }; | 133 | }; |
| 134 | MODULE_DEVICE_TABLE(platform, atmel_lcdfb_devtypes); | ||
| 134 | 135 | ||
| 135 | static struct atmel_lcdfb_config * | 136 | static struct atmel_lcdfb_config * |
| 136 | atmel_lcdfb_get_config(struct platform_device *pdev) | 137 | atmel_lcdfb_get_config(struct platform_device *pdev) |
diff --git a/drivers/video/kyro/fbdev.c b/drivers/video/kyro/fbdev.c index 50c857477e4f..65041e15fd59 100644 --- a/drivers/video/kyro/fbdev.c +++ b/drivers/video/kyro/fbdev.c | |||
| @@ -624,15 +624,15 @@ static int kyrofb_ioctl(struct fb_info *info, | |||
| 624 | return -EINVAL; | 624 | return -EINVAL; |
| 625 | } | 625 | } |
| 626 | case KYRO_IOCTL_UVSTRIDE: | 626 | case KYRO_IOCTL_UVSTRIDE: |
| 627 | if (copy_to_user(argp, &deviceInfo.ulOverlayUVStride, sizeof(unsigned long))) | 627 | if (copy_to_user(argp, &deviceInfo.ulOverlayUVStride, sizeof(deviceInfo.ulOverlayUVStride))) |
| 628 | return -EFAULT; | 628 | return -EFAULT; |
| 629 | break; | 629 | break; |
| 630 | case KYRO_IOCTL_STRIDE: | 630 | case KYRO_IOCTL_STRIDE: |
| 631 | if (copy_to_user(argp, &deviceInfo.ulOverlayStride, sizeof(unsigned long))) | 631 | if (copy_to_user(argp, &deviceInfo.ulOverlayStride, sizeof(deviceInfo.ulOverlayStride))) |
| 632 | return -EFAULT; | 632 | return -EFAULT; |
| 633 | break; | 633 | break; |
| 634 | case KYRO_IOCTL_OVERLAY_OFFSET: | 634 | case KYRO_IOCTL_OVERLAY_OFFSET: |
| 635 | if (copy_to_user(argp, &deviceInfo.ulOverlayOffset, sizeof(unsigned long))) | 635 | if (copy_to_user(argp, &deviceInfo.ulOverlayOffset, sizeof(deviceInfo.ulOverlayOffset))) |
| 636 | return -EFAULT; | 636 | return -EFAULT; |
| 637 | break; | 637 | break; |
| 638 | } | 638 | } |
diff --git a/drivers/video/offb.c b/drivers/video/offb.c index 9dbea2223401..7d44d669d5b6 100644 --- a/drivers/video/offb.c +++ b/drivers/video/offb.c | |||
| @@ -91,6 +91,15 @@ extern boot_infos_t *boot_infos; | |||
| 91 | #define AVIVO_DC_LUTB_WHITE_OFFSET_GREEN 0x6cd4 | 91 | #define AVIVO_DC_LUTB_WHITE_OFFSET_GREEN 0x6cd4 |
| 92 | #define AVIVO_DC_LUTB_WHITE_OFFSET_RED 0x6cd8 | 92 | #define AVIVO_DC_LUTB_WHITE_OFFSET_RED 0x6cd8 |
| 93 | 93 | ||
| 94 | #define FB_RIGHT_POS(p, bpp) (fb_be_math(p) ? 0 : (32 - (bpp))) | ||
| 95 | |||
| 96 | static inline u32 offb_cmap_byteswap(struct fb_info *info, u32 value) | ||
| 97 | { | ||
| 98 | u32 bpp = info->var.bits_per_pixel; | ||
| 99 | |||
| 100 | return cpu_to_be32(value) >> FB_RIGHT_POS(info, bpp); | ||
| 101 | } | ||
| 102 | |||
| 94 | /* | 103 | /* |
| 95 | * Set a single color register. The values supplied are already | 104 | * Set a single color register. The values supplied are already |
| 96 | * rounded down to the hardware's capabilities (according to the | 105 | * rounded down to the hardware's capabilities (according to the |
| @@ -120,7 +129,7 @@ static int offb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, | |||
| 120 | mask <<= info->var.transp.offset; | 129 | mask <<= info->var.transp.offset; |
| 121 | value |= mask; | 130 | value |= mask; |
| 122 | } | 131 | } |
| 123 | pal[regno] = value; | 132 | pal[regno] = offb_cmap_byteswap(info, value); |
| 124 | return 0; | 133 | return 0; |
| 125 | } | 134 | } |
| 126 | 135 | ||
| @@ -301,7 +310,7 @@ static struct fb_ops offb_ops = { | |||
| 301 | static void __iomem *offb_map_reg(struct device_node *np, int index, | 310 | static void __iomem *offb_map_reg(struct device_node *np, int index, |
| 302 | unsigned long offset, unsigned long size) | 311 | unsigned long offset, unsigned long size) |
| 303 | { | 312 | { |
| 304 | const u32 *addrp; | 313 | const __be32 *addrp; |
| 305 | u64 asize, taddr; | 314 | u64 asize, taddr; |
| 306 | unsigned int flags; | 315 | unsigned int flags; |
| 307 | 316 | ||
| @@ -369,7 +378,11 @@ static void offb_init_palette_hacks(struct fb_info *info, struct device_node *dp | |||
| 369 | } | 378 | } |
| 370 | of_node_put(pciparent); | 379 | of_node_put(pciparent); |
| 371 | } else if (dp && of_device_is_compatible(dp, "qemu,std-vga")) { | 380 | } else if (dp && of_device_is_compatible(dp, "qemu,std-vga")) { |
| 372 | const u32 io_of_addr[3] = { 0x01000000, 0x0, 0x0 }; | 381 | #ifdef __BIG_ENDIAN |
| 382 | const __be32 io_of_addr[3] = { 0x01000000, 0x0, 0x0 }; | ||
| 383 | #else | ||
| 384 | const __be32 io_of_addr[3] = { 0x00000001, 0x0, 0x0 }; | ||
| 385 | #endif | ||
| 373 | u64 io_addr = of_translate_address(dp, io_of_addr); | 386 | u64 io_addr = of_translate_address(dp, io_of_addr); |
| 374 | if (io_addr != OF_BAD_ADDR) { | 387 | if (io_addr != OF_BAD_ADDR) { |
| 375 | par->cmap_adr = ioremap(io_addr + 0x3c8, 2); | 388 | par->cmap_adr = ioremap(io_addr + 0x3c8, 2); |
| @@ -535,7 +548,7 @@ static void __init offb_init_nodriver(struct device_node *dp, int no_real_node) | |||
| 535 | unsigned int flags, rsize, addr_prop = 0; | 548 | unsigned int flags, rsize, addr_prop = 0; |
| 536 | unsigned long max_size = 0; | 549 | unsigned long max_size = 0; |
| 537 | u64 rstart, address = OF_BAD_ADDR; | 550 | u64 rstart, address = OF_BAD_ADDR; |
| 538 | const u32 *pp, *addrp, *up; | 551 | const __be32 *pp, *addrp, *up; |
| 539 | u64 asize; | 552 | u64 asize; |
| 540 | int foreign_endian = 0; | 553 | int foreign_endian = 0; |
| 541 | 554 | ||
| @@ -551,25 +564,25 @@ static void __init offb_init_nodriver(struct device_node *dp, int no_real_node) | |||
| 551 | if (pp == NULL) | 564 | if (pp == NULL) |
| 552 | pp = of_get_property(dp, "depth", &len); | 565 | pp = of_get_property(dp, "depth", &len); |
| 553 | if (pp && len == sizeof(u32)) | 566 | if (pp && len == sizeof(u32)) |
| 554 | depth = *pp; | 567 | depth = be32_to_cpup(pp); |
| 555 | 568 | ||
| 556 | pp = of_get_property(dp, "linux,bootx-width", &len); | 569 | pp = of_get_property(dp, "linux,bootx-width", &len); |
| 557 | if (pp == NULL) | 570 | if (pp == NULL) |
| 558 | pp = of_get_property(dp, "width", &len); | 571 | pp = of_get_property(dp, "width", &len); |
| 559 | if (pp && len == sizeof(u32)) | 572 | if (pp && len == sizeof(u32)) |
| 560 | width = *pp; | 573 | width = be32_to_cpup(pp); |
| 561 | 574 | ||
| 562 | pp = of_get_property(dp, "linux,bootx-height", &len); | 575 | pp = of_get_property(dp, "linux,bootx-height", &len); |
| 563 | if (pp == NULL) | 576 | if (pp == NULL) |
| 564 | pp = of_get_property(dp, "height", &len); | 577 | pp = of_get_property(dp, "height", &len); |
| 565 | if (pp && len == sizeof(u32)) | 578 | if (pp && len == sizeof(u32)) |
| 566 | height = *pp; | 579 | height = be32_to_cpup(pp); |
| 567 | 580 | ||
| 568 | pp = of_get_property(dp, "linux,bootx-linebytes", &len); | 581 | pp = of_get_property(dp, "linux,bootx-linebytes", &len); |
| 569 | if (pp == NULL) | 582 | if (pp == NULL) |
| 570 | pp = of_get_property(dp, "linebytes", &len); | 583 | pp = of_get_property(dp, "linebytes", &len); |
| 571 | if (pp && len == sizeof(u32) && (*pp != 0xffffffffu)) | 584 | if (pp && len == sizeof(u32) && (*pp != 0xffffffffu)) |
| 572 | pitch = *pp; | 585 | pitch = be32_to_cpup(pp); |
| 573 | else | 586 | else |
| 574 | pitch = width * ((depth + 7) / 8); | 587 | pitch = width * ((depth + 7) / 8); |
| 575 | 588 | ||
diff --git a/drivers/video/omap2/displays-new/panel-sony-acx565akm.c b/drivers/video/omap2/displays-new/panel-sony-acx565akm.c index e6d56f714ae4..d94f35dbd536 100644 --- a/drivers/video/omap2/displays-new/panel-sony-acx565akm.c +++ b/drivers/video/omap2/displays-new/panel-sony-acx565akm.c | |||
| @@ -526,6 +526,8 @@ static int acx565akm_panel_power_on(struct omap_dss_device *dssdev) | |||
| 526 | struct omap_dss_device *in = ddata->in; | 526 | struct omap_dss_device *in = ddata->in; |
| 527 | int r; | 527 | int r; |
| 528 | 528 | ||
| 529 | mutex_lock(&ddata->mutex); | ||
| 530 | |||
| 529 | dev_dbg(&ddata->spi->dev, "%s\n", __func__); | 531 | dev_dbg(&ddata->spi->dev, "%s\n", __func__); |
| 530 | 532 | ||
| 531 | in->ops.sdi->set_timings(in, &ddata->videomode); | 533 | in->ops.sdi->set_timings(in, &ddata->videomode); |
| @@ -614,10 +616,7 @@ static int acx565akm_enable(struct omap_dss_device *dssdev) | |||
| 614 | if (omapdss_device_is_enabled(dssdev)) | 616 | if (omapdss_device_is_enabled(dssdev)) |
| 615 | return 0; | 617 | return 0; |
| 616 | 618 | ||
| 617 | mutex_lock(&ddata->mutex); | ||
| 618 | r = acx565akm_panel_power_on(dssdev); | 619 | r = acx565akm_panel_power_on(dssdev); |
| 619 | mutex_unlock(&ddata->mutex); | ||
| 620 | |||
| 621 | if (r) | 620 | if (r) |
| 622 | return r; | 621 | return r; |
| 623 | 622 | ||
diff --git a/drivers/video/sh_mobile_meram.c b/drivers/video/sh_mobile_meram.c index e0f098562a74..a297de5cc859 100644 --- a/drivers/video/sh_mobile_meram.c +++ b/drivers/video/sh_mobile_meram.c | |||
| @@ -569,6 +569,7 @@ EXPORT_SYMBOL_GPL(sh_mobile_meram_cache_update); | |||
| 569 | * Power management | 569 | * Power management |
| 570 | */ | 570 | */ |
| 571 | 571 | ||
| 572 | #if defined(CONFIG_PM_SLEEP) || defined(CONFIG_PM_RUNTIME) | ||
| 572 | static int sh_mobile_meram_suspend(struct device *dev) | 573 | static int sh_mobile_meram_suspend(struct device *dev) |
| 573 | { | 574 | { |
| 574 | struct platform_device *pdev = to_platform_device(dev); | 575 | struct platform_device *pdev = to_platform_device(dev); |
| @@ -611,6 +612,7 @@ static int sh_mobile_meram_resume(struct device *dev) | |||
| 611 | meram_write_reg(priv->base, common_regs[i], priv->regs[i]); | 612 | meram_write_reg(priv->base, common_regs[i], priv->regs[i]); |
| 612 | return 0; | 613 | return 0; |
| 613 | } | 614 | } |
| 615 | #endif /* CONFIG_PM_SLEEP || CONFIG_PM_RUNTIME */ | ||
| 614 | 616 | ||
| 615 | static UNIVERSAL_DEV_PM_OPS(sh_mobile_meram_dev_pm_ops, | 617 | static UNIVERSAL_DEV_PM_OPS(sh_mobile_meram_dev_pm_ops, |
| 616 | sh_mobile_meram_suspend, | 618 | sh_mobile_meram_suspend, |
diff --git a/drivers/video/vt8500lcdfb.c b/drivers/video/vt8500lcdfb.c index b30e5a439d1f..a8f2b280f796 100644 --- a/drivers/video/vt8500lcdfb.c +++ b/drivers/video/vt8500lcdfb.c | |||
| @@ -293,8 +293,7 @@ static int vt8500lcd_probe(struct platform_device *pdev) | |||
| 293 | + sizeof(u32) * 16, GFP_KERNEL); | 293 | + sizeof(u32) * 16, GFP_KERNEL); |
| 294 | if (!fbi) { | 294 | if (!fbi) { |
| 295 | dev_err(&pdev->dev, "Failed to initialize framebuffer device\n"); | 295 | dev_err(&pdev->dev, "Failed to initialize framebuffer device\n"); |
| 296 | ret = -ENOMEM; | 296 | return -ENOMEM; |
| 297 | goto failed; | ||
| 298 | } | 297 | } |
| 299 | 298 | ||
| 300 | strcpy(fbi->fb.fix.id, "VT8500 LCD"); | 299 | strcpy(fbi->fb.fix.id, "VT8500 LCD"); |
| @@ -327,15 +326,13 @@ static int vt8500lcd_probe(struct platform_device *pdev) | |||
| 327 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 326 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 328 | if (res == NULL) { | 327 | if (res == NULL) { |
| 329 | dev_err(&pdev->dev, "no I/O memory resource defined\n"); | 328 | dev_err(&pdev->dev, "no I/O memory resource defined\n"); |
| 330 | ret = -ENODEV; | 329 | return -ENODEV; |
| 331 | goto failed_fbi; | ||
| 332 | } | 330 | } |
| 333 | 331 | ||
| 334 | res = request_mem_region(res->start, resource_size(res), "vt8500lcd"); | 332 | res = request_mem_region(res->start, resource_size(res), "vt8500lcd"); |
| 335 | if (res == NULL) { | 333 | if (res == NULL) { |
| 336 | dev_err(&pdev->dev, "failed to request I/O memory\n"); | 334 | dev_err(&pdev->dev, "failed to request I/O memory\n"); |
| 337 | ret = -EBUSY; | 335 | return -EBUSY; |
| 338 | goto failed_fbi; | ||
| 339 | } | 336 | } |
| 340 | 337 | ||
| 341 | fbi->regbase = ioremap(res->start, resource_size(res)); | 338 | fbi->regbase = ioremap(res->start, resource_size(res)); |
| @@ -346,17 +343,19 @@ static int vt8500lcd_probe(struct platform_device *pdev) | |||
| 346 | } | 343 | } |
| 347 | 344 | ||
| 348 | disp_timing = of_get_display_timings(pdev->dev.of_node); | 345 | disp_timing = of_get_display_timings(pdev->dev.of_node); |
| 349 | if (!disp_timing) | 346 | if (!disp_timing) { |
| 350 | return -EINVAL; | 347 | ret = -EINVAL; |
| 348 | goto failed_free_io; | ||
| 349 | } | ||
| 351 | 350 | ||
| 352 | ret = of_get_fb_videomode(pdev->dev.of_node, &of_mode, | 351 | ret = of_get_fb_videomode(pdev->dev.of_node, &of_mode, |
| 353 | OF_USE_NATIVE_MODE); | 352 | OF_USE_NATIVE_MODE); |
| 354 | if (ret) | 353 | if (ret) |
| 355 | return ret; | 354 | goto failed_free_io; |
| 356 | 355 | ||
| 357 | ret = of_property_read_u32(pdev->dev.of_node, "bits-per-pixel", &bpp); | 356 | ret = of_property_read_u32(pdev->dev.of_node, "bits-per-pixel", &bpp); |
| 358 | if (ret) | 357 | if (ret) |
| 359 | return ret; | 358 | goto failed_free_io; |
| 360 | 359 | ||
| 361 | /* try allocating the framebuffer */ | 360 | /* try allocating the framebuffer */ |
| 362 | fb_mem_len = of_mode.xres * of_mode.yres * 2 * (bpp / 8); | 361 | fb_mem_len = of_mode.xres * of_mode.yres * 2 * (bpp / 8); |
| @@ -364,7 +363,8 @@ static int vt8500lcd_probe(struct platform_device *pdev) | |||
| 364 | GFP_KERNEL); | 363 | GFP_KERNEL); |
| 365 | if (!fb_mem_virt) { | 364 | if (!fb_mem_virt) { |
| 366 | pr_err("%s: Failed to allocate framebuffer\n", __func__); | 365 | pr_err("%s: Failed to allocate framebuffer\n", __func__); |
| 367 | return -ENOMEM; | 366 | ret = -ENOMEM; |
| 367 | goto failed_free_io; | ||
| 368 | } | 368 | } |
| 369 | 369 | ||
| 370 | fbi->fb.fix.smem_start = fb_mem_phys; | 370 | fbi->fb.fix.smem_start = fb_mem_phys; |
| @@ -447,9 +447,6 @@ failed_free_io: | |||
| 447 | iounmap(fbi->regbase); | 447 | iounmap(fbi->regbase); |
| 448 | failed_free_res: | 448 | failed_free_res: |
| 449 | release_mem_region(res->start, resource_size(res)); | 449 | release_mem_region(res->start, resource_size(res)); |
| 450 | failed_fbi: | ||
| 451 | kfree(fbi); | ||
| 452 | failed: | ||
| 453 | return ret; | 450 | return ret; |
| 454 | } | 451 | } |
| 455 | 452 | ||
diff --git a/drivers/watchdog/bcm2835_wdt.c b/drivers/watchdog/bcm2835_wdt.c index a6a2cebb2587..cafa973c43be 100644 --- a/drivers/watchdog/bcm2835_wdt.c +++ b/drivers/watchdog/bcm2835_wdt.c | |||
| @@ -19,7 +19,6 @@ | |||
| 19 | #include <linux/watchdog.h> | 19 | #include <linux/watchdog.h> |
| 20 | #include <linux/platform_device.h> | 20 | #include <linux/platform_device.h> |
| 21 | #include <linux/of_address.h> | 21 | #include <linux/of_address.h> |
| 22 | #include <linux/miscdevice.h> | ||
| 23 | 22 | ||
| 24 | #define PM_RSTC 0x1c | 23 | #define PM_RSTC 0x1c |
| 25 | #define PM_WDOG 0x24 | 24 | #define PM_WDOG 0x24 |
diff --git a/drivers/watchdog/ep93xx_wdt.c b/drivers/watchdog/ep93xx_wdt.c index 833e81311848..d1d07f2f69df 100644 --- a/drivers/watchdog/ep93xx_wdt.c +++ b/drivers/watchdog/ep93xx_wdt.c | |||
| @@ -28,7 +28,6 @@ | |||
| 28 | 28 | ||
| 29 | #include <linux/platform_device.h> | 29 | #include <linux/platform_device.h> |
| 30 | #include <linux/module.h> | 30 | #include <linux/module.h> |
| 31 | #include <linux/miscdevice.h> | ||
| 32 | #include <linux/watchdog.h> | 31 | #include <linux/watchdog.h> |
| 33 | #include <linux/timer.h> | 32 | #include <linux/timer.h> |
| 34 | #include <linux/io.h> | 33 | #include <linux/io.h> |
diff --git a/drivers/watchdog/ie6xx_wdt.c b/drivers/watchdog/ie6xx_wdt.c index 70a240297c6d..07f88f54e5c0 100644 --- a/drivers/watchdog/ie6xx_wdt.c +++ b/drivers/watchdog/ie6xx_wdt.c | |||
| @@ -28,7 +28,6 @@ | |||
| 28 | #include <linux/kernel.h> | 28 | #include <linux/kernel.h> |
| 29 | #include <linux/types.h> | 29 | #include <linux/types.h> |
| 30 | #include <linux/watchdog.h> | 30 | #include <linux/watchdog.h> |
| 31 | #include <linux/miscdevice.h> | ||
| 32 | #include <linux/seq_file.h> | 31 | #include <linux/seq_file.h> |
| 33 | #include <linux/debugfs.h> | 32 | #include <linux/debugfs.h> |
| 34 | #include <linux/uaccess.h> | 33 | #include <linux/uaccess.h> |
diff --git a/drivers/watchdog/jz4740_wdt.c b/drivers/watchdog/jz4740_wdt.c index 2de486a7eea1..3aa50cfa335f 100644 --- a/drivers/watchdog/jz4740_wdt.c +++ b/drivers/watchdog/jz4740_wdt.c | |||
| @@ -17,7 +17,6 @@ | |||
| 17 | #include <linux/moduleparam.h> | 17 | #include <linux/moduleparam.h> |
| 18 | #include <linux/types.h> | 18 | #include <linux/types.h> |
| 19 | #include <linux/kernel.h> | 19 | #include <linux/kernel.h> |
| 20 | #include <linux/miscdevice.h> | ||
| 21 | #include <linux/watchdog.h> | 20 | #include <linux/watchdog.h> |
| 22 | #include <linux/init.h> | 21 | #include <linux/init.h> |
| 23 | #include <linux/platform_device.h> | 22 | #include <linux/platform_device.h> |
diff --git a/drivers/watchdog/kempld_wdt.c b/drivers/watchdog/kempld_wdt.c index a1a3638c579c..20dc73844737 100644 --- a/drivers/watchdog/kempld_wdt.c +++ b/drivers/watchdog/kempld_wdt.c | |||
| @@ -26,7 +26,6 @@ | |||
| 26 | 26 | ||
| 27 | #include <linux/module.h> | 27 | #include <linux/module.h> |
| 28 | #include <linux/moduleparam.h> | 28 | #include <linux/moduleparam.h> |
| 29 | #include <linux/miscdevice.h> | ||
| 30 | #include <linux/uaccess.h> | 29 | #include <linux/uaccess.h> |
| 31 | #include <linux/watchdog.h> | 30 | #include <linux/watchdog.h> |
| 32 | #include <linux/platform_device.h> | 31 | #include <linux/platform_device.h> |
diff --git a/drivers/watchdog/max63xx_wdt.c b/drivers/watchdog/max63xx_wdt.c index 6d4f3998e1f6..bdb3f4a5b27c 100644 --- a/drivers/watchdog/max63xx_wdt.c +++ b/drivers/watchdog/max63xx_wdt.c | |||
| @@ -19,7 +19,6 @@ | |||
| 19 | #include <linux/moduleparam.h> | 19 | #include <linux/moduleparam.h> |
| 20 | #include <linux/types.h> | 20 | #include <linux/types.h> |
| 21 | #include <linux/kernel.h> | 21 | #include <linux/kernel.h> |
| 22 | #include <linux/miscdevice.h> | ||
| 23 | #include <linux/watchdog.h> | 22 | #include <linux/watchdog.h> |
| 24 | #include <linux/init.h> | 23 | #include <linux/init.h> |
| 25 | #include <linux/bitops.h> | 24 | #include <linux/bitops.h> |
diff --git a/drivers/watchdog/orion_wdt.c b/drivers/watchdog/orion_wdt.c index 44edca66d564..f7722a424676 100644 --- a/drivers/watchdog/orion_wdt.c +++ b/drivers/watchdog/orion_wdt.c | |||
| @@ -16,7 +16,6 @@ | |||
| 16 | #include <linux/moduleparam.h> | 16 | #include <linux/moduleparam.h> |
| 17 | #include <linux/types.h> | 17 | #include <linux/types.h> |
| 18 | #include <linux/kernel.h> | 18 | #include <linux/kernel.h> |
| 19 | #include <linux/miscdevice.h> | ||
| 20 | #include <linux/platform_device.h> | 19 | #include <linux/platform_device.h> |
| 21 | #include <linux/watchdog.h> | 20 | #include <linux/watchdog.h> |
| 22 | #include <linux/init.h> | 21 | #include <linux/init.h> |
diff --git a/drivers/watchdog/pnx4008_wdt.c b/drivers/watchdog/pnx4008_wdt.c index 1bdcc313e1d9..5bec20f5dc2d 100644 --- a/drivers/watchdog/pnx4008_wdt.c +++ b/drivers/watchdog/pnx4008_wdt.c | |||
| @@ -23,7 +23,6 @@ | |||
| 23 | #include <linux/moduleparam.h> | 23 | #include <linux/moduleparam.h> |
| 24 | #include <linux/types.h> | 24 | #include <linux/types.h> |
| 25 | #include <linux/kernel.h> | 25 | #include <linux/kernel.h> |
| 26 | #include <linux/miscdevice.h> | ||
| 27 | #include <linux/watchdog.h> | 26 | #include <linux/watchdog.h> |
| 28 | #include <linux/init.h> | 27 | #include <linux/init.h> |
| 29 | #include <linux/platform_device.h> | 28 | #include <linux/platform_device.h> |
diff --git a/drivers/watchdog/rt2880_wdt.c b/drivers/watchdog/rt2880_wdt.c index 53d37fea183e..d92c2d5859ce 100644 --- a/drivers/watchdog/rt2880_wdt.c +++ b/drivers/watchdog/rt2880_wdt.c | |||
| @@ -16,7 +16,6 @@ | |||
| 16 | #include <linux/module.h> | 16 | #include <linux/module.h> |
| 17 | #include <linux/kernel.h> | 17 | #include <linux/kernel.h> |
| 18 | #include <linux/watchdog.h> | 18 | #include <linux/watchdog.h> |
| 19 | #include <linux/miscdevice.h> | ||
| 20 | #include <linux/moduleparam.h> | 19 | #include <linux/moduleparam.h> |
| 21 | #include <linux/platform_device.h> | 20 | #include <linux/platform_device.h> |
| 22 | 21 | ||
diff --git a/drivers/watchdog/sc1200wdt.c b/drivers/watchdog/sc1200wdt.c index 3b9fff9dcf65..131193a7acdf 100644 --- a/drivers/watchdog/sc1200wdt.c +++ b/drivers/watchdog/sc1200wdt.c | |||
| @@ -409,8 +409,9 @@ static int __init sc1200wdt_init(void) | |||
| 409 | #if defined CONFIG_PNP | 409 | #if defined CONFIG_PNP |
| 410 | /* now that the user has specified an IO port and we haven't detected | 410 | /* now that the user has specified an IO port and we haven't detected |
| 411 | * any devices, disable pnp support */ | 411 | * any devices, disable pnp support */ |
| 412 | if (isapnp) | ||
| 413 | pnp_unregister_driver(&scl200wdt_pnp_driver); | ||
| 412 | isapnp = 0; | 414 | isapnp = 0; |
| 413 | pnp_unregister_driver(&scl200wdt_pnp_driver); | ||
| 414 | #endif | 415 | #endif |
| 415 | 416 | ||
| 416 | if (!request_region(io, io_len, SC1200_MODULE_NAME)) { | 417 | if (!request_region(io, io_len, SC1200_MODULE_NAME)) { |
diff --git a/drivers/watchdog/shwdt.c b/drivers/watchdog/shwdt.c index f9b8e06f3558..af3528f84d65 100644 --- a/drivers/watchdog/shwdt.c +++ b/drivers/watchdog/shwdt.c | |||
| @@ -26,7 +26,6 @@ | |||
| 26 | #include <linux/init.h> | 26 | #include <linux/init.h> |
| 27 | #include <linux/types.h> | 27 | #include <linux/types.h> |
| 28 | #include <linux/spinlock.h> | 28 | #include <linux/spinlock.h> |
| 29 | #include <linux/miscdevice.h> | ||
| 30 | #include <linux/watchdog.h> | 29 | #include <linux/watchdog.h> |
| 31 | #include <linux/pm_runtime.h> | 30 | #include <linux/pm_runtime.h> |
| 32 | #include <linux/fs.h> | 31 | #include <linux/fs.h> |
diff --git a/drivers/watchdog/softdog.c b/drivers/watchdog/softdog.c index ef2638fee4a8..c04a1aa158e2 100644 --- a/drivers/watchdog/softdog.c +++ b/drivers/watchdog/softdog.c | |||
| @@ -42,7 +42,6 @@ | |||
| 42 | #include <linux/moduleparam.h> | 42 | #include <linux/moduleparam.h> |
| 43 | #include <linux/types.h> | 43 | #include <linux/types.h> |
| 44 | #include <linux/timer.h> | 44 | #include <linux/timer.h> |
| 45 | #include <linux/miscdevice.h> | ||
| 46 | #include <linux/watchdog.h> | 45 | #include <linux/watchdog.h> |
| 47 | #include <linux/notifier.h> | 46 | #include <linux/notifier.h> |
| 48 | #include <linux/reboot.h> | 47 | #include <linux/reboot.h> |
diff --git a/drivers/watchdog/stmp3xxx_rtc_wdt.c b/drivers/watchdog/stmp3xxx_rtc_wdt.c index d667f6b51d35..bb64ae3f47da 100644 --- a/drivers/watchdog/stmp3xxx_rtc_wdt.c +++ b/drivers/watchdog/stmp3xxx_rtc_wdt.c | |||
| @@ -12,7 +12,6 @@ | |||
| 12 | #include <linux/init.h> | 12 | #include <linux/init.h> |
| 13 | #include <linux/kernel.h> | 13 | #include <linux/kernel.h> |
| 14 | #include <linux/module.h> | 14 | #include <linux/module.h> |
| 15 | #include <linux/miscdevice.h> | ||
| 16 | #include <linux/watchdog.h> | 15 | #include <linux/watchdog.h> |
| 17 | #include <linux/platform_device.h> | 16 | #include <linux/platform_device.h> |
| 18 | #include <linux/stmp3xxx_rtc_wdt.h> | 17 | #include <linux/stmp3xxx_rtc_wdt.h> |
diff --git a/drivers/watchdog/txx9wdt.c b/drivers/watchdog/txx9wdt.c index 0fd0e8ae62a8..6a447e321dd0 100644 --- a/drivers/watchdog/txx9wdt.c +++ b/drivers/watchdog/txx9wdt.c | |||
| @@ -13,7 +13,6 @@ | |||
| 13 | #include <linux/module.h> | 13 | #include <linux/module.h> |
| 14 | #include <linux/moduleparam.h> | 14 | #include <linux/moduleparam.h> |
| 15 | #include <linux/types.h> | 15 | #include <linux/types.h> |
| 16 | #include <linux/miscdevice.h> | ||
| 17 | #include <linux/watchdog.h> | 16 | #include <linux/watchdog.h> |
| 18 | #include <linux/init.h> | 17 | #include <linux/init.h> |
| 19 | #include <linux/platform_device.h> | 18 | #include <linux/platform_device.h> |
diff --git a/drivers/watchdog/ux500_wdt.c b/drivers/watchdog/ux500_wdt.c index e029b5768f2c..5aed9d7ad47e 100644 --- a/drivers/watchdog/ux500_wdt.c +++ b/drivers/watchdog/ux500_wdt.c | |||
| @@ -12,7 +12,6 @@ | |||
| 12 | #include <linux/module.h> | 12 | #include <linux/module.h> |
| 13 | #include <linux/kernel.h> | 13 | #include <linux/kernel.h> |
| 14 | #include <linux/moduleparam.h> | 14 | #include <linux/moduleparam.h> |
| 15 | #include <linux/miscdevice.h> | ||
| 16 | #include <linux/err.h> | 15 | #include <linux/err.h> |
| 17 | #include <linux/uaccess.h> | 16 | #include <linux/uaccess.h> |
| 18 | #include <linux/watchdog.h> | 17 | #include <linux/watchdog.h> |
diff --git a/drivers/xen/grant-table.c b/drivers/xen/grant-table.c index 62ccf5424ba8..028387192b60 100644 --- a/drivers/xen/grant-table.c +++ b/drivers/xen/grant-table.c | |||
| @@ -930,9 +930,10 @@ int gnttab_map_refs(struct gnttab_map_grant_ref *map_ops, | |||
| 930 | ret = m2p_add_override(mfn, pages[i], kmap_ops ? | 930 | ret = m2p_add_override(mfn, pages[i], kmap_ops ? |
| 931 | &kmap_ops[i] : NULL); | 931 | &kmap_ops[i] : NULL); |
| 932 | if (ret) | 932 | if (ret) |
| 933 | return ret; | 933 | goto out; |
| 934 | } | 934 | } |
| 935 | 935 | ||
| 936 | out: | ||
| 936 | if (lazy) | 937 | if (lazy) |
| 937 | arch_leave_lazy_mmu_mode(); | 938 | arch_leave_lazy_mmu_mode(); |
| 938 | 939 | ||
| @@ -969,9 +970,10 @@ int gnttab_unmap_refs(struct gnttab_unmap_grant_ref *unmap_ops, | |||
| 969 | ret = m2p_remove_override(pages[i], kmap_ops ? | 970 | ret = m2p_remove_override(pages[i], kmap_ops ? |
| 970 | &kmap_ops[i] : NULL); | 971 | &kmap_ops[i] : NULL); |
| 971 | if (ret) | 972 | if (ret) |
| 972 | return ret; | 973 | goto out; |
| 973 | } | 974 | } |
| 974 | 975 | ||
| 976 | out: | ||
| 975 | if (lazy) | 977 | if (lazy) |
| 976 | arch_leave_lazy_mmu_mode(); | 978 | arch_leave_lazy_mmu_mode(); |
| 977 | 979 | ||
diff --git a/drivers/xen/swiotlb-xen.c b/drivers/xen/swiotlb-xen.c index a224bc74b6b9..1eac0731c349 100644 --- a/drivers/xen/swiotlb-xen.c +++ b/drivers/xen/swiotlb-xen.c | |||
| @@ -555,6 +555,11 @@ xen_swiotlb_map_sg_attrs(struct device *hwdev, struct scatterlist *sgl, | |||
| 555 | sg_dma_len(sgl) = 0; | 555 | sg_dma_len(sgl) = 0; |
| 556 | return 0; | 556 | return 0; |
| 557 | } | 557 | } |
| 558 | xen_dma_map_page(hwdev, pfn_to_page(map >> PAGE_SHIFT), | ||
| 559 | map & ~PAGE_MASK, | ||
| 560 | sg->length, | ||
| 561 | dir, | ||
| 562 | attrs); | ||
| 558 | sg->dma_address = xen_phys_to_bus(map); | 563 | sg->dma_address = xen_phys_to_bus(map); |
| 559 | } else { | 564 | } else { |
| 560 | /* we are not interested in the dma_addr returned by | 565 | /* we are not interested in the dma_addr returned by |
