Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit bb2ea96b authored by Azael Avalos's avatar Azael Avalos Committed by Darren Hart
Browse files

toshiba_bluetooth: Add three new functions to the driver 



This patch introduces three new functions, which are going to be used
by the next patches.

The functions introduced are toshiba_bluetooth_present,
toshiba_bluetooth_status and toshiba_bluetooth_disable, which queries
the presence of the device, queries the status and disables the
device respectively.

Signed-off-by: default avatarAzael Avalos <coproscefalo@gmail.com>
Signed-off-by: default avatarDarren Hart <dvhart@linux.intel.com>
parent fb42d1f4

drivers/platform/x86/toshiba_bluetooth.c

+51 −0
Original line number Diff line number Diff line
@@ -57,6 +57,38 @@ static struct acpi_driver toshiba_bt_rfkill_driver = { 
	.drv.pm =	&toshiba_bt_pm,

};



static int toshiba_bluetooth_present(acpi_handle handle)

{

	acpi_status result;

	u64 bt_present;



	result = acpi_evaluate_integer(handle, "_STA", NULL, &bt_present);

	if (ACPI_FAILURE(result)) {

		pr_err("ACPI call to query Bluetooth presence failed");

		return -ENXIO;

	} else if (!bt_present) {

		pr_info("Bluetooth device not present\n");

		return -ENODEV;

	}



	return 0;

}



static int toshiba_bluetooth_status(acpi_handle handle)

{

	acpi_status result;

	u64 status;



	result = acpi_evaluate_integer(handle, "BTST", NULL, &status);

	if (ACPI_FAILURE(result)) {

		pr_err("Could not get Bluetooth device status\n");

		return -ENXIO;

	}



	pr_info("Bluetooth status %llu\n", status);



	return status;

}



static int toshiba_bluetooth_enable(acpi_handle handle)

{
@@ -85,6 +117,25 @@ static int toshiba_bluetooth_enable(acpi_handle handle) 
	return -ENODEV;

}



static int toshiba_bluetooth_disable(acpi_handle handle)

{

	acpi_status result;



	result = acpi_evaluate_object(handle, "BTPF", NULL, NULL);

	if (ACPI_FAILURE(result)) {

		pr_err("Could not power OFF Bluetooth device\n");

		return -ENXIO;

	}



	result = acpi_evaluate_object(handle, "DUSB", NULL, NULL);

	if (ACPI_FAILURE(result)) {

		pr_err("Could not detach USB Bluetooth device\n");

		return -ENXIO;

	}



	return 0;

}



static void toshiba_bt_rfkill_notify(struct acpi_device *device, u32 event)

{

	toshiba_bluetooth_enable(device->handle);