Fix IAC support

2 files changed, 3 insertions, 3 deletions

diff --git a/include/hci.h b/include/hci.h
index 6e41642b..4ffa34fc 100644
--- a/include/hci.h
+++ b/include/hci.h
@@ -688,14 +688,14 @@ typedef struct {
 typedef struct {
 	uint8_t		status;
 	uint8_t		num_current_iac;
-	uint8_t		lap[3][MAX_IAC_LAP];
+	uint8_t		lap[MAX_IAC_LAP][3];
 } __attribute__ ((packed)) read_current_iac_lap_rp;
 #define READ_CURRENT_IAC_LAP_RP_SIZE 2+3*MAX_IAC_LAP
 
 #define OCF_WRITE_CURRENT_IAC_LAP	0x003A
 typedef struct {
 	uint8_t		num_current_iac;
-	uint8_t		lap[3][MAX_IAC_LAP];
+	uint8_t		lap[MAX_IAC_LAP][3];
 } __attribute__ ((packed)) write_current_iac_lap_cp;
 #define WRITE_CURRENT_IAC_LAP_CP_SIZE 1+3*MAX_IAC_LAP
 
diff --git a/src/hci.c b/src/hci.c
index 37715613..82bdbffc 100644
--- a/src/hci.c
+++ b/src/hci.c
@@ -1215,7 +1215,7 @@ int hci_write_current_iac_lap(int dd, uint8_t num_iac, uint8_t *lap, int to)
 	rq.ogf    = OGF_HOST_CTL;
 	rq.ocf    = OCF_WRITE_CURRENT_IAC_LAP;
 	rq.cparam = &cp;
-	rq.clen   = WRITE_CURRENT_IAC_LAP_CP_SIZE;
+	rq.clen   = num_iac * 3 + 1;
 
 	return hci_send_req(dd, &rq, to);
 }