[PATCH skeleton v10 19/22] Support FAN LED feature

OpenBMC Patches openbmc-patches at stwcx.xyz
Wed May 11 13:20:49 AEST 2016


From: johnhcwang <hsienchiang at gmail.com>

---
 objects/fan_algorithm.c | 475 ++++++++++++++++++++++++++----------------------
 1 file changed, 261 insertions(+), 214 deletions(-)

diff --git a/objects/fan_algorithm.c b/objects/fan_algorithm.c
index 9665860..9bb3f4c 100755
--- a/objects/fan_algorithm.c
+++ b/objects/fan_algorithm.c
@@ -6,45 +6,59 @@
 #include "i2c-dev.h"
 #include "log.h"
 
+
+#define NUM_DIMM	32
+#define NUM_FAN		12
+#define NUM_CPU_CORE	12
+#define NUM_PWM		6
+
 const char *gService = "org.openbmc.Sensors";
 const char *fanService = "org.openbmc.control.Fans";
-
-const char *gfanflagObjPath = "/org/openbmc/sensors/FanParameter/flag";
-const char *gfanCPUvaribleObjPath = "/org/openbmc/sensors/FanParameter/flag";
-const char *gfanDIMMvaribleObjPath = "/org/openbmc/sensors/FanParameter/flag";
-			
-const char *gfanpidObjPath [3] = {"/org/openbmc/sensors/FanParameter/Kp",
-							      "/org/openbmc/sensors/FanParameter/Ki",
-							      "/org/openbmc/sensors/FanParameter/Kd"};
-
-
-const char *gCPU0ObjPath [12] = {"/org/openbmc/sensors/temperature/cpu0/core0",
-								 "/org/openbmc/sensors/temperature/cpu0/core1",
-								 "/org/openbmc/sensors/temperature/cpu0/core2",
-								 "/org/openbmc/sensors/temperature/cpu0/core3",
-								 "/org/openbmc/sensors/temperature/cpu0/core4",
-								 "/org/openbmc/sensors/temperature/cpu0/core5",
-								 "/org/openbmc/sensors/temperature/cpu0/core6",
-								 "/org/openbmc/sensors/temperature/cpu0/core7",
-								 "/org/openbmc/sensors/temperature/cpu0/core8",
-								 "/org/openbmc/sensors/temperature/cpu0/core9",
-								 "/org/openbmc/sensors/temperature/cpu0/core10",
-								 "/org/openbmc/sensors/temperature/cpu0/core11"};
+const char *gService_Power = "org.openbmc.control.Chassis";
+const char *gObjPath_Power = "/org/openbmc/control/chassis0";
+const char *gIntPath_Power = "org.openbmc.control.Chassis";
+
+const char *fanInObjPath [NUM_FAN] = {"/org/openbmc/sensors/tach/fan0H",
+				"/org/openbmc/sensors/tach/fan0L",
+				"/org/openbmc/sensors/tach/fan1H",
+				"/org/openbmc/sensors/tach/fan1L",
+				"/org/openbmc/sensors/tach/fan2H",
+				"/org/openbmc/sensors/tach/fan2L",
+				"/org/openbmc/sensors/tach/fan3H",
+				"/org/openbmc/sensors/tach/fan3L",
+				"/org/openbmc/sensors/tach/fan4H",
+				"/org/openbmc/sensors/tach/fan4L",
+				"/org/openbmc/sensors/tach/fan5H",
+				"/org/openbmc/sensors/tach/fan5L",
+				};
+
+const char *gCPU0ObjPath[NUM_CPU_CORE] = {"/org/openbmc/sensors/temperature/cpu0/core0",
+						 "/org/openbmc/sensors/temperature/cpu0/core1",
+						 "/org/openbmc/sensors/temperature/cpu0/core2",
+						 "/org/openbmc/sensors/temperature/cpu0/core3",
+						 "/org/openbmc/sensors/temperature/cpu0/core4",
+						 "/org/openbmc/sensors/temperature/cpu0/core5",
+						 "/org/openbmc/sensors/temperature/cpu0/core6",
+						 "/org/openbmc/sensors/temperature/cpu0/core7",
+						 "/org/openbmc/sensors/temperature/cpu0/core8",
+						 "/org/openbmc/sensors/temperature/cpu0/core9",
+						 "/org/openbmc/sensors/temperature/cpu0/core10",
+						 "/org/openbmc/sensors/temperature/cpu0/core11"};
 								
