[PATCH 14/19] commands: add fan control command
Luca Lauro <[email protected]>
| Newsgroups | org.kernel.feeds.b4-sent,org.infradead.lists.barebox |
|---|---|
| Message-ID | <[email protected]> |
---
commands/fan.c | 286 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 286 insertions(+)
diff --git a/commands/fan.c b/commands/fan.c
new file mode 100644
index 0000000000..1581751d51
--- /dev/null
+++ b/commands/fan.c
@@ -0,0 +1,286 @@
+#include <common.h>
+#include <command.h>
+#include <complete.h>
+#include <errno.h>
+#include <fan/fan.h>
+
+static int do_fan(int argc, char *argv[])
+{
+ struct fan_device *fan;
+ char buf[32];
+ unsigned long val;
+ int ret = 0;
+
+
+ if (argc < 3) {
+ return COMMAND_ERROR_USAGE;
+ }
+
+ fan = fan_device_find(argv[2]);
+ if (IS_ERR(fan)) {
+ printf("Device not found: %s\n", argv[2]);
+ return PTR_ERR(fan);
+ }
+ if (!fan->ops) {
+ printf("Fan driver ops not initialized\n");
+ return -ENODEV;
+ }
+
+ if (!strcmp(argv[1], "get")) {
+ if (argc == 4) {
+ if (!strcmp(argv[3], "startv") && fan->ops->get_fan_startv) {
+ ret = fan->ops->get_fan_startv(fan->dev, buf);
+ printf("Fan startup voltage mode: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "gearmult") && fan->ops->get_gear_multiplier) {
+ ret = fan->ops->get_gear_multiplier(fan->dev, buf);
+ printf("Gear multiplier: %s\n", ret >= 0 ? buf : "N/A");
+}
+ else if (!strcmp(argv[3], "outmode") && fan->ops->get_output_mode) {
+ ret = fan->ops->get_output_mode(fan->dev, buf);
+ printf("Output mode: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "ppr") && fan->ops->get_fan_ppr) {
+ ret = fan->ops->get_fan_ppr(fan->dev, buf);
+ printf("Pulses per revolution: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "pwmpol") && fan->ops->get_pwm_polarity) {
+ ret = fan->ops->get_pwm_polarity(fan->dev, buf);
+ printf("PWM polarity: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "clkfreq") && fan->ops->get_clk_freq) {
+ ret = fan->ops->get_clk_freq(fan->dev, buf);
+ printf("Clock frequency: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "clkdiv") && fan->ops->get_clk_div) {
+ ret = fan->ops->get_clk_div(fan->dev, buf);
+ printf("Clock divider: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "ctrlmode") && fan->ops->get_control_mode) {
+ ret = fan->ops->get_control_mode(fan->dev, buf);
+ printf("Control mode: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "outmode") && fan->ops->get_output_mode) {
+ ret = fan->ops->get_output_mode(fan->dev, buf);
+ printf("Output mode: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "oocdet") && fan->ops->get_ooc_detection) {
+ ret = fan->ops->get_ooc_detection(fan->dev, buf);
+ printf("Out of control detection: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "faultdet") && fan->ops->get_failure_detection) {
+ ret = fan->ops->get_failure_detection(fan->dev, buf);
+ printf("Failure detection: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "oocstate") && fan->ops->get_ooc_state) {
+ ret = fan->ops->get_ooc_state(fan->dev, buf);
+ printf("Fan out of control state: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "faultstate") && fan->ops->get_failure_state) {
+ ret = fan->ops->get_failure_state(fan->dev, buf);
+ printf("Fan failure state: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "speed") && fan->ops->get_fan_speed) {
+ ret = fan->ops->get_fan_speed(fan->dev, buf);
+ printf("Fan speed: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "rpm") && fan->ops->get_fan_rpm) {
+ ret = fan->ops->get_fan_rpm(fan->dev, buf);
+ printf("Fan rpm: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "level") && fan->ops->get_fan_level) {
+ ret = fan->ops->get_fan_level(fan->dev, buf);
+ printf("Fan level: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "all")) {
+ if (fan->ops->get_fan_startv) {
+ ret = fan->ops->get_fan_startv(fan->dev, buf);
+ printf("Fan startup voltage mode: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_gear_multiplier) {
+ ret = fan->ops->get_gear_multiplier(fan->dev, buf);
+ printf("Gear multiplier: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_fan_ppr) {
+ ret = fan->ops->get_fan_ppr(fan->dev, buf);
+ printf("Pulses per revolution: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_pwm_polarity) {
+ ret = fan->ops->get_pwm_polarity(fan->dev, buf);
+ printf("PWM polarity: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_clk_freq) {
+ ret = fan->ops->get_clk_freq(fan->dev, buf);
+ printf("Clock frequency: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_clk_div) {
+ ret = fan->ops->get_clk_div(fan->dev, buf);
+ printf("Clock divider: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_control_mode) {
+ ret = fan->ops->get_control_mode(fan->dev, buf);
+ printf("Control mode: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_output_mode) {
+ ret = fan->ops->get_output_mode(fan->dev, buf);
+ printf("Output mode: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_ooc_detection) {
+ ret = fan->ops->get_ooc_detection(fan->dev, buf);
+ printf("Out of control detection: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_failure_detection) {
+ ret = fan->ops->get_failure_detection(fan->dev, buf);
+ printf("Failure detection: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_failure_state) {
+ ret = fan->ops->get_failure_state(fan->dev, buf);
+ printf("Fan failure state: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_ooc_state) {
+ ret = fan->ops->get_ooc_state(fan->dev, buf);
+ printf("Fan out of control state: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_fan_speed) {
+ ret = fan->ops->get_fan_speed(fan->dev, buf);
+ printf("Fan speed: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_fan_rpm) {
+ ret = fan->ops->get_fan_rpm(fan->dev, buf);
+ printf("Fan rpm: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ if (fan->ops->get_fan_level) {
+ ret = fan->ops->get_fan_level(fan->dev, buf);
+ printf("Fan level: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ }
+ else {
+ printf("Invalid parameter: %s\n", argv[3]);
+ return COMMAND_ERROR_USAGE;
+ }
+ }
+ else {
+ printf("Invalid number of arguments for %s cmd\n", argv[1]);
+ return COMMAND_ERROR_USAGE;
+ }
+ }
+ else if (!strcmp(argv[1], "set")) {
+ if (argc == 5) {
+ val = simple_strtoul(argv[4], NULL, 10);
+ snprintf(buf, sizeof(buf), "%lu", val);
+
+ if (!strcmp(argv[3], "startv") && fan->ops->set_fan_startv) {
+ ret = fan->ops->set_fan_startv(fan->dev, val);
+ printf("Fan startup voltage set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "gearmult") && fan->ops->set_gear_multiplier) {
+ ret = fan->ops->set_gear_multiplier(fan->dev, val);
+ printf("Gear multiplier set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "ppr") && fan->ops->set_fan_ppr) {
+ ret = fan->ops->set_fan_ppr(fan->dev, val);
+ printf("Pulses per revolution set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "pwmpol") && fan->ops->set_pwm_polarity) {
+ ret = fan->ops->set_pwm_polarity(fan->dev, val);
+ printf("PWM polarity set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "clkfreq") && fan->ops->set_clk_freq) {
+ ret = fan->ops->set_clk_freq(fan->dev, val);
+ printf("Clock frequency set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "clkdiv") && fan->ops->set_clk_div) {
+ ret = fan->ops->set_clk_div(fan->dev, val);
+ printf("Clock divider set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "ctrlmode") && fan->ops->set_control_mode) {
+ ret = fan->ops->set_control_mode(fan->dev, val);
+ printf("Control mode set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "outmode") && fan->ops->set_output_mode) {
+ ret = fan->ops->set_output_mode(fan->dev, val);
+ printf("Output mode set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "ooc") && fan->ops->set_ooc_detection) {
+ ret = fan->ops->set_ooc_detection(fan->dev, val);
+ printf("Out of control detection set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "fault") && fan->ops->set_failure_detection) {
+ ret = fan->ops->set_failure_detection(fan->dev, val);
+ printf("Failure detection set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "speed") && fan->ops->set_fan_speed) {
+ ret = fan->ops->set_fan_speed(fan->dev, val);
+ printf("Fan speed set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "rpm") && fan->ops->set_fan_rpm) {
+ ret = fan->ops->set_fan_rpm(fan->dev, val);
+ printf("Fan rpm set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else if (!strcmp(argv[3], "level") && fan->ops->set_fan_level) {
+ ret = fan->ops->set_fan_level(fan->dev, val);
+ printf("Fan level set to: %s\n", ret >= 0 ? buf : "N/A");
+ }
+ else {
+ printf("Invalid parameter: %s\n", argv[3]);
+ return COMMAND_ERROR_USAGE;
+ }
+ }
+ else {
+ printf("Invalid number of arguments for %s cmd\n", argv[1]);
+ return COMMAND_ERROR_USAGE;
+ }
+ }
+ else if (!strcmp(argv[1], "init")) {
+ if (argc == 3) {
+ if (fan->ops->fan_init) {
+ ret = fan->ops->fan_init(fan->dev);
+ printf("Fan initialization: %s\n", ret >= 0 ? "successful" : "N/A");
+ }
+ }
+ else {
+ printf("Invalid number of arguments for %s cmd\n", argv[1]);
+ return COMMAND_ERROR_USAGE;
+ }
+ }
+ else {
+ printf("Invalid cmd: %s\n", argv[1]);
+ return COMMAND_ERROR_USAGE;
+ }
+
+ return ret;
+}
+
+BAREBOX_CMD_HELP_START(fan)
+BAREBOX_CMD_HELP_TEXT("cmd options:\n")
+BAREBOX_CMD_HELP_OPT("get", "get fan parameter")
+BAREBOX_CMD_HELP_OPT("set", "set fan parameter")
+BAREBOX_CMD_HELP_OPT("init", "initialize fan")
+
+BAREBOX_CMD_HELP_TEXT("\nparameter options:\n")
+BAREBOX_CMD_HELP_OPT("outmode", "fan controller ouptut mode [0 (adc)|1 (pwm)]")
+BAREBOX_CMD_HELP_OPT("clkdiv", "fan controller prescaler value [1|2|4|8]")
+BAREBOX_CMD_HELP_OPT("clkfreq", "input clock frequency (Hz)")
+BAREBOX_CMD_HELP_OPT("ppr", "fan tachometer pulses per revolution [2|4]")
+BAREBOX_CMD_HELP_OPT("ctrlmode", "fan control mode [0 (open-loop)|1 (closed-loop)]")
+BAREBOX_CMD_HELP_OPT("speed", "fan speed register value [0:255]")
+BAREBOX_CMD_HELP_OPT("rpm", "fan rpm [0:(max fan rpm)]")
+BAREBOX_CMD_HELP_OPT("level", "fan speed percentage [0:100]")
+BAREBOX_CMD_HELP_OPT("startv", "fan startup voltage [0|1|2|3]")
+BAREBOX_CMD_HELP_OPT("gearmult", "gear multiplier [0|1|2]")
+BAREBOX_CMD_HELP_OPT("pwmpol", "PWM polarity [0 (positive)|1 (negative)]")
+BAREBOX_CMD_HELP_OPT("faultdet", "enable/disable failure detection [0|1]")
+BAREBOX_CMD_HELP_OPT("oocdet", "enable/disable out-of-control detection [0|1]")
+BAREBOX_CMD_HELP_OPT("fault", "fan failure flag [0 (ok)|1 (fault)]")
+BAREBOX_CMD_HELP_OPT("ooc", "fan out of control flag [1 (ok):0 (ooc)]")
+BAREBOX_CMD_HELP_OPT("all", "print all fan parameters")
+BAREBOX_CMD_HELP_TEXT("\n")
+BAREBOX_CMD_HELP_END
+
+BAREBOX_CMD_START(fan)
+ .cmd = do_fan,
+ BAREBOX_CMD_DESC("fan management")
+ BAREBOX_CMD_OPTS("<cmd> <devpath> <parameter> [value]")
+ BAREBOX_CMD_GROUP(CMD_GRP_HWMANIP)
+ BAREBOX_CMD_HELP(cmd_fan_help)
+BAREBOX_CMD_END
\ No newline at end of file
--
2.47.3