mirror of
https://gitea.osmocom.org/sim-card/simtrace2.git
synced 2026-03-17 13:48:32 +03:00
46 lines
1.2 KiB
C
46 lines
1.2 KiB
C
#include "board.h"
|
|
|
|
static volatile bool write_to_host_in_progress = false;
|
|
static bool check_for_pts = false;
|
|
|
|
static struct Usart_info usart_info = {.base = USART_PHONE, .id = ID_USART_PHONE, .state = USART_RCV};
|
|
|
|
void USB_write_callback(uint8_t *pArg, uint8_t status, uint32_t transferred, uint32_t remaining)
|
|
{
|
|
if (status != USBD_STATUS_SUCCESS) {
|
|
TRACE_ERROR("USB err status: %d(%s)\n", __FUNCTION__, status);
|
|
}
|
|
write_to_host_in_progress = false;
|
|
TRACE_DEBUG("WR_CB\n");
|
|
}
|
|
|
|
int send_to_host()
|
|
{
|
|
static uint8_t msg[RING_BUFLEN];
|
|
int ret = 0;
|
|
unsigned int i;
|
|
|
|
for(i = 0; !rbuf_is_empty(&sim_rcv_buf) && i < sizeof(msg); i++) {
|
|
msg[i] = rbuf_read(&sim_rcv_buf);
|
|
}
|
|
TRACE_DEBUG("Wr %d\n", i);
|
|
write_to_host_in_progress = true;
|
|
ret = USBD_Write( PHONE_DATAIN, msg, i, (TransferCallback)&USB_write_callback, 0 );
|
|
if (ret != USBD_STATUS_SUCCESS) {
|
|
TRACE_ERROR("Error sending to host (%x)\n", ret);
|
|
write_to_host_in_progress = false;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int check_data_from_phone()
|
|
{
|
|
int ret = 0;
|
|
|
|
if((rbuf_is_empty(&sim_rcv_buf) || write_to_host_in_progress == true)) {
|
|
return ret;
|
|
}
|
|
ret = send_to_host();
|
|
return ret;
|
|
}
|