-const char *gCPU1ObjPath [12] = {"/org/openbmc/sensors/temperature/cpu0/core0",
-								 "/org/openbmc/sensors/temperature/cpu0/core1",
-								 "/org/openbmc/sensors/temperature/cpu0/core2",
-								 "/org/openbmc/sensors/temperature/cpu0/core3",
-								 "/org/openbmc/sensors/temperature/cpu0/core4",
-								 "/org/openbmc/sensors/temperature/cpu0/core5",
-								 "/org/openbmc/sensors/temperature/cpu0/core6",
-								 "/org/openbmc/sensors/temperature/cpu0/core7",
-								 "/org/openbmc/sensors/temperature/cpu0/core8",
-								 "/org/openbmc/sensors/temperature/cpu0/core9",
-								 "/org/openbmc/sensors/temperature/cpu0/core10",
-								 "/org/openbmc/sensors/temperature/cpu0/core11"};
-
-const char *gDIMMObjPath [32] = {"/org/openbmc/sensors/temperature/dimm0",
+const char *gCPU1ObjPath[NUM_CPU_CORE] = {"/org/openbmc/sensors/temperature/cpu1/core0",
+						 "/org/openbmc/sensors/temperature/cpu1/core1",
+						 "/org/openbmc/sensors/temperature/cpu1/core2",
+						 "/org/openbmc/sensors/temperature/cpu1/core3",
+						 "/org/openbmc/sensors/temperature/cpu1/core4",
+						 "/org/openbmc/sensors/temperature/cpu1/core5",
+						 "/org/openbmc/sensors/temperature/cpu1/core6",
+						 "/org/openbmc/sensors/temperature/cpu1/core7",
+						 "/org/openbmc/sensors/temperature/cpu1/core8",
+						 "/org/openbmc/sensors/temperature/cpu1/core9",
+						 "/org/openbmc/sensors/temperature/cpu1/core10",
+						 "/org/openbmc/sensors/temperature/cpu1/core11"};
+
+const char *gDIMMObjPath [NUM_DIMM] = {"/org/openbmc/sensors/temperature/dimm0",
 								 "/org/openbmc/sensors/temperature/dimm1",
 								 "/org/openbmc/sensors/temperature/dimm2",
 								 "/org/openbmc/sensors/temperature/dimm3",
@@ -91,22 +105,6 @@ const char *fanObjPath [6] ={"/org/openbmc/sensors/speed/fan0",
 const char *gIntPath = "org.openbmc.SensorValue";
 
 
-char *gMessage = NULL;
-
-#define MAX_BYTES 255
-
-int g_use_pec = 0;
-int g_has_write = 1;
-int g_n_write = 0;
-uint8_t g_write_bytes[MAX_BYTES];
-uint8_t g_write_color_bytes[MAX_BYTES];
-
-int g_has_read = 1;
-int g_n_read = -1;
-uint8_t g_read_bytes[MAX_BYTES];
-uint8_t g_read_tmp[MAX_BYTES];
-uint8_t g_bus = -1;
-uint8_t g_slave_addr = 0xff;
 double g_Kp = 0.7;
 double g_Ki = -0.025;
 double g_Kd = 1.0;
@@ -120,18 +118,16 @@ int Interal_DIMM_Err[20]={0};
 
 int g_fanspeed = 0;
 
-
 int Openloopspeed = 0;
 int Closeloopspeed = 0;
 int Finalfanspeed = 0;
 
-static int i2c_open()
+static int i2c_open(int bus)
 {
 	int rc = 0, fd = -1;
 	char fn[32];
 
-	g_bus = 6;
-	snprintf(fn, sizeof(fn), "/dev/i2c-%d", g_bus);
+	snprintf(fn, sizeof(fn), "/dev/i2c-%d", bus);
 	fd = open(fn, O_RDWR);
 	if (fd == -1) {
 		LOG_ERR(errno, "Failed to open i2c device %s", fn);
@@ -141,48 +137,30 @@ static int i2c_open()
 	return fd;
 }
 
-static int SetFanLed(int fd,int color)
+#define CMD_OUTPUT_PORT_0 2
+#define PCA9535_ADDR 0x20
+static int SetFanLed(int fd, uint8_t port0, uint8_t port1)
 {
 	struct i2c_rdwr_ioctl_data data;
-	struct i2c_msg msg[2];
-	int rc = 0, n_msg = 0;
+	struct i2c_msg msg[1];
+	int rc = 0, use_pec = 0;
+	uint8_t write_bytes[3];
 
-	memset(&msg, 0, sizeof(msg));
+//	fprintf(stderr,"SetFanLed: port0 = %02X,port1 = %02X\n",port0,port1);
 
-	g_slave_addr = 0x20;
-	g_use_pec = 0;
-	g_n_write = 2;
+	memset(&msg, 0, sizeof(msg));
 
-	if(color == 1) {
-		//blue light
-		g_write_bytes[0] = 0x03;
-		g_write_bytes[1] = 0x55;
-		g_write_color_bytes[0] = 0x02;
-		g_write_color_bytes[1] = 0xaa;
-	} else {
-		//red light
-		g_write_bytes[0] = 0x03;
-		g_write_bytes[1] = 0xaa;
-		g_write_color_bytes[0] = 0x02;
-		g_write_color_bytes[1] = 0x55;
-	}
+	write_bytes[0] = CMD_OUTPUT_PORT_0;
+	write_bytes[1] = port0;
+	write_bytes[2] = port1;
   
-	if (1) {
-		msg[n_msg].addr = g_slave_addr;
-		msg[n_msg].flags = (g_use_pec) ? I2C_CLIENT_PEC : 0;
-		msg[n_msg].len = g_n_write;
-		msg[n_msg].buf = g_write_bytes;
-		n_msg++;
-	}
-	 if (1) {
-		msg[n_msg].addr = g_slave_addr;
-		msg[n_msg].flags = (g_use_pec) ? I2C_CLIENT_PEC : 0;
-		msg[n_msg].len = g_n_write;
-		msg[n_msg].buf = g_write_color_bytes;
-		n_msg++;
-	}
+	msg[0].addr = PCA9535_ADDR;
+	msg[0].flags = (use_pec) ? I2C_CLIENT_PEC : 0;
+	msg[0].len = sizeof(write_bytes);
+	msg[0].buf = write_bytes;
+
 	data.msgs = msg;
-	data.nmsgs = n_msg;
+	data.nmsgs = 1;
 	rc = ioctl(fd, I2C_RDWR, &data);
 	if (rc < 0) {
 		LOG_ERR(errno, "Failed to do raw io");
@@ -302,22 +280,26 @@ int OpenLoop (int sensorreading)
 	return 0;
 }
 
-
+#define FAN_LED_OFF     0xFF
+#define FAN_LED_PORT0_ALL_BLUE  0xAA
+#define FAN_LED_PORT1_ALL_BLUE  0x55
+#define FAN_LED_PORT0_ALL_RED   0x55
+#define FAN_LED_PORT1_ALL_RED   0xAA
+#define PORT0_FAN_LED_RED_MASK  0x02
+#define PORT0_FAN_LED_BLUE_MASK	0x01
+#define PORT1_FAN_LED_RED_MASK  0x40
+#define PORT1_FAN_LED_BLUE_MASK	0x80
 int Fan_control_algorithm(void)
 {
 	sd_bus *bus = NULL;
 	sd_bus_error bus_error = SD_BUS_ERROR_NULL;
 	sd_bus_message *response = NULL;
-	int Ambient_reading = 0, rc = 0, i = 0;
-	int CPU0_core_temperature[12];
-	int CPU1_core_temperature[12];
-	int DIMM_temperature[32];
-	int HighestCPUtemp = 0;
-	int HighestDIMMtemp = 0;
-	int CPUnocore[2];
-	int fd = -1;
-	int FinalFanSpeed = 0;
-	int CPUtemp = 0;
+	int rc = 0, i = 0, fd = -1, offset = 0;
+	int CPU0_core_temperature[NUM_CPU_CORE], CPU1_core_temperature[NUM_CPU_CORE], HighestCPUtemp = 0;
+	int DIMM_temperature[NUM_DIMM], HighestDIMMtemp = 0;
+	int Ambient_reading = 0;
+	int Fan_tach[NUM_FAN], FinalFanSpeed = 255;
+	int Power_state = 0, fan_led_port0 = 0xFF, fan_led_port1 = 0xFF;
 	
 	do {
 		/* Connect to the user bus this time */
@@ -330,147 +312,209 @@ int Fan_control_algorithm(void)
 	} while (rc < 0);
 
 	while (1) {
-		CPUtemp = 0;
-		for(i=0; i<12; i++) {
-			rc = sd_bus_call_method(bus,                   // On the System Bus
-						gService,               // Service to contact
-						gCPU0ObjPath[i],            // Object path
-						gIntPath,              // Interface name
-						"getValue",          // Method to be called
-						&bus_error,                 // object to return error
-						&response,                  // Response message on success
-						NULL);                       // input message (string,byte)
-			if(rc < 0) {
-//				fprintf(stderr, "Failed to get CPU 0 temperature from dbus: %s\n", bus_error.message);
-				CPU0_core_temperature[i] = 0;
-			} else {
-				rc = sd_bus_message_read(response, "v","i", &CPU0_core_temperature[i]);
-				if (rc < 0 ) {
-					fprintf(stderr, "Failed to parse GetCpu0Temp response message:[%s]\n", strerror(-rc));
+		rc = sd_bus_call_method(bus,					// On the System Bus
+					gService_Power,				// Service to contact
+					gObjPath_Power,			 // Object path
+					gIntPath_Power,			   // Interface name
+					"getPowerState",			// Method to be called
+					&bus_error,				  // object to return error
+					&response,				  // Response message on success
+					NULL);					   // input message (string,byte)
+		if(rc < 0) {
+			fprintf(stderr, "Failed to get power state from dbus: %s\n", bus_error.message);
+			goto finish;
+		}
+
+		rc = sd_bus_message_read(response, "i", &Power_state);
+		if (rc < 0 ) {
+			fprintf(stderr, "Failed to parse GetPowerState response message:[%s]\n", strerror(-rc));
+			goto finish;
+		}
+		sd_bus_error_free(&bus_error);
+		response = sd_bus_message_unref(response);
+//		fprintf(stderr,"Power State = [%d]\n",Power_state);
+
+		if (Power_state == 1 ) {
+			for(i=0; i<NUM_CPU_CORE; i++) {
+				rc = sd_bus_call_method(bus,                   // On the System Bus
+							gService,               // Service to contact
+							gCPU0ObjPath[i],            // Object path
+							gIntPath,              // Interface name
+							"getValue",          // Method to be called
+							&bus_error,                 // object to return error
+							&response,                  // Response message on success
+							NULL);                       // input message (string,byte)
+				if(rc < 0) {
+//					fprintf(stderr, "Failed to get CPU 0 temperature from dbus: %s\n", bus_error.message);
 					CPU0_core_temperature[i] = 0;
+				} else {
+					rc = sd_bus_message_read(response, "v","i", &CPU0_core_temperature[i]);
+					if (rc < 0 ) {
+						fprintf(stderr, "Failed to parse GetCpu0Temp response message:[%s]\n", strerror(-rc));
+						CPU0_core_temperature[i] = 0;
+					}
 				}
+//				fprintf(stderr, "CPU0 core %d temperature is %d\n",i ,CPU0_core_temperature[i]);
+				if(CPU0_core_temperature[i] > HighestCPUtemp)
+					HighestCPUtemp = CPU0_core_temperature[i];
+
+				sd_bus_error_free(&bus_error);
+				response = sd_bus_message_unref(response);
 			}
-//			fprintf(stderr, "CPU0 core %d temperature is %d\n",i ,CPU0_core_temperature[i]);
-			if(CPU0_core_temperature[i] > HighestCPUtemp) {
-				HighestCPUtemp = CPU0_core_temperature[i];
-				CPUnocore[0] = 0;
-				CPUnocore[1] = i;
-			}
-			CPUtemp = CPUtemp + CPU0_core_temperature[i];
-			sd_bus_error_free(&bus_error);
-			response = sd_bus_message_unref(response);
-		}
 
-		for(i=0; i<12; i++) {
-			rc = sd_bus_call_method(bus,                   // On the System Bus
-						gService,               // Service to contact
-						gCPU1ObjPath[i],            // Object path
-						gIntPath,              // Interface name
-						"getValue",          // Method to be called
-						&bus_error,                 // object to return error
-						&response,                  // Response message on success
-						NULL);                       // input message (string,byte)
-			if(rc < 0) {
-//				fprintf(stderr, "Failed to get CPU 1 temperature from dbus: %s\n", bus_error.message);
-				CPU1_core_temperature[i] = 0;
-			} else {
-				rc = sd_bus_message_read(response, "v","i", &CPU1_core_temperature[i]);
-				if (rc < 0 ) {
-					fprintf(stderr, "Failed to parse GetCpu1Temp response message:[%s]\n", strerror(-rc));
+			for(i=0; i<NUM_CPU_CORE; i++) {
+				rc = sd_bus_call_method(bus,                   // On the System Bus
+							gService,               // Service to contact
+							gCPU1ObjPath[i],            // Object path
+							gIntPath,              // Interface name
+							"getValue",          // Method to be called
+							&bus_error,                 // object to return error
+							&response,                  // Response message on success
+							NULL);                       // input message (string,byte)
+				if(rc < 0) {
+//					fprintf(stderr, "Failed to get CPU 1 temperature from dbus: %s\n", bus_error.message);
 					CPU1_core_temperature[i] = 0;
+				} else {
+					rc = sd_bus_message_read(response, "v","i", &CPU1_core_temperature[i]);
+					if (rc < 0 ) {
+						fprintf(stderr, "Failed to parse GetCpu1Temp response message:[%s]\n", strerror(-rc));
+						CPU1_core_temperature[i] = 0;
+					}
 				}
+//				fprintf(stderr, "CPU1 core %d temperature is %d\n",i ,CPU1_core_temperature[i]);
+				if(CPU1_core_temperature[i] > HighestCPUtemp )
+					HighestCPUtemp = CPU1_core_temperature[i];
+
+				sd_bus_error_free(&bus_error);
+				response = sd_bus_message_unref(response);
 			}
-//			fprintf(stderr, "CPU1 core %d temperature is %d\n",i ,CPU1_core_temperature[i]);
-			if(CPU1_core_temperature[i] > HighestCPUtemp ) {
-				HighestCPUtemp = CPU1_core_temperature[i];
-				CPUnocore[0] = 1;
-				CPUnocore[1] = i;
-			}
-			sd_bus_error_free(&bus_error);
-			response = sd_bus_message_unref(response);
-		}
-//		fprintf(stderr, "Highest CPU temperature = [%d]\n", HighestCPUtemp);
-	
-		for(i=0; i<32; i++) {
+//			fprintf(stderr, "Highest CPU temperature = [%d]\n", HighestCPUtemp);
+
 			rc = sd_bus_call_method(bus,                   // On the System Bus
 						gService,               // Service to contact
-						gDIMMObjPath[i],            // Object path
+						gObjPath_Ambient,            // Object path
 						gIntPath,              // Interface name
 						"getValue",          // Method to be called
 						&bus_error,                 // object to return error
 						&response,                  // Response message on success
 						NULL);                       // input message (string,byte)
 			if(rc < 0) {
-//				fprintf(stderr, "Failed to get DIMM temperature from dbus: %s\n", bus_error.message);
-				DIMM_temperature[i] = 0;
+				fprintf(stderr, "Failed to get ambient temperature from dbus: %s\n", bus_error.message);
+				Ambient_reading = 0;
 			} else {
-				rc = sd_bus_message_read(response, "v","i", &DIMM_temperature[i]);
+				rc = sd_bus_message_read(response, "v","i", &Ambient_reading);
 				if (rc < 0 ) {
 					fprintf(stderr, "Failed to parse GetDimmTemp response message:[%s]\n", strerror(-rc));
-					DIMM_temperature[i] = 0;
+					Ambient_reading = 0;
 				}
 			}
-//			fprintf(stderr, "DIMM %d temperature is %d\n", i, DIMM_temperature[i]);
-			if(DIMM_temperature[i] > HighestDIMMtemp )
-				HighestDIMMtemp = DIMM_temperature[i];
 			sd_bus_error_free(&bus_error);
 			response = sd_bus_message_unref(response);
-		}
-//		fprintf(stderr, "Highest DIMM temperature = [%d]\n",HighestDIMMtemp);
-
-		rc = sd_bus_call_method(bus,                   // On the System Bus
-					gService,               // Service to contact
-					gObjPath_Ambient,            // Object path
-					gIntPath,              // Interface name
-					"getValue",          // Method to be called
-					&bus_error,                 // object to return error
-					&response,                  // Response message on success
-					NULL);                       // input message (string,byte)
-		if(rc < 0) {
-//			fprintf(stderr, "Failed to get ambient temperature from dbus: %s\n", bus_error.message);
-			Ambient_reading = 0;
-		} else {
-			rc = sd_bus_message_read(response, "v","i", &Ambient_reading);
-			if (rc < 0 ) {
-				fprintf(stderr, "Failed to parse GetDimmTemp response message:[%s]\n", strerror(-rc));
-				Ambient_reading = 0;
-			}
-		}
-		sd_bus_error_free(&bus_error);
-		response = sd_bus_message_unref(response);
-//		fprintf(stderr, "Highest ambient inlet temperature = [%d]\n", HighestCPUtemp);
+//			fprintf(stderr, "Highest ambient inlet temperature = [%d]\n", HighestCPUtemp);
+
+			if (HighestCPUtemp > 0 && Ambient_reading > 0) {
+				for(i=0; i<NUM_DIMM; i++) {
+					rc = sd_bus_call_method(bus,                   // On the System Bus
+								gService,               // Service to contact
+								gDIMMObjPath[i],            // Object path
+								gIntPath,              // Interface name
+								"getValue",          // Method to be called
+								&bus_error,                 // object to return error
+								&response,                  // Response message on success
+								NULL);                       // input message (string,byte)
+					if(rc < 0) {
+//						fprintf(stderr, "Failed to get DIMM temperature from dbus: %s\n", bus_error.message);
+						DIMM_temperature[i] = 0;
+					} else {
+						rc = sd_bus_message_read(response, "v","i", &DIMM_temperature[i]);
+						if (rc < 0 ) {
+							fprintf(stderr, "Failed to parse GetDimmTemp response message:[%s]\n", strerror(-rc));
+							DIMM_temperature[i] = 0;
+						}
+					}
+//					fprintf(stderr, "DIMM %d temperature is %d\n", i, DIMM_temperature[i]);
+					if(DIMM_temperature[i] > HighestDIMMtemp )
+						HighestDIMMtemp = DIMM_temperature[i];
+					sd_bus_error_free(&bus_error);
+					response = sd_bus_message_unref(response);
+				}
+//				fprintf(stderr, "Highest DIMM temperature = [%d]\n",HighestDIMMtemp);
 
-		if (CPUtemp == 0)	{
-			HighestCPUtemp = 0;
-			HighestDIMMtemp = 0;
-		}
+				CloseLoop(HighestCPUtemp,HighestDIMMtemp);
+				OpenLoop(Ambient_reading);
 
-		CloseLoop(HighestCPUtemp,HighestDIMMtemp);
-		OpenLoop(Ambient_reading);
+				if(Openloopspeed > Closeloopspeed)
+					g_fanspeed = Openloopspeed;
+				else
+					g_fanspeed = Closeloopspeed;
 
-		if(Openloopspeed > Closeloopspeed)
-			g_fanspeed = Openloopspeed;
-		else
-			g_fanspeed = Closeloopspeed;
-	
-		fd = i2c_open();
-		if (fd == -1) {
-			fprintf(stderr, "Fail to set FAN LED\n");
-		} else {
-			if(g_fanspeed > 30)
-				SetFanLed(fd,1);
-			else
-				SetFanLed(fd,2);
-			close(fd);
-		}
+				FinalFanSpeed = g_fanspeed * 255;
+				FinalFanSpeed = FinalFanSpeed / 100;
 
-		FinalFanSpeed = g_fanspeed * 255;
-		FinalFanSpeed = FinalFanSpeed / 100;
+				if(g_fanspeed > 30) {
+					fan_led_port0 = FAN_LED_PORT0_ALL_BLUE;
+					fan_led_port1 = FAN_LED_PORT1_ALL_BLUE;
+				} else {
+					fan_led_port0 = FAN_LED_PORT0_ALL_RED;
+					fan_led_port1 = FAN_LED_PORT1_ALL_RED;
+				}
+			} else {//HighestCPUtemp == 0 || Ambient_reading == 0
+				FinalFanSpeed = 255;
+				fan_led_port0 = FAN_LED_PORT0_ALL_BLUE;
+				fan_led_port1 = FAN_LED_PORT1_ALL_BLUE;
+			}
 
-		if(HighestCPUtemp == 0) //OCC sensor does not enable
+//			fprintf(stderr,"fan_led compute: port0=%02X,port1=%02X\n",fan_led_port0,fan_led_port1);
+			for(i=0;i<NUM_FAN;i++) {
+				rc = sd_bus_call_method(bus,                               // On the System Bus
+							gService,                               // Service to contact
+							fanInObjPath[i],                        // Object path
+							gIntPath,                          // Interface name
+							"getValue",              // Method to be called
+							&bus_error,                             // object to return error
+							&response,                                      // Response message on success
+							NULL);                                           // input message (string,byte)
+				if(rc < 0) {
+					fprintf(stderr, "Failed to get fan tach from dbus: %s\n", bus_error.message);
+					Fan_tach[i] = 0;
+				} else {
+					rc = sd_bus_message_read(response, "v","i", &Fan_tach[i]);
+					if (rc < 0 ) {
+						fprintf(stderr, "Failed to parse GetFanTach response message:[%s]\n", strerror(-rc));
+						Fan_tach[i] = 0;
+					}
+				}
+				sd_bus_error_free(&bus_error);
+				response = sd_bus_message_unref(response);
+
+				if (Fan_tach[i] == 0) {
+					FinalFanSpeed = 255;
+					if (i <= 3) { //FAN 1 & 2
+						offset = i / 2 * 2;
+						fan_led_port1 &= ~(PORT1_FAN_LED_RED_MASK >> offset); //turn on red led
+						fan_led_port1 |= PORT1_FAN_LED_BLUE_MASK >> offset; //turn off blue led
+//						fprintf(stderr,"i=%d,offset=%d,fan_led_port1=%02X\n",i,offset,fan_led_port1);
+					} else { //FAN 3~6
+						offset = (i - 4) / 2 * 2;
+						fan_led_port0 &= ~(PORT0_FAN_LED_RED_MASK << offset); //turn on red led
+						fan_led_port0 |= PORT0_FAN_LED_BLUE_MASK << offset; //turn off blue led
+//						fprintf(stderr,"i=%d,offset=%d,fan_led_port0=%02X\n",i,offset,fan_led_port0);
+					}
+				}
+			}
+		} else {//Power_state == 0
 			FinalFanSpeed = 255;
+			fan_led_port0 = FAN_LED_OFF;
+			fan_led_port1 = FAN_LED_OFF;
+		}
+
+		fd = i2c_open(6);
+		if (fd != -1) {
+			SetFanLed(fd,fan_led_port0,fan_led_port1);
+			close(fd);
+		}
 
-		for(i=0; i<6; i++) {
+		for(i=0; i<NUM_PWM; i++) {
 			rc = sd_bus_call_method(bus,				   // On the System Bus
 						gService,			   // Service to contact
 						fanObjPath[i],			// Object path
@@ -490,6 +534,9 @@ finish:
 		sd_bus_error_free(&bus_error);
 		response = sd_bus_message_unref(response);
 		sd_bus_flush(bus);
+		HighestCPUtemp = 0;
+		HighestDIMMtemp = 0;
+		Ambient_reading = 0;
 		sleep(1);
 	}
 	bus = sd_bus_flush_close_unref(bus);
-- 
2.8.1




More information about the openbmc mailing list