X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fmainboard%2Frobotsim.c;fp=projects%2Fmicrob2010%2Fmainboard%2Frobotsim.c;h=a0fa5a0eba8baf1f6654b8b0ed559c64050943bc;hp=5fc2e3768e9867c7b5b02ecaf382c179a322f988;hb=b022f257a5ee568737e1a684a83d0154397fffcb;hpb=aed049ab6be4e1916457743d53f6b610a21b4854

diff --git a/projects/microb2010/mainboard/robotsim.c b/projects/microb2010/mainboard/robotsim.c
index 5fc2e37..a0fa5a0 100644
--- a/projects/microb2010/mainboard/robotsim.c
+++ b/projects/microb2010/mainboard/robotsim.c
@@ -91,14 +91,17 @@ robotsim_i2c_ballboard_set_mode(struct i2c_cmd_ballboard_set_mode *cmd)
 	return 0;
 }
 
-static int8_t
-robotsim_i2c_cobboard_set_mode(struct i2c_cmd_cobboard_set_mode *cmd)
+int8_t
+robotsim_i2c_cobboard_set_mode(uint8_t mode)
 {
 	char buf[BUFSIZ];
 	int len;
 
-	cobboard.mode = cmd->mode;
-	len = snprintf(buf, sizeof(buf), "cobboard=%d\n", cmd->mode);
+	if (cobboard.mode == mode)
+		return 0;
+
+	cobboard.mode = mode;
+	len = snprintf(buf, sizeof(buf), "cobboard=%d\n", mode);
 	hostsim_lock();
 	write(fdw, buf, len);
 	hostsim_unlock();
@@ -127,15 +130,17 @@ robotsim_i2c_ballboard(uint8_t addr, uint8_t *buf, uint8_t size)
 static int8_t
 robotsim_i2c_cobboard(uint8_t addr, uint8_t *buf, uint8_t size)
 {
-	void *void_cmd = buf;
+	//	void *void_cmd = buf;
 
 	switch (buf[0]) {
+#if 0 /* deleted */
 	case I2C_CMD_COBBOARD_SET_MODE:
 		{
 			struct i2c_cmd_cobboard_set_mode *cmd = void_cmd;
 			robotsim_i2c_cobboard_set_mode(cmd);
 			break;
 		}
+#endif
 	default:
 		break;
 	}