jaseg/secure-hid
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

lld/stm32f4: Send correct amount of data

Browse source 
+ added logging output of data that is going to be sent.

Signed-off-by: Amir Hammad <amir.hammad@hotmail.com>
This commit is contained in:
Amir Hammad 2015-08-26 08:00:40 +02:00
parent 631a614c81
commit 4cbbb39624
1 changed files with 15 additions and 2 deletions
Download patch file Download diff file Expand all files Collapse all files

17
src/usbh_lld_stm32f4.c
View file

@ -20,9 +20,9 @@
*
*/
#include "driver/usbh_device_driver.h"
#include "usbh_lld_stm32f4.h"
#include "usart_helpers.h"
#include "driver/usbh_device_driver.h"
#include <string.h>
#include <stdint.h>
@ -301,10 +301,23 @@ static void write(void *drvdata, const usbh_packet_t *packet)
volatile uint32_t *fifo = &REBASE_CH(OTG_FIFO, channel) + RX_FIFO_SIZE;
const uint32_t * buf32 = packet->data;
int i;
for(i = packet->datalen; i > 0; i-=4) {
LOG_PRINTF("\nSending[%d]: ", packet->datalen);
for(i = packet->datalen; i >= 4; i-=4) {
const uint8_t *buf8 = (const uint8_t *)buf32;
LOG_PRINTF("%02X %02X %02X %02X, ", buf8[0], buf8[1], buf8[2], buf8[3]);
*fifo++ = *buf32++;
}
if (i > 0) {
*fifo = *buf32&((1 << (8*i)) - 1);
uint8_t *buf8 = (uint8_t *)buf32;
while (i--) {
LOG_PRINTF("%02X ", *buf8++);
}
}
LOG_PRINTF("\n");
} else {
volatile uint32_t *fifo = &REBASE_CH(OTG_FIFO, channel) +
RX_FIFO_SIZE + TX_NP_FIFO_SIZE;