123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841 |
- #include "lwip/apps/lwiperf.h"
- #include "lwip/tcp.h"
- #include "lwip/sys.h"
- #include <string.h>
- #if LWIP_TCP && LWIP_CALLBACK_API
- #ifndef LWIPERF_TCP_MAX_IDLE_SEC
- #define LWIPERF_TCP_MAX_IDLE_SEC 10U
- #endif
- #if LWIPERF_TCP_MAX_IDLE_SEC > 255
- #error LWIPERF_TCP_MAX_IDLE_SEC must fit into an u8_t
- #endif
- #ifndef LWIPERF_SERVER_IP_TYPE
- #define LWIPERF_SERVER_IP_TYPE IPADDR_TYPE_ANY
- #endif
- #ifndef LWIPERF_ALLOC
- #define LWIPERF_ALLOC(type) mem_malloc(sizeof(type))
- #define LWIPERF_FREE(type, item) mem_free(item)
- #endif
- #ifndef LWIPERF_CHECK_RX_DATA
- #define LWIPERF_CHECK_RX_DATA 0
- #endif
- typedef struct _lwiperf_settings {
- #define LWIPERF_FLAGS_ANSWER_TEST 0x80000000
- #define LWIPERF_FLAGS_ANSWER_NOW 0x00000001
- u32_t flags;
- u32_t num_threads;
- u32_t remote_port;
- u32_t buffer_len;
- u32_t win_band;
- u32_t amount;
- } lwiperf_settings_t;
- struct _lwiperf_state_base;
- typedef struct _lwiperf_state_base lwiperf_state_base_t;
- struct _lwiperf_state_base {
-
- lwiperf_state_base_t *next;
-
- u8_t tcp;
-
- u8_t server;
-
- lwiperf_state_base_t *related_master_state;
- };
- typedef struct _lwiperf_state_tcp {
- lwiperf_state_base_t base;
- struct tcp_pcb *server_pcb;
- struct tcp_pcb *conn_pcb;
- u32_t time_started;
- lwiperf_report_fn report_fn;
- void *report_arg;
- u8_t poll_count;
- u8_t next_num;
-
- u8_t client_tradeoff_mode;
- u32_t bytes_transferred;
- lwiperf_settings_t settings;
- u8_t have_settings_buf;
- u8_t specific_remote;
- ip_addr_t remote_addr;
- } lwiperf_state_tcp_t;
- static lwiperf_state_base_t *lwiperf_all_connections;
- static const u8_t lwiperf_txbuf_const[1600] = {
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- };
- static err_t lwiperf_tcp_poll(void *arg, struct tcp_pcb *tpcb);
- static void lwiperf_tcp_err(void *arg, err_t err);
- static err_t lwiperf_start_tcp_server_impl(const ip_addr_t *local_addr, u16_t local_port,
- lwiperf_report_fn report_fn, void *report_arg,
- lwiperf_state_base_t *related_master_state, lwiperf_state_tcp_t **state);
- static void
- lwiperf_list_add(lwiperf_state_base_t *item)
- {
- item->next = lwiperf_all_connections;
- lwiperf_all_connections = item;
- }
- static void
- lwiperf_list_remove(lwiperf_state_base_t *item)
- {
- lwiperf_state_base_t *prev = NULL;
- lwiperf_state_base_t *iter;
- for (iter = lwiperf_all_connections; iter != NULL; prev = iter, iter = iter->next) {
- if (iter == item) {
- if (prev == NULL) {
- lwiperf_all_connections = iter->next;
- } else {
- prev->next = iter->next;
- }
-
- for (iter = iter->next; iter != NULL; iter = iter->next) {
- LWIP_ASSERT("duplicate entry", iter != item);
- }
- break;
- }
- }
- }
- static lwiperf_state_base_t *
- lwiperf_list_find(lwiperf_state_base_t *item)
- {
- lwiperf_state_base_t *iter;
- for (iter = lwiperf_all_connections; iter != NULL; iter = iter->next) {
- if (iter == item) {
- return item;
- }
- }
- return NULL;
- }
- static void
- lwip_tcp_conn_report(lwiperf_state_tcp_t *conn, enum lwiperf_report_type report_type)
- {
- if ((conn != NULL) && (conn->report_fn != NULL)) {
- u32_t now, duration_ms, bandwidth_kbitpsec;
- now = sys_now();
- duration_ms = now - conn->time_started;
- if (duration_ms == 0) {
- bandwidth_kbitpsec = 0;
- } else {
- bandwidth_kbitpsec = (conn->bytes_transferred / duration_ms) * 8U;
- }
- conn->report_fn(conn->report_arg, report_type,
- &conn->conn_pcb->local_ip, conn->conn_pcb->local_port,
- &conn->conn_pcb->remote_ip, conn->conn_pcb->remote_port,
- conn->bytes_transferred, duration_ms, bandwidth_kbitpsec);
- }
- }
- static void
- lwiperf_tcp_close(lwiperf_state_tcp_t *conn, enum lwiperf_report_type report_type)
- {
- err_t err;
- lwiperf_list_remove(&conn->base);
- lwip_tcp_conn_report(conn, report_type);
- if (conn->conn_pcb != NULL) {
- tcp_arg(conn->conn_pcb, NULL);
- tcp_poll(conn->conn_pcb, NULL, 0);
- tcp_sent(conn->conn_pcb, NULL);
- tcp_recv(conn->conn_pcb, NULL);
- tcp_err(conn->conn_pcb, NULL);
- err = tcp_close(conn->conn_pcb);
- if (err != ERR_OK) {
-
- tcp_abort(conn->conn_pcb);
- }
- } else {
-
- err = tcp_close(conn->server_pcb);
- LWIP_ASSERT("error", err == ERR_OK);
- }
- LWIPERF_FREE(lwiperf_state_tcp_t, conn);
- }
- static err_t
- lwiperf_tcp_client_send_more(lwiperf_state_tcp_t *conn)
- {
- int send_more;
- err_t err;
- u16_t txlen;
- u16_t txlen_max;
- void *txptr;
- u8_t apiflags;
- LWIP_ASSERT("conn invalid", (conn != NULL) && conn->base.tcp && (conn->base.server == 0));
- do {
- send_more = 0;
- if (conn->settings.amount & PP_HTONL(0x80000000)) {
-
- u32_t now = sys_now();
- u32_t diff_ms = now - conn->time_started;
- u32_t time = (u32_t) - (s32_t)lwip_htonl(conn->settings.amount);
- u32_t time_ms = time * 10;
- if (diff_ms >= time_ms) {
-
- lwiperf_tcp_close(conn, LWIPERF_TCP_DONE_CLIENT);
- return ERR_OK;
- }
- } else {
-
- u32_t amount_bytes = lwip_htonl(conn->settings.amount);
-
- if (amount_bytes >= conn->bytes_transferred) {
-
- lwiperf_tcp_close(conn, LWIPERF_TCP_DONE_CLIENT);
- return ERR_OK;
- }
- }
- if (conn->bytes_transferred < 24) {
-
- txptr = &((u8_t *)&conn->settings)[conn->bytes_transferred];
- txlen_max = (u16_t)(24 - conn->bytes_transferred);
- apiflags = TCP_WRITE_FLAG_COPY;
- } else if (conn->bytes_transferred < 48) {
-
- txptr = &((u8_t *)&conn->settings)[conn->bytes_transferred - 24];
- txlen_max = (u16_t)(48 - conn->bytes_transferred);
- apiflags = TCP_WRITE_FLAG_COPY | TCP_WRITE_FLAG_MORE;
- send_more = 1;
- } else {
-
-
- txptr = LWIP_CONST_CAST(void *, &lwiperf_txbuf_const[conn->bytes_transferred % 10]);
- txlen_max = TCP_MSS;
- if (conn->bytes_transferred == 48) {
- txlen_max = TCP_MSS - 24;
- }
- apiflags = 0;
- send_more = 1;
- }
- txlen = txlen_max;
- do {
- err = tcp_write(conn->conn_pcb, txptr, txlen, apiflags);
- if (err == ERR_MEM) {
- txlen /= 2;
- }
- } while ((err == ERR_MEM) && (txlen >= (TCP_MSS / 2)));
- if (err == ERR_OK) {
- conn->bytes_transferred += txlen;
- } else {
- send_more = 0;
- }
- } while (send_more);
- tcp_output(conn->conn_pcb);
- return ERR_OK;
- }
- static err_t
- lwiperf_tcp_client_sent(void *arg, struct tcp_pcb *tpcb, u16_t len)
- {
- lwiperf_state_tcp_t *conn = (lwiperf_state_tcp_t *)arg;
-
- LWIP_ASSERT("invalid conn", conn->conn_pcb == tpcb);
- LWIP_UNUSED_ARG(tpcb);
- LWIP_UNUSED_ARG(len);
- conn->poll_count = 0;
- return lwiperf_tcp_client_send_more(conn);
- }
- static err_t
- lwiperf_tcp_client_connected(void *arg, struct tcp_pcb *tpcb, err_t err)
- {
- lwiperf_state_tcp_t *conn = (lwiperf_state_tcp_t *)arg;
- LWIP_ASSERT("invalid conn", conn->conn_pcb == tpcb);
- LWIP_UNUSED_ARG(tpcb);
- if (err != ERR_OK) {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_REMOTE);
- return ERR_OK;
- }
- conn->poll_count = 0;
- conn->time_started = sys_now();
- return lwiperf_tcp_client_send_more(conn);
- }
- static err_t
- lwiperf_tx_start_impl(const ip_addr_t *remote_ip, u16_t remote_port, lwiperf_settings_t *settings, lwiperf_report_fn report_fn,
- void *report_arg, lwiperf_state_base_t *related_master_state, lwiperf_state_tcp_t **new_conn)
- {
- err_t err;
- lwiperf_state_tcp_t *client_conn;
- struct tcp_pcb *newpcb;
- ip_addr_t remote_addr;
- LWIP_ASSERT("remote_ip != NULL", remote_ip != NULL);
- LWIP_ASSERT("remote_ip != NULL", settings != NULL);
- LWIP_ASSERT("new_conn != NULL", new_conn != NULL);
- *new_conn = NULL;
- client_conn = (lwiperf_state_tcp_t *)LWIPERF_ALLOC(lwiperf_state_tcp_t);
- if (client_conn == NULL) {
- return ERR_MEM;
- }
- newpcb = tcp_new_ip_type(IP_GET_TYPE(remote_ip));
- if (newpcb == NULL) {
- LWIPERF_FREE(lwiperf_state_tcp_t, client_conn);
- return ERR_MEM;
- }
- memset(client_conn, 0, sizeof(lwiperf_state_tcp_t));
- client_conn->base.tcp = 1;
- client_conn->base.related_master_state = related_master_state;
- client_conn->conn_pcb = newpcb;
- client_conn->time_started = sys_now();
- client_conn->report_fn = report_fn;
- client_conn->report_arg = report_arg;
- client_conn->next_num = 4;
- client_conn->bytes_transferred = 0;
- memcpy(&client_conn->settings, settings, sizeof(*settings));
- client_conn->have_settings_buf = 1;
- tcp_arg(newpcb, client_conn);
- tcp_sent(newpcb, lwiperf_tcp_client_sent);
- tcp_poll(newpcb, lwiperf_tcp_poll, 2U);
- tcp_err(newpcb, lwiperf_tcp_err);
- ip_addr_copy(remote_addr, *remote_ip);
- err = tcp_connect(newpcb, &remote_addr, remote_port, lwiperf_tcp_client_connected);
- if (err != ERR_OK) {
- lwiperf_tcp_close(client_conn, LWIPERF_TCP_ABORTED_LOCAL);
- return err;
- }
- lwiperf_list_add(&client_conn->base);
- *new_conn = client_conn;
- return ERR_OK;
- }
- static err_t
- lwiperf_tx_start_passive(lwiperf_state_tcp_t *conn)
- {
- err_t ret;
- lwiperf_state_tcp_t *new_conn = NULL;
- u16_t remote_port = (u16_t)lwip_htonl(conn->settings.remote_port);
- ret = lwiperf_tx_start_impl(&conn->conn_pcb->remote_ip, remote_port, &conn->settings, conn->report_fn, conn->report_arg,
- conn->base.related_master_state, &new_conn);
- if (ret == ERR_OK) {
- LWIP_ASSERT("new_conn != NULL", new_conn != NULL);
- new_conn->settings.flags = 0;
- }
- return ret;
- }
- static err_t
- lwiperf_tcp_recv(void *arg, struct tcp_pcb *tpcb, struct pbuf *p, err_t err)
- {
- u8_t tmp;
- u16_t tot_len;
- u32_t packet_idx;
- struct pbuf *q;
- lwiperf_state_tcp_t *conn = (lwiperf_state_tcp_t *)arg;
- LWIP_ASSERT("pcb mismatch", conn->conn_pcb == tpcb);
- LWIP_UNUSED_ARG(tpcb);
- if (err != ERR_OK) {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_REMOTE);
- return ERR_OK;
- }
- if (p == NULL) {
-
- if (conn->settings.flags & PP_HTONL(LWIPERF_FLAGS_ANSWER_TEST)) {
- if ((conn->settings.flags & PP_HTONL(LWIPERF_FLAGS_ANSWER_NOW)) == 0) {
-
- lwiperf_tx_start_passive(conn);
- }
- }
- lwiperf_tcp_close(conn, LWIPERF_TCP_DONE_SERVER);
- return ERR_OK;
- }
- tot_len = p->tot_len;
- conn->poll_count = 0;
- if ((!conn->have_settings_buf) || ((conn->bytes_transferred - 24) % (1024 * 128) == 0)) {
-
- if (p->tot_len < sizeof(lwiperf_settings_t)) {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_LOCAL_DATAERROR);
- pbuf_free(p);
- return ERR_OK;
- }
- if (!conn->have_settings_buf) {
- if (pbuf_copy_partial(p, &conn->settings, sizeof(lwiperf_settings_t), 0) != sizeof(lwiperf_settings_t)) {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_LOCAL);
- pbuf_free(p);
- return ERR_OK;
- }
- conn->have_settings_buf = 1;
- if (conn->settings.flags & PP_HTONL(LWIPERF_FLAGS_ANSWER_TEST)) {
- if (conn->settings.flags & PP_HTONL(LWIPERF_FLAGS_ANSWER_NOW)) {
-
- err_t err2 = lwiperf_tx_start_passive(conn);
- if (err2 != ERR_OK) {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_LOCAL_TXERROR);
- pbuf_free(p);
- return ERR_OK;
- }
- }
- }
- } else {
- if (conn->settings.flags & PP_HTONL(LWIPERF_FLAGS_ANSWER_TEST)) {
- if (pbuf_memcmp(p, 0, &conn->settings, sizeof(lwiperf_settings_t)) != 0) {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_LOCAL_DATAERROR);
- pbuf_free(p);
- return ERR_OK;
- }
- }
- }
- conn->bytes_transferred += sizeof(lwiperf_settings_t);
- if (conn->bytes_transferred <= 24) {
- conn->time_started = sys_now();
- tcp_recved(tpcb, p->tot_len);
- pbuf_free(p);
- return ERR_OK;
- }
- conn->next_num = 4;
- tmp = pbuf_remove_header(p, 24);
- LWIP_ASSERT("pbuf_remove_header failed", tmp == 0);
- LWIP_UNUSED_ARG(tmp);
- }
- packet_idx = 0;
- for (q = p; q != NULL; q = q->next) {
- #if LWIPERF_CHECK_RX_DATA
- const u8_t *payload = (const u8_t *)q->payload;
- u16_t i;
- for (i = 0; i < q->len; i++) {
- u8_t val = payload[i];
- u8_t num = val - '0';
- if (num == conn->next_num) {
- conn->next_num++;
- if (conn->next_num == 10) {
- conn->next_num = 0;
- }
- } else {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_LOCAL_DATAERROR);
- pbuf_free(p);
- return ERR_OK;
- }
- }
- #endif
- packet_idx += q->len;
- }
- LWIP_ASSERT("count mismatch", packet_idx == p->tot_len);
- conn->bytes_transferred += packet_idx;
- tcp_recved(tpcb, tot_len);
- pbuf_free(p);
- return ERR_OK;
- }
- static void
- lwiperf_tcp_err(void *arg, err_t err)
- {
- lwiperf_state_tcp_t *conn = (lwiperf_state_tcp_t *)arg;
- LWIP_UNUSED_ARG(err);
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_REMOTE);
- }
- static err_t
- lwiperf_tcp_poll(void *arg, struct tcp_pcb *tpcb)
- {
- lwiperf_state_tcp_t *conn = (lwiperf_state_tcp_t *)arg;
- LWIP_ASSERT("pcb mismatch", conn->conn_pcb == tpcb);
- LWIP_UNUSED_ARG(tpcb);
- if (++conn->poll_count >= LWIPERF_TCP_MAX_IDLE_SEC) {
- lwiperf_tcp_close(conn, LWIPERF_TCP_ABORTED_LOCAL);
- return ERR_OK;
- }
- if (!conn->base.server) {
- lwiperf_tcp_client_send_more(conn);
- }
- return ERR_OK;
- }
- static err_t
- lwiperf_tcp_accept(void *arg, struct tcp_pcb *newpcb, err_t err)
- {
- lwiperf_state_tcp_t *s, *conn;
- if ((err != ERR_OK) || (newpcb == NULL) || (arg == NULL)) {
- return ERR_VAL;
- }
- s = (lwiperf_state_tcp_t *)arg;
- LWIP_ASSERT("invalid session", s->base.server);
- LWIP_ASSERT("invalid listen pcb", s->server_pcb != NULL);
- LWIP_ASSERT("invalid conn pcb", s->conn_pcb == NULL);
- if (s->specific_remote) {
- LWIP_ASSERT("s->base.related_master_state != NULL", s->base.related_master_state != NULL);
- if (!ip_addr_cmp(&newpcb->remote_ip, &s->remote_addr)) {
-
- return ERR_VAL;
- }
- } else {
- LWIP_ASSERT("s->base.related_master_state == NULL", s->base.related_master_state == NULL);
- }
- conn = (lwiperf_state_tcp_t *)LWIPERF_ALLOC(lwiperf_state_tcp_t);
- if (conn == NULL) {
- return ERR_MEM;
- }
- memset(conn, 0, sizeof(lwiperf_state_tcp_t));
- conn->base.tcp = 1;
- conn->base.server = 1;
- conn->base.related_master_state = &s->base;
- conn->conn_pcb = newpcb;
- conn->time_started = sys_now();
- conn->report_fn = s->report_fn;
- conn->report_arg = s->report_arg;
-
- tcp_arg(newpcb, conn);
- tcp_recv(newpcb, lwiperf_tcp_recv);
- tcp_poll(newpcb, lwiperf_tcp_poll, 2U);
- tcp_err(conn->conn_pcb, lwiperf_tcp_err);
- if (s->specific_remote) {
-
- conn->base.related_master_state = s->base.related_master_state;
-
- if (!s->client_tradeoff_mode || !lwiperf_list_find(s->base.related_master_state)) {
-
- s->report_fn = NULL;
- lwiperf_tcp_close(s, LWIPERF_TCP_ABORTED_LOCAL);
- }
- }
- lwiperf_list_add(&conn->base);
- return ERR_OK;
- }
- void *
- lwiperf_start_tcp_server_default(lwiperf_report_fn report_fn, void *report_arg)
- {
- return lwiperf_start_tcp_server(IP_ADDR_ANY, LWIPERF_TCP_PORT_DEFAULT,
- report_fn, report_arg);
- }
- void *
- lwiperf_start_tcp_server(const ip_addr_t *local_addr, u16_t local_port,
- lwiperf_report_fn report_fn, void *report_arg)
- {
- err_t err;
- lwiperf_state_tcp_t *state = NULL;
- err = lwiperf_start_tcp_server_impl(local_addr, local_port, report_fn, report_arg,
- NULL, &state);
- if (err == ERR_OK) {
- return state;
- }
- return NULL;
- }
- static err_t lwiperf_start_tcp_server_impl(const ip_addr_t *local_addr, u16_t local_port,
- lwiperf_report_fn report_fn, void *report_arg,
- lwiperf_state_base_t *related_master_state, lwiperf_state_tcp_t **state)
- {
- err_t err;
- struct tcp_pcb *pcb;
- lwiperf_state_tcp_t *s;
- LWIP_ASSERT_CORE_LOCKED();
- LWIP_ASSERT("state != NULL", state != NULL);
- if (local_addr == NULL) {
- return ERR_ARG;
- }
- s = (lwiperf_state_tcp_t *)LWIPERF_ALLOC(lwiperf_state_tcp_t);
- if (s == NULL) {
- return ERR_MEM;
- }
- memset(s, 0, sizeof(lwiperf_state_tcp_t));
- s->base.tcp = 1;
- s->base.server = 1;
- s->base.related_master_state = related_master_state;
- s->report_fn = report_fn;
- s->report_arg = report_arg;
- pcb = tcp_new_ip_type(LWIPERF_SERVER_IP_TYPE);
- if (pcb == NULL) {
- return ERR_MEM;
- }
- err = tcp_bind(pcb, local_addr, local_port);
- if (err != ERR_OK) {
- return err;
- }
- s->server_pcb = tcp_listen_with_backlog(pcb, 1);
- if (s->server_pcb == NULL) {
- if (pcb != NULL) {
- tcp_close(pcb);
- }
- LWIPERF_FREE(lwiperf_state_tcp_t, s);
- return ERR_MEM;
- }
- pcb = NULL;
- tcp_arg(s->server_pcb, s);
- tcp_accept(s->server_pcb, lwiperf_tcp_accept);
- lwiperf_list_add(&s->base);
- *state = s;
- return ERR_OK;
- }
- void* lwiperf_start_tcp_client_default(const ip_addr_t* remote_addr,
- lwiperf_report_fn report_fn, void* report_arg)
- {
- return lwiperf_start_tcp_client(remote_addr, LWIPERF_TCP_PORT_DEFAULT, LWIPERF_CLIENT,
- report_fn, report_arg);
- }
- void* lwiperf_start_tcp_client(const ip_addr_t* remote_addr, u16_t remote_port,
- enum lwiperf_client_type type, lwiperf_report_fn report_fn, void* report_arg)
- {
- err_t ret;
- lwiperf_settings_t settings;
- lwiperf_state_tcp_t *state = NULL;
- memset(&settings, 0, sizeof(settings));
- switch (type) {
- case LWIPERF_CLIENT:
-
- settings.flags = 0;
- break;
- case LWIPERF_DUAL:
-
- settings.flags = htonl(LWIPERF_FLAGS_ANSWER_TEST | LWIPERF_FLAGS_ANSWER_NOW);
- break;
- case LWIPERF_TRADEOFF:
-
- settings.flags = htonl(LWIPERF_FLAGS_ANSWER_TEST);
- break;
- default:
-
- return NULL;
- }
- settings.num_threads = htonl(1);
- settings.remote_port = htonl(LWIPERF_TCP_PORT_DEFAULT);
-
- settings.amount = htonl((u32_t)-1000);
- ret = lwiperf_tx_start_impl(remote_addr, remote_port, &settings, report_fn, report_arg, NULL, &state);
- if (ret == ERR_OK) {
- LWIP_ASSERT("state != NULL", state != NULL);
- if (type != LWIPERF_CLIENT) {
-
- lwiperf_state_tcp_t *server = NULL;
- ret = lwiperf_start_tcp_server_impl(&state->conn_pcb->local_ip, LWIPERF_TCP_PORT_DEFAULT,
- report_fn, report_arg, (lwiperf_state_base_t *)state, &server);
- if (ret != ERR_OK) {
-
- lwiperf_abort(state);
- return NULL;
- }
-
- server->specific_remote = 1;
- server->remote_addr = state->conn_pcb->remote_ip;
- if (type == LWIPERF_TRADEOFF) {
-
- server->client_tradeoff_mode = 1;
- }
- }
- return state;
- }
- return NULL;
- }
- void
- lwiperf_abort(void *lwiperf_session)
- {
- lwiperf_state_base_t *i, *dealloc, *last = NULL;
- LWIP_ASSERT_CORE_LOCKED();
- for (i = lwiperf_all_connections; i != NULL; ) {
- if ((i == lwiperf_session) || (i->related_master_state == lwiperf_session)) {
- dealloc = i;
- i = i->next;
- if (last != NULL) {
- last->next = i;
- }
- LWIPERF_FREE(lwiperf_state_tcp_t, dealloc);
- } else {
- last = i;
- i = i->next;
- }
- }
- }
- #endif
|