read back current and pwm limit

2011-06-05 18:23:29 +02:00 · 2011-06-05 18:23:29 +02:00 · c0eef162bd
commit c0eef162bd
parent 5fa8d27b5c
1 changed files with 13 additions and 1 deletions
--- a/i2c-slave.c
+++ b/i2c-slave.c
@ -160,7 +160,19 @@ ISR(TWI_vect)
 	case 0xB8:
 		switch (cmd) {
 		case CMD_WAIT:
-			data = 0x00;	/* TODO: transmit Current and MaxPWM */
+			switch (bcnt++) {
+			case 0:
+				data = blmc.current & 0xFF;
+				break;
+
+			case 1:
+				data = 0xFF - blmc.pwm_limit;
+				break;
+
+			default:
+				data = 0xFF;
+				break;
+			}
 			break;

 		case CMD_READ_VERSION: