main: added tests for twi module. COM: added COM_EnqueueI2cBusMember

avr/com.asm

@@ -39,6 +39,8 @@
 
 .equ COM_CMD_PING                 = 1
 .equ COM_CMD_COMSENDSTATS         = 2
+.equ COM_CMD_COMRECVSTATS         = 3
+.equ COM_CMD_I2CBUSMEMBER         = 4
 
 
 ; ***************************************************************************
@@ -127,7 +129,7 @@ Com_Init:
   ldi r17, (comDataEnd-comDataBegin)
   rcall Utils_FillSram
 
-  ldi r16, 1          ; debug: set fixed address "1"
+  ldi r16, 2          ; debug: set fixed address "2"
   sts comAddress, r16
 
   ; setup pins and interrupts
@@ -344,6 +346,56 @@ COM_EnqueueComSendStats_error:
 
 
 
+; ---------------------------------------------------------------------------
+; Enqueue a I2C Bus Member packet.
+;
+; IN:
+; - R16: destination address
+; - R1 : Address of the bus member
+; - R2 : availability (0=not available, 1=available)
+; OUT:
+; - CFLAG: set if okay, clear otherwise
+; MODIFIED REGS: R16, R17, R20, X (R15, Y)
+
+COM_EnqueueI2cBusMember:
+  push r16
+    rcall COM_AllocBufferAndGetXY ; (r16, r17, r21)
+  pop r16
+  brcc COM_EnqueueI2cBusMember_error
+  clr r17                         ; r17: XOR byte
+  ; write header (dest address, msg length)
+  st X+, r16                      ; destination address
+  eor r17, r16
+  ldi r16, 4                      ; 4 bytes payload
+  st X+, r16
+  eor r17, r16
+  ; write payload
+  ldi r16, COM_CMD_I2CBUSMEMBER   ; send command
+  st X+, r16
+  eor r17, r16
+  lds r16, comAddress             ; send source address
+  st X+, r16
+  eor r17, r16
+  mov r16, r1                     ; send i2c bus member address
+  st X+, r16
+  eor r17, r16
+  mov r16, r2                     ; send i2c bus member availability
+  st X+, r16
+  eor r17, r16
+  ; store XOR byte
+  st X+, r17
+  ; mark buffer as enqueued with PRIO "info" (limited amount of retries)
+  ldi r20, COM_BUFFER_PRIO_INFO
+  rcall COM_EnqueuePacket      ; (R15, R16)
+  brcc COM_EnqueueI2cBusMember_error
+  sec
+  ret
+COM_EnqueueI2cBusMember_error:
+  clc
+  ret
+
+
+
 ; ---------------------------------------------------------------------------
 ; comHandleNextPacketInQueue
 ;