patch-2.4.6 linux/drivers/acpi/ospm/battery/bt.c

• Lines: 594
• Date: Wed Jun 20 17:47:40 2001
• Orig file: v2.4.5/linux/drivers/acpi/ospm/battery/bt.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.4.5/linux/drivers/acpi/ospm/battery/bt.c linux/drivers/acpi/ospm/battery/bt.c
@@ -0,0 +1,593 @@
+/*****************************************************************************
+ *
+ * Module Name: bt.c
+ *   $Revision: 24 $
+ *
+ *****************************************************************************/
+
+/*
+ *  Copyright (C) 2000, 2001 Andrew Grover
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation; either version 2 of the License, or
+ *  (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+#include <acpi.h>
+#include "bt.h"
+
+
+#define _COMPONENT		ACPI_BATTERY
+	MODULE_NAME 		("bt")
+
+
+/****************************************************************************
+ *                            Internal Functions
+ ****************************************************************************/
+
+/****************************************************************************
+ *
+ * FUNCTION:	bt_print
+ *
+ * PARAMETERS:	
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION: Prints out information on a specific battery.
+ *
+ ****************************************************************************/
+
+void
+bt_print (
+	BT_CONTEXT		*battery)
+{
+
+	return;
+}
+
+
+/****************************************************************************
+ *
+ * FUNCTION:	bt_get_info
+ *
+ * PARAMETERS:	
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ * NOTES:	Allocates battery_info - which must be freed by the caller.
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_get_info (
+	BT_CONTEXT		*battery,
+	BT_BATTERY_INFO 	**battery_info)
+{
+	ACPI_STATUS 		status = AE_OK;
+	ACPI_BUFFER 		bif_buffer, package_format, package_data;
+	ACPI_OBJECT 		*package = NULL;
+
+	if (!battery || !battery_info || *battery_info) {
+		return(AE_BAD_PARAMETER);
+	}
+
+	MEMSET(&bif_buffer, 0, sizeof(ACPI_BUFFER));
+
+	/*
+	 * Evalute _BIF:
+	 * -------------
+	 * And be sure to deallocate bif_buffer.pointer!
+	 */
+	status = bm_evaluate_object(battery->acpi_handle, "_BIF", NULL,
+		&bif_buffer);
+	if (ACPI_FAILURE(status)) {
+		return(status);
+	}
+
+	/*
+	 * Extract Package Data:
+	 * ---------------------
+	 * Type-cast this bif_buffer to a package and use helper
+	 * functions to convert results into BT_BATTERY_INFO structure.
+	 * The first attempt is just to get the size of the package
+	 * data; the second gets the data (once we know the required
+	 * bif_buffer size).
+	 */
+	status = bm_cast_buffer(&bif_buffer, (void**)&package,
+		sizeof(ACPI_OBJECT));
+	if (ACPI_FAILURE(status)) {
+		goto end;
+	}
+
+	package_format.length = sizeof("NNNNNNNNNSSSS");
+	package_format.pointer = "NNNNNNNNNSSSS";
+
+	MEMSET(&package_data, 0, sizeof(ACPI_BUFFER));
+
+	status = bm_extract_package_data(package, &package_format,
+		&package_data);
+	if (status != AE_BUFFER_OVERFLOW) {
+		if (status == AE_OK) {
+			status = AE_ERROR;
+		}
+		goto end;
+	}
+
+	package_data.pointer = acpi_os_callocate(package_data.length);
+	if (!package_data.pointer) {
+		return(AE_NO_MEMORY);
+	}
+
+	status = bm_extract_package_data(package, &package_format,
+		&package_data);
+	if (ACPI_FAILURE(status)) {
+		acpi_os_free(package_data.pointer);
+		goto end;
+	}
+
+	*battery_info = package_data.pointer;
+
+end:
+	acpi_os_free(bif_buffer.pointer);
+
+	return(status);
+}
+
+
+/****************************************************************************
+ *
+ * FUNCTION:	bt_get_status
+ *
+ * PARAMETERS:	
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_get_status (
+	BT_CONTEXT		*battery,
+	BT_BATTERY_STATUS	**battery_status)
+{
+	ACPI_STATUS 		status = AE_OK;
+	ACPI_BUFFER 		bst_buffer, package_format, package_data;
+	ACPI_OBJECT 		*package = NULL;
+
+	if (!battery || !battery_status || *battery_status) {
+		return(AE_BAD_PARAMETER);
+	}
+
+	MEMSET(&bst_buffer, 0, sizeof(ACPI_BUFFER));
+
+	/*
+	 * Evalute _BST:
+	 * -------------
+	 * And be sure to deallocate bst_buffer.pointer!
+	 */
+	status = bm_evaluate_object(battery->acpi_handle, "_BST",
+		NULL, &bst_buffer);
+	if (ACPI_FAILURE(status)) {
+		return(status);
+	}
+
+	/*
+	 * Extract Package Data:
+	 * ---------------------
+	 * Type-cast this bst_buffer to a package and use helper
+	 * functions to convert results into BT_BATTERY_STATUS structure.
+	 * The first attempt is just to get the size of the package data;
+	 * the second gets the data (once we know the required bst_buffer
+	 * size).
+	 */
+	status = bm_cast_buffer(&bst_buffer, (void**)&package,
+		sizeof(ACPI_OBJECT));
+	if (ACPI_FAILURE(status)) {
+		goto end;
+	}
+
+	package_format.length = sizeof("NNNN");
+	package_format.pointer = "NNNN";
+
+	MEMSET(&package_data, 0, sizeof(ACPI_BUFFER));
+
+	status = bm_extract_package_data(package, &package_format,
+		&package_data);
+	if (status != AE_BUFFER_OVERFLOW) {
+		if (status == AE_OK) {
+			status = AE_ERROR;
+		}
+		goto end;
+	}
+
+	package_data.pointer = acpi_os_callocate(package_data.length);
+	if (!package_data.pointer) {
+		return(AE_NO_MEMORY);
+	}
+
+	status = bm_extract_package_data(package, &package_format,
+		&package_data);
+	if (ACPI_FAILURE(status)) {
+		acpi_os_free(package_data.pointer);
+		goto end;
+	}
+
+	*battery_status = package_data.pointer;
+
+end:
+	acpi_os_free(bst_buffer.pointer);
+
+	return(status);
+}
+
+
+/****************************************************************************
+ *
+ * FUNCTION:	bt_check_device
+ *
+ * PARAMETERS:	
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_check_device (
+	BT_CONTEXT		*battery)
+{
+	ACPI_STATUS 		status = AE_OK;
+	BM_DEVICE_STATUS	battery_status = BM_STATUS_UNKNOWN;
+	u32 			was_present = FALSE;
+	BT_BATTERY_INFO 	*battery_info = NULL;
+
+	if (!battery) {
+		return(AE_BAD_PARAMETER);
+	}
+
+	was_present = battery->is_present;
+
+	/*
+	 * Battery Present?
+	 * ----------------
+	 * Get the device status and check if battery slot is occupied.
+	 */
+	status = bm_get_device_status(battery->device_handle, &battery_status);
+	if (ACPI_FAILURE(status)) {
+		return(status);
+	}
+
+	if (battery_status & BM_STATUS_BATTERY_PRESENT) {
+		battery->is_present = TRUE;
+	}
+	else {
+		battery->is_present = FALSE;
+	}
+
+	/*
+	 * Battery Appeared?
+	 * -----------------
+	 */
+	if (!was_present && battery->is_present) {
+
+		/*
+		 * Units of Power?
+		 * ---------------
+		 * Get the 'units of power', as we'll need this to report
+		 * status information.
+		 */
+		status = bt_get_info(battery, &battery_info);
+		if (ACPI_SUCCESS(status)) {
+			battery->power_units = (battery_info->power_unit)
+				? BT_POWER_UNITS_AMPS : BT_POWER_UNITS_WATTS;
+			acpi_os_free(battery_info);
+		}
+	}
+
+	/*
+	 * Battery Disappeared?
+	 * --------------------
+	 */
+	else if (was_present && !battery->is_present) {
+		battery->power_units = BT_POWER_UNITS_DEFAULT;
+	}
+
+	return(status);
+}
+
+
+/*****************************************************************************
+ *
+ * FUNCTION:	bt_add_device
+ *
+ * PARAMETERS:	
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_add_device (
+	BM_HANDLE		device_handle,
+	void			**context)
+{
+	ACPI_STATUS 		status = AE_OK;
+	BM_DEVICE		*device = NULL;
+	BT_CONTEXT		*battery = NULL;
+
+	if (!context || *context) {
+		return(AE_BAD_PARAMETER);
+	}
+
+	/*
+	 * Get information on this device.
+	 */
+	status = bm_get_device_info(device_handle, &device);
+	if (ACPI_FAILURE(status)) {
+		return(status);
+	}
+
+	/*
+	 * Allocate a new BT_CONTEXT structure.
+	 */
+	battery = acpi_os_callocate(sizeof(BT_CONTEXT));
+	if (!battery) {
+		return(AE_NO_MEMORY);
+	}
+
+	battery->device_handle = device->handle;
+	battery->acpi_handle = device->acpi_handle;
+	strncpy(battery->uid, device->id.uid, sizeof(battery->uid));
+
+	battery->power_units = BT_POWER_UNITS_DEFAULT;
+	battery->is_present = FALSE;
+
+	/*
+	 * See if battery is really present.
+	 */
+	status = bt_check_device(battery);
+	if (ACPI_FAILURE(status)) {
+		goto end;
+	}
+
+	status = bt_osl_add_device(battery);
+	if (ACPI_FAILURE(status)) {
+		goto end;
+	}
+
+	*context = battery;
+
+	bt_print(battery);
+
+end:
+	if (ACPI_FAILURE(status)) {
+		acpi_os_free(battery);
+	}
+
+	return(status);
+}
+
+
+/*****************************************************************************
+ *
+ * FUNCTION:	bt_remove_device
+ *
+ * PARAMETERS:	
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_remove_device (
+	void			**context)
+{
+	ACPI_STATUS 		status = AE_OK;
+	BT_CONTEXT		*battery = NULL;
+
+	if (!context || !*context) {
+		return(AE_BAD_PARAMETER);
+	}
+
+	battery = (BT_CONTEXT*)*context;
+
+	bt_osl_remove_device(battery);
+
+	acpi_os_free(battery);
+
+	*context = NULL;
+
+	return(status);
+}
+
+
+/*****************************************************************************
+ *                               External Functions
+ *****************************************************************************/
+
+/*****************************************************************************
+ *
+ * FUNCTION:	bt_initialize
+ *
+ * PARAMETERS:	<none>
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_initialize (void)
+{
+	ACPI_STATUS		status = AE_OK;
+	BM_DEVICE_ID		criteria;
+	BM_DRIVER		driver;
+
+	MEMSET(&criteria, 0, sizeof(BM_DEVICE_ID));
+	MEMSET(&driver, 0, sizeof(BM_DRIVER));
+
+	/*
+	 * Register driver for driver method battery devices.
+	 */
+	MEMCPY(criteria.hid, BT_HID_CM_BATTERY, sizeof(BT_HID_CM_BATTERY));
+
+	driver.notify = &bt_notify;
+	driver.request = &bt_request;
+
+	status = bm_register_driver(&criteria, &driver);
+
+	return(status);
+}
+
+
+/****************************************************************************
+ *
+ * FUNCTION:	bt_terminate
+ *
+ * PARAMETERS:	<none>
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_terminate (void)
+{
+	ACPI_STATUS		status = AE_OK;
+	BM_DEVICE_ID		criteria;
+	BM_DRIVER		driver;
+
+	MEMSET(&criteria, 0, sizeof(BM_DEVICE_ID));
+	MEMSET(&driver, 0, sizeof(BM_DRIVER));
+
+	/*
+	 * Unregister driver for driver method battery devices.
+	 */
+	MEMCPY(criteria.hid, BT_HID_CM_BATTERY, sizeof(BT_HID_CM_BATTERY));
+
+	driver.notify = &bt_notify;
+	driver.request = &bt_request;
+
+	status = bm_unregister_driver(&criteria, &driver);
+
+	return(status);
+}
+
+
+/****************************************************************************
+ *
+ * FUNCTION:	bt_notify
+ *
+ * PARAMETERS:	<none>
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_notify (
+	BM_NOTIFY		notify_type,
+	BM_HANDLE		device_handle,
+	void			**context)
+{
+	ACPI_STATUS 		status = AE_OK;
+
+	if (!context) {
+		return(AE_BAD_PARAMETER);
+	}
+
+	switch (notify_type) {
+
+	case BM_NOTIFY_DEVICE_ADDED:
+		status = bt_add_device(device_handle, context);
+		break;
+
+	case BM_NOTIFY_DEVICE_REMOVED:
+		status = bt_remove_device(context);
+		break;
+
+	case BT_NOTIFY_STATUS_CHANGE:
+		status = bt_osl_generate_event(notify_type,
+			((BT_CONTEXT*)*context));
+		break;
+
+	case BT_NOTIFY_INFORMATION_CHANGE:
+		status = bt_check_device((BT_CONTEXT*)*context);
+		if (ACPI_SUCCESS(status)) {
+			status = bt_osl_generate_event(notify_type,
+				((BT_CONTEXT*)*context));
+		}
+		break;
+
+	default:
+		status = AE_SUPPORT;
+		break;
+	}
+
+	return(status);
+}
+
+
+/****************************************************************************
+ *
+ * FUNCTION:	bt_request
+ *
+ * PARAMETERS:	
+ *
+ * RETURN:	
+ *
+ * DESCRIPTION:
+ *
+ ****************************************************************************/
+
+ACPI_STATUS
+bt_request (
+	BM_REQUEST		*request,
+	void			*context)
+{
+	ACPI_STATUS 		status = AE_OK;
+
+	/*
+	 * Must have a valid request structure and context.
+	 */
+	if (!request || !context)
+		return(AE_BAD_PARAMETER);
+
+	/*
+	 * Handle request:
+	 * ---------------
+	 */
+	switch (request->command) {
+
+	default:
+		status = AE_SUPPORT;
+		break;
+	}
+
+	request->status = status;
+
+	return(status);
+}