|
@@ -40,13 +40,13 @@ struct Current_cmd_Proc Psu_cmd={
|
|
|
0x0E001C00,
|
|
|
};
|
|
|
|
|
|
-#define DEBUG 1
|
|
|
+#define DEBUG_LIB 0
|
|
|
|
|
|
-void PRINTF_FUNC(char *string, ...);
|
|
|
+void PRINTF_LIB_FUNC(char *string, ...);
|
|
|
|
|
|
-void PRINTF_FUNC(char *string, ...)
|
|
|
+void PRINTF_LIB_FUNC(char *string, ...)
|
|
|
{
|
|
|
- if (DEBUG)
|
|
|
+ if (DEBUG_LIB)
|
|
|
{
|
|
|
va_list args;
|
|
|
char buffer[4096];
|
|
@@ -121,7 +121,7 @@ int InitCanBus()
|
|
|
struct sockaddr_can addr0;
|
|
|
|
|
|
system("/sbin/ip link set can1 down");
|
|
|
- system("/sbin/ip link set can1 type can bitrate 125000 restart-ms 100");
|
|
|
+ system("/sbin/ip link set can1 type can bitrate 500000 restart-ms 100");
|
|
|
system("/sbin/ip link set can1 up");
|
|
|
|
|
|
s0 = socket(PF_CAN, SOCK_RAW, CAN_RAW);
|
|
@@ -131,21 +131,21 @@ int InitCanBus()
|
|
|
if (setsockopt(s0, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof(struct timeval)) < 0)
|
|
|
{
|
|
|
#ifdef SystemLogMessage
|
|
|
- PRINTF_FUNC("Set SO_RCVTIMEO NG");
|
|
|
+ PRINTF_LIB_FUNC("Set SO_RCVTIMEO NG");
|
|
|
#endif
|
|
|
}
|
|
|
nbytes=40960;
|
|
|
if (setsockopt(s0, SOL_SOCKET, SO_RCVBUF, &nbytes, sizeof(int)) < 0)
|
|
|
{
|
|
|
#ifdef SystemLogMessage
|
|
|
- PRINTF_FUNC("Set SO_RCVBUF NG");
|
|
|
+ PRINTF_LIB_FUNC("Set SO_RCVBUF NG");
|
|
|
#endif
|
|
|
}
|
|
|
nbytes=40960;
|
|
|
if (setsockopt(s0, SOL_SOCKET, SO_SNDBUF, &nbytes, sizeof(int)) < 0)
|
|
|
{
|
|
|
#ifdef SystemLogMessage
|
|
|
- PRINTF_FUNC("Set SO_SNDBUF NG");
|
|
|
+ PRINTF_LIB_FUNC("Set SO_SNDBUF NG");
|
|
|
#endif
|
|
|
}
|
|
|
|
|
@@ -184,8 +184,8 @@ void ReceiveDataFromCanBus()
|
|
|
|
|
|
if(target == 0xF0)
|
|
|
{
|
|
|
-
|
|
|
-
|
|
|
+
|
|
|
+
|
|
|
|
|
|
switch (intCmd)
|
|
|
{
|
|
@@ -239,7 +239,7 @@ void ReceiveDataFromCanBus()
|
|
|
((word) frame.data[0] * 256 ) + (word) frame.data[1],
|
|
|
((word) frame.data[2] * 256 ) + (word) frame.data[3]);
|
|
|
}
|
|
|
-
|
|
|
+
|
|
|
break;
|
|
|
|
|
|
case INFYPWR_GET_MISC_INFO_MSG:
|
|
@@ -250,7 +250,7 @@ void ReceiveDataFromCanBus()
|
|
|
((word) frame.data[0] * 256 ) + (word) frame.data[1],
|
|
|
(((int) frame.data[4] << 24) + ((int) frame.data[5] << 16) + ((int) frame.data[6] << 8) + (int) frame.data[7]) & 0x00ffffff);
|
|
|
}
|
|
|
-
|
|
|
+
|
|
|
break;
|
|
|
|
|
|
|
|
@@ -350,7 +350,7 @@ bool InitialCommunication()
|
|
|
|
|
|
if(CanFd < 0)
|
|
|
{
|
|
|
- PRINTF_FUNC("Init can bus fail.\n");
|
|
|
+ PRINTF_LIB_FUNC("Init can bus fail.\n");
|
|
|
return false;
|
|
|
}
|
|
|
|
|
@@ -361,7 +361,7 @@ bool InitialCommunication()
|
|
|
}
|
|
|
else if(recFork > 0)
|
|
|
{
|
|
|
- PRINTF_FUNC("fork fail\n");
|
|
|
+ PRINTF_LIB_FUNC("fork fail\n");
|
|
|
}
|
|
|
|
|
|
return true;
|
|
@@ -380,7 +380,7 @@ void RequestModuleTotalMumbert(void)
|
|
|
|
|
|
void PsuAddressAssignment(byte phy_addr, byte group)
|
|
|
{
|
|
|
- PRINTF_FUNC("phy_addr = %d, group = %d \n", phy_addr, group);
|
|
|
+ PRINTF_LIB_FUNC("phy_addr = %d, group = %d \n", phy_addr, group);
|
|
|
uint cmd = INFYPWR_MODULE_CMD | INFYPWR_SET_GROUP_ASSINGMENT_MSG | (phy_addr << 8) | INFYPWR_MASTER_TXID;
|
|
|
|
|
|
byte data[8];
|
|
@@ -393,7 +393,7 @@ void PsuAddressAssignment(byte phy_addr, byte group)
|
|
|
void GetStatus(byte group, byte address)
|
|
|
{
|
|
|
|
|
|
-
|
|
|
+
|
|
|
uint cmd;
|
|
|
byte data[8];
|
|
|
|
|
@@ -491,7 +491,7 @@ void SetMiscInfo(byte group, byte address, unsigned short CmdType, unsigned int
|
|
|
int cmd;
|
|
|
byte data[8];
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
memset(data, 0x00, ARRAY_SIZE(data));
|
|
|
|
|
@@ -513,13 +513,13 @@ void SetMiscInfo(byte group, byte address, unsigned short CmdType, unsigned int
|
|
|
if(group == SET_GROUP_CMD)
|
|
|
{
|
|
|
cmd = INFYPWR_GROUP_CMD | INFYPWR_SET_MISC_INFO_MSG | (address << 8) | INFYPWR_MASTER_TXID;
|
|
|
-
|
|
|
+
|
|
|
}
|
|
|
|
|
|
else
|
|
|
{
|
|
|
cmd = INFYPWR_MODULE_CMD | INFYPWR_SET_MISC_INFO_MSG | (address << 8) | INFYPWR_MASTER_TXID;
|
|
|
-
|
|
|
+
|
|
|
}
|
|
|
|
|
|
SendCmdToPsu(cmd, data, sizeof(data));
|
|
@@ -527,7 +527,7 @@ void SetMiscInfo(byte group, byte address, unsigned short CmdType, unsigned int
|
|
|
|
|
|
void GetPresentInputVol(byte group, byte address)
|
|
|
{
|
|
|
-
|
|
|
+
|
|
|
|
|
|
uint cmd;
|
|
|
byte data[8];
|
|
@@ -570,7 +570,7 @@ void GetAvailableCap(byte group, byte address, short _outputVol)
|
|
|
|
|
|
void GetPresentOutput(byte group, byte address)
|
|
|
{
|
|
|
-
|
|
|
+
|
|
|
int cmd;
|
|
|
byte data[8];
|
|
|
|
|
@@ -597,13 +597,13 @@ void SetPresentOutput(byte group, byte address, float vol, float cur, float Avai
|
|
|
|
|
|
|
|
|
|
|
|
-
|
|
|
-
|
|
|
+
|
|
|
+
|
|
|
|
|
|
uint vol2 = vol * 100;
|
|
|
uint cur2 = cur * 100;
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
|
|
|
data[0] = (vol2 >> 24) & 0xff;
|
|
@@ -621,7 +621,7 @@ void SetPresentOutput(byte group, byte address, float vol, float cur, float Avai
|
|
|
|
|
|
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
|
|
|
|
|
@@ -646,10 +646,10 @@ void SetPresentOutput(byte group, byte address, float vol, float cur, float Avai
|
|
|
|
|
|
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
|
|
|
- PRINTF_FUNC("typecmd = %02x, addr = %02x ,vol = %d, tot_Amp = %f, need_cur = %d, \n",
|
|
|
+ PRINTF_LIB_FUNC("typecmd = %02x, addr = %02x ,vol = %d, tot_Amp = %f, need_cur = %d, \n",
|
|
|
group, address, vol2, AvailableCur, cur2);
|
|
|
SendCmdToPsu(cmd, data, sizeof(data));
|
|
|
}
|
|
@@ -671,13 +671,13 @@ void EnableGreenLedFlash(byte group, byte address, byte value)
|
|
|
|
|
|
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
|
|
|
SendCmdToPsu(cmd, data, sizeof(data));
|
|
@@ -700,13 +700,13 @@ void EnableWalkInMode(byte group, byte address, byte value)
|
|
|
if(group == SET_GROUP_CMD)
|
|
|
{
|
|
|
cmd = INFYPWR_GROUP_CMD | INFYPWR_SET_WALKIN_MODE_MSG | (address << 8) | INFYPWR_MASTER_TXID;
|
|
|
-
|
|
|
+
|
|
|
}
|
|
|
|
|
|
else
|
|
|
{
|
|
|
cmd = INFYPWR_MODULE_CMD | INFYPWR_SET_WALKIN_MODE_MSG | (address << 8) | INFYPWR_MASTER_TXID;
|
|
|
-
|
|
|
+
|
|
|
}
|
|
|
|
|
|
SendCmdToPsu(cmd, data, sizeof(data));
|
|
@@ -729,13 +729,13 @@ void EnableSleepMode(byte group, byte address, byte value)
|
|
|
if(group == SET_GROUP_CMD)
|
|
|
{
|
|
|
cmd = INFYPWR_GROUP_CMD | INFYPWR_SET_SLEEP_MODE_MSG | (address << 8) | INFYPWR_MASTER_TXID;
|
|
|
-
|
|
|
+
|
|
|
}
|
|
|
|
|
|
else
|
|
|
{
|
|
|
cmd = INFYPWR_MODULE_CMD | INFYPWR_SET_SLEEP_MODE_MSG | (address << 8) | INFYPWR_MASTER_TXID;
|
|
|
-
|
|
|
+
|
|
|
}
|
|
|
|
|
|
SendCmdToPsu(cmd, data, sizeof(data));
|
|
@@ -770,7 +770,7 @@ void EnableOutputPower(byte group, byte address, byte value)
|
|
|
int cmd;
|
|
|
byte data[8];
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
memset(data, 0x00, ARRAY_SIZE(data));
|
|
|
|
|
@@ -786,13 +786,13 @@ void EnableOutputPower(byte group, byte address, byte value)
|
|
|
|
|
|
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
-
|
|
|
+
|
|
|
|
|
|
|
|
|
SendCmdToPsu(cmd, data, sizeof(data));
|