+#include <string.h>
#include <stdio.h>
+#include "i2c.h"
+#include "chassis.h"
#include "ipmb.h"
uint8_t ipmb_csum(unsigned char *buf, int len)
return -csum;
}
-void decode_ipmb_pkt(unsigned char *buf, int len)
+void ipmb_send(struct ipmb_resp *resp)
{
+ unsigned char buf[24];
+ int len;
+#ifdef DEBUG
int i;
- struct ipmb_req req;
+#endif
- req.rsSA = buf[0];
- req.netFn = (buf[1]>>2)&0x3f;
- req.rsLUN = (buf[1] & 0x03);
- req.rqSA = buf[3];
- req.rqSEQ = (buf[4]>>2)&0x3f;
- req.rqLUN = (buf[4] & 0x03);
- req.cmd = buf[5];
- req.data = buf+6;
- req.datalen = len - 6 - 1;
+ buf[0] = resp->rqSA;
+ buf[1] = ((resp->netFn)<<2) | (resp->rqLUN & 0x3);
+ buf[2] = ipmb_csum(buf, 2);
+ buf[3] = resp->rsSA;
+ buf[4] = ((resp->rqSEQ)<<2) | (resp->rsLUN & 0x3);
+ buf[5] = resp->cmd;
+ memcpy(buf+6, resp->data, resp->datalen);
+ len = resp->datalen + 7;
+ buf[len-1] = ipmb_csum(buf+3, len - 4);
+
+#ifdef DEBUG
+ printf("Sending: ");
+ for(i = 0; i < len; i++) {
+ printf("0x%02x ", buf[i]);
+ }
+ printf("\n");
+#endif
+
+ i2c_send(buf, len);
+
+}
+
+#ifdef DEBUG
+void ipmb_dump_req(struct ipmb_req *req)
+{
+ int i;
printf(">>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>\n");
printf("Connection Header:\n");
- printf("\trs Slave Addr.: 0x%02x\n", req.rsSA);
- printf("\tnetFn: 0x%02x, LUN: 0x%02x\n", req.netFn, req.rsLUN);
- printf("\tChecksum: 0x%02x (%s)\n", buf[2],
- (buf[2] == ipmb_csum(buf, 2)) ? "OK" : "Wrong");
+ printf("\trs Slave Addr.: 0x%02x\n", req->rsSA);
+ printf("\tnetFn: 0x%02x, LUN: 0x%02x\n", req->netFn, req->rsLUN);
printf("Data:\n");
- printf("\trq Slave Addr.: 0x%02x\n", req.rqSA);
- printf("\trqSeq: 0x%02x, rqLUN: 0x%02x\n", req.rqSEQ, req.rqLUN);
- printf("\tcmd: 0x%02x\n", req.cmd);
+ printf("\trq Slave Addr.: 0x%02x\n", req->rqSA);
+ printf("\trqSeq: 0x%02x, rqLUN: 0x%02x\n", req->rqSEQ, req->rqLUN);
+ printf("\tcmd: 0x%02x\n", req->cmd);
printf("\tData: ");
- for(i = 0; i < req.datalen; i++) {
- printf("0x%02x ", req.data[i]);
+ for(i = 0; i < req->datalen; i++) {
+ printf("0x%02x ", req->data[i]);
}
printf("\n");
- printf("\tChecksum: 0x%02x (%s)\n", buf[len-1],
- (buf[len-1] == ipmb_csum(buf+3, len-4)) ? "OK" : "Wrong");
printf("<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<\n");
+}
+#endif
+
+void ipmb_invalid(struct ipmb_resp *resp)
+{
+#if 0
+ static unsigned char cmd_invalid[] = {0xc2};
+
+ resp->data = cmd_invalid;
+ resp->datalen = sizeof(cmd_invalid);
+ ipmb_send(resp);
+#endif
+}
+
+void ipmb_cmd(struct ipmb_req *req)
+{
+ struct ipmb_resp resp;
+ static unsigned char get_devid[] =
+ {IPMB_CC_NORMALLY, 0x42, 0x42, 0x01, 0x01, 0x51, 0xff /* Add. Dev. Supp */, 0x00, 0x00, 0x00, 0x00, 0x00 };
+ static unsigned char get_wd_timer[] =
+ {IPMB_CC_NORMALLY, 0x42, 0x00, 0x00, 0x04, 0xff, 0xff, 0xfe, 0xfe};
+ static unsigned char cc_normal[] =
+ {IPMB_CC_NORMALLY};
+
+ resp.rqSA = req->rqSA;
+ resp.netFn = req->netFn+1;
+ resp.rqLUN = req->rqLUN;
+ resp.rsSA = req->rsSA;
+ resp.rqSEQ = req->rqSEQ;
+ resp.rsLUN = req->rsLUN;
+ resp.cmd = req->cmd;
+
+ switch (req->netFn) {
+ case IPMB_NETFN_CHASSIS:
+ switch (req->cmd) {
+ case IPMB_CHASSIS_CONTROL:
+ chassis_control(*(req->data));
+ resp.data = cc_normal;
+ resp.datalen = sizeof(cc_normal);
+ ipmb_send(&resp);
+ break;
+ default:
+#ifdef DEBUG
+ printf("Unknown chassis cmd 0x%02x\n", req->cmd);
+ ipmb_dump_req(req);
+#endif
+ ipmb_invalid(&resp);
+ break;
+ }
+ break;
+
+ case IPMB_NETFN_SENSOR_EVENT:
+ switch (req->cmd) {
+ default:
+#ifdef DEBUG
+ printf("Unknown sensor cmd 0x%02x\n", req->cmd);
+ ipmb_dump_req(req);
+#endif
+ ipmb_invalid(&resp);
+ break;
+ }
+ break;
+
+ case IPMB_NETFN_APP:
+ switch (req->cmd) {
+ case IPMB_APP_GET_DEVICE_ID:
+ resp.data = get_devid;
+ resp.datalen = sizeof(get_devid);
+ ipmb_send(&resp);
+ break;
+
+ case IPMB_APP_GET_WATCHDOG_TIMER:
+ resp.data = get_wd_timer;
+ resp.datalen = sizeof(get_wd_timer);
+ ipmb_send(&resp);
+ break;
+
+ default:
+#ifdef DEBUG
+ printf("Unknown app cmd 0x%02x\n", req->cmd);
+ ipmb_dump_req(req);
+#endif
+ ipmb_invalid(&resp);
+ break;
+ }
+ break;
+
+ case IPMB_NETFN_STORAGE:
+ switch (req->cmd) {
+ default:
+#ifdef DEBUG
+ printf("Unknown storage cmd 0x%02x\n", req->cmd);
+ ipmb_dump_req(req);
+#endif
+ ipmb_invalid(&resp);
+ break;
+ }
+ break;
+
+ default:
+#ifdef DEBUG
+ printf("Unknown netFn 0x%02x\n", req->netFn);
+ ipmb_dump_req(req);
+#endif
+ ipmb_invalid(&resp);
+ break;
+ }
+}
+
+void decode_ipmb_pkt(unsigned char *buf, int len)
+{
+ struct ipmb_req req;
if ((buf[2] != ipmb_csum(buf, 2)) ||
- (buf[len-1] == ipmb_csum(buf+3, len-4)))
+ (buf[len-1] != ipmb_csum(buf+3, len-4)))
return; /* Checksum wrong */
- //i2c_send((unsigned char*)"\x28\x00",1);
+ req.rsSA = buf[0];
+ req.netFn = (buf[1]>>2)&0x3f;
+ req.rsLUN = (buf[1] & 0x03);
+ req.rqSA = buf[3];
+ req.rqSEQ = (buf[4]>>2)&0x3f;
+ req.rqLUN = (buf[4] & 0x03);
+ req.cmd = buf[5];
+ req.data = buf+6;
+ req.datalen = len - 6 - 1;
+
+ ipmb_cmd(&req);
}
projects / rsbs2 / blobdiff