mfd: menf21bmc: Introduce MEN 14F021P00 BMC MFD Core driver (dfbdcd7c) · Commits · 戴 / test

drivers/mfd/Kconfig

+15 −0

Original line number	Diff line number	Diff line
		@@ -454,6 +454,21 @@ config MFD_MAX8998
		additional drivers must be enabled in order to use the functionality
		of the device.

		config MFD_MENF21BMC
		tristate "MEN 14F021P00 Board Management Controller Support"
		depends on I2C
		select MFD_CORE
		help
		Say yes here to add support for the MEN 14F021P00 BMC
		which is a Board Management Controller connected to the I2C bus.
		The device supports multiple sub-devices like LED, HWMON and WDT.
		This driver provides common support for accessing the devices;
		additional drivers must be enabled in order to use the
		functionality of the BMC device.

		This driver can also be built as a module. If so the module
		will be called menf21bmc.

		config EZX_PCAP
		bool "Motorola EZXPCAP Support"
		depends on SPI_MASTER

drivers/mfd/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -169,6 +169,7 @@ obj-$(CONFIG_MFD_AS3711) += as3711.o
		obj-$(CONFIG_MFD_AS3722) += as3722.o
		obj-$(CONFIG_MFD_STW481X) += stw481x.o
		obj-$(CONFIG_MFD_IPAQ_MICRO) += ipaq-micro.o
		obj-$(CONFIG_MFD_MENF21BMC) += menf21bmc.o

		intel-soc-pmic-objs := intel_soc_pmic_core.o intel_soc_pmic_crc.o
		obj-$(CONFIG_INTEL_SOC_PMIC) += intel-soc-pmic.o

drivers/mfd/menf21bmc.c

0 → 100644

+132 −0

Original line number	Diff line number	Diff line
		/*
		* MEN 14F021P00 Board Management Controller (BMC) MFD Core Driver.
		*
		* Copyright (C) 2014 MEN Mikro Elektronik Nuernberg GmbH
		*
		* 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.
		*/

		#include <linux/kernel.h>
		#include <linux/device.h>
		#include <linux/module.h>
		#include <linux/i2c.h>
		#include <linux/mfd/core.h>

		#define BMC_CMD_WDT_EXIT_PROD 0x18
		#define BMC_CMD_WDT_PROD_STAT 0x19
		#define BMC_CMD_REV_MAJOR 0x80
		#define BMC_CMD_REV_MINOR 0x81
		#define BMC_CMD_REV_MAIN 0x82

		static struct mfd_cell menf21bmc_cell[] = {
		{ .name = "menf21bmc_wdt", },
		{ .name = "menf21bmc_led", },
		{ .name = "menf21bmc_hwmon", }
		};

		static int menf21bmc_wdt_exit_prod_mode(struct i2c_client *client)
		{
		int val, ret;

		val = i2c_smbus_read_byte_data(client, BMC_CMD_WDT_PROD_STAT);
		if (val < 0)
		return val;

		/*
		* Production mode should be not active after delivery of the Board.
		* To be sure we check it, inform the user and exit the mode
		* if active.
		*/
		if (val == 0x00) {
		dev_info(&client->dev,
		"BMC in production mode. Exit production mode\n");

		ret = i2c_smbus_write_byte(client, BMC_CMD_WDT_EXIT_PROD);
		if (ret < 0)
		return ret;
		}

		return 0;
		}

		static int
		menf21bmc_probe(struct i2c_client client, const struct i2c_device_id ids)
		{
		int rev_major, rev_minor, rev_main;
		int ret;

		ret = i2c_check_functionality(client->adapter,
		I2C_FUNC_SMBUS_BYTE_DATA \|
		I2C_FUNC_SMBUS_WORD_DATA \|
		I2C_FUNC_SMBUS_BYTE);
		if (!ret)
		return -ENODEV;

		rev_major = i2c_smbus_read_word_data(client, BMC_CMD_REV_MAJOR);
		if (rev_major < 0) {
		dev_err(&client->dev, "failed to get BMC major revision\n");
		return rev_major;
		}

		rev_minor = i2c_smbus_read_word_data(client, BMC_CMD_REV_MINOR);
		if (rev_minor < 0) {
		dev_err(&client->dev, "failed to get BMC minor revision\n");
		return rev_minor;
		}

		rev_main = i2c_smbus_read_word_data(client, BMC_CMD_REV_MAIN);
		if (rev_main < 0) {
		dev_err(&client->dev, "failed to get BMC main revision\n");
		return rev_main;
		}

		dev_info(&client->dev, "FW Revision: %02d.%02d.%02d\n",
		rev_major, rev_minor, rev_main);

		/*
		* We have to exit the Production Mode of the BMC to activate the
		* Watchdog functionality and the BIOS life sign monitoring.
		*/
		ret = menf21bmc_wdt_exit_prod_mode(client);
		if (ret < 0) {
		dev_err(&client->dev, "failed to leave production mode\n");
		return ret;
		}

		ret = mfd_add_devices(&client->dev, 0, menf21bmc_cell,
		ARRAY_SIZE(menf21bmc_cell), NULL, 0, NULL);
		if (ret < 0) {
		dev_err(&client->dev, "failed to add BMC sub-devices\n");
		return ret;
		}

		return 0;
		}

		static int menf21bmc_remove(struct i2c_client *client)
		{
		mfd_remove_devices(&client->dev);
		return 0;
		}

		static const struct i2c_device_id menf21bmc_id_table[] = {
		{ "menf21bmc" },
		{ }
		};
		MODULE_DEVICE_TABLE(i2c, menf21bmc_id_table);

		static struct i2c_driver menf21bmc_driver = {
		.driver.name = "menf21bmc",
		.id_table = menf21bmc_id_table,
		.probe = menf21bmc_probe,
		.remove = menf21bmc_remove,
		};

		module_i2c_driver(menf21bmc_driver);

		MODULE_DESCRIPTION("MEN 14F021P00 BMC mfd core driver");
		MODULE_AUTHOR("Andreas Werner <andreas.werner@men.de>");
		MODULE_LICENSE("GPL v2");

Admin message