X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fballboard%2Fi2c_protocol.c;h=36bbf96517288549e836e295672177ceed0adf0d;hp=f9e9b554bab378e031937675f06b061dd906c364;hb=063af91cd38fceba6cbcf3a9b8abd4c48684d990;hpb=c8bae2eb9f3084d53436bc6c9fee9952dfcc1fda diff --git a/projects/microb2010/ballboard/i2c_protocol.c b/projects/microb2010/ballboard/i2c_protocol.c index f9e9b55..36bbf96 100644 --- a/projects/microb2010/ballboard/i2c_protocol.c +++ b/projects/microb2010/ballboard/i2c_protocol.c @@ -1,6 +1,6 @@ /* - * Copyright Droids Corporation (2007) - * + * Copyright Droids Corporation (2010) + * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or @@ -47,6 +47,7 @@ #include "../common/i2c_commands.h" #include "main.h" #include "state.h" +#include "sensor.h" #include "actuator.h" void i2c_protocol_init(void) @@ -73,8 +74,10 @@ void i2c_send_status(void) struct i2c_ans_ballboard_status ans; i2c_flush(); ans.hdr.cmd = I2C_ANS_BALLBOARD_STATUS; - ans.status = 0x55; /* XXX */ + ans.status = state_get_status(); ans.ball_count = state_get_ball_count(); + ans.lcob = cob_detect_left(); + ans.rcob = cob_detect_right(); i2c_send(I2C_ADD_MASTER, (uint8_t *) &ans, sizeof(ans), I2C_CTRL_GENERIC);