From f2bc5ddbeca144fa79208a5ac6a029da6ed5c10c Mon Sep 17 00:00:00 2001 From: Uros Majstorovic Date: Thu, 31 Mar 2022 13:09:12 +0200 Subject: vconn bugfix --- ecp/test/Makefile | 23 +- ecp/test/basic.c | 16 +- ecp/test/client.c | 90 ++++---- ecp/test/dir.c | 93 -------- ecp/test/echo.c | 56 ----- ecp/test/frag.c | 122 ----------- ecp/test/init_vconn.c | 45 ++-- ecp/test/server.c | 55 ++--- ecp/test/vc_client.c | 95 ++++---- ecp/test/vc_server.c | 91 ++++---- ecp/test/vcs.c | 58 ++--- ecp/test/vid/Makefile | 23 -- ecp/test/vid/cap.c | 576 ------------------------------------------------- ecp/test/vid/cap.sh | 3 - ecp/test/vid/client.c | 123 ----------- ecp/test/vid/display.c | 68 ------ ecp/test/vid/display.h | 17 -- ecp/test/vid/enc.c | 168 --------------- ecp/test/vid/enc.h | 7 - ecp/test/vid/server.c | 76 ------- ecp/test/vid/server.h | 7 - ecp/test/vid/tools.c | 165 -------------- ecp/test/vid/tools.h | 37 ---- ecp/test/voip.c | 196 ----------------- 24 files changed, 243 insertions(+), 1967 deletions(-) delete mode 100644 ecp/test/dir.c delete mode 100644 ecp/test/echo.c delete mode 100644 ecp/test/frag.c delete mode 100644 ecp/test/vid/Makefile delete mode 100644 ecp/test/vid/cap.c delete mode 100755 ecp/test/vid/cap.sh delete mode 100644 ecp/test/vid/client.c delete mode 100644 ecp/test/vid/display.c delete mode 100644 ecp/test/vid/display.h delete mode 100644 ecp/test/vid/enc.c delete mode 100644 ecp/test/vid/enc.h delete mode 100644 ecp/test/vid/server.c delete mode 100644 ecp/test/vid/server.h delete mode 100644 ecp/test/vid/tools.c delete mode 100644 ecp/test/vid/tools.h delete mode 100644 ecp/test/voip.c (limited to 'ecp/test') diff --git a/ecp/test/Makefile b/ecp/test/Makefile index ce12a87..abda4e2 100644 --- a/ecp/test/Makefile +++ b/ecp/test/Makefile @@ -7,11 +7,23 @@ dep=../build-posix/*.a ../util/libecputil.a %.o: %.c $(CC) $(CFLAGS) -c $< -all: basic # dir server echo frag stress vcs vc_server vc_client vc_client_t +all: basic client server vcs vc_server vc_client # dir echo frag stress vc_client_t basic: basic.o init.o $(dep) $(CC) -o $@ $< init.o $(dep) $(LDFLAGS) +vcs: vcs.o init_vconn.o $(dep) + $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) + +vc_server: vc_server.o init_vconn.o $(dep) + $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) + +vc_server2: vc_server2.o init_vconn.o $(dep) + $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) + +vc_client: vc_client.o init_vconn.o $(dep) + $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) + dir: dir.o init.o $(dep) $(CC) -DWITH_DIR_SERVER -o $@ $< init.o $(dep) $(LDFLAGS) @@ -30,15 +42,6 @@ frag: frag.o init.o $(dep) stress: stress.o init.o $(dep) $(CC) -o $@ $< init.o $(dep) $(LDFLAGS) -vcs: vcs.o init_vconn.o $(dep) - $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) - -vc_server: vc_server.o init_vconn.o $(dep) - $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) - -vc_client: vc_client.o init_vconn.o $(dep) - $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) - vc_client_t: vc_client_t.o init_vconn.o $(dep) $(CC) -o $@ $< init_vconn.o $(dep) $(LDFLAGS) diff --git a/ecp/test/basic.c b/ecp/test/basic.c index 2edb174..b266a07 100644 --- a/ecp/test/basic.c +++ b/ecp/test/basic.c @@ -1,26 +1,23 @@ -#include #include #include +#include #include ECPContext ctx_s; ECPSocket sock_s; -ECPDHKey key_perma_s; ECPConnHandler handler_s; ECPContext ctx_c; ECPSocket sock_c; -ECPDHKey key_perma_c; ECPConnHandler handler_c; -ECPNode node; ECPConnection conn; #define CTYPE_TEST 0 #define MTYPE_MSG 0 -int handle_open_c(ECPConnection *conn, ECP2Buffer *b) { +static int handle_open_c(ECPConnection *conn, ECP2Buffer *b) { char *_msg = "PERA JE CAR!"; ssize_t rv; @@ -30,12 +27,12 @@ int handle_open_c(ECPConnection *conn, ECP2Buffer *b) { return ECP_OK; } -ssize_t handle_msg_c(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { +static ssize_t handle_msg_c(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { printf("MSG C:%s size:%ld\n", msg, msg_size); return msg_size; } -ssize_t handle_msg_s(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { +static ssize_t handle_msg_s(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { char *_msg = "VAISTINU JE CAR!"; ssize_t rv; @@ -46,6 +43,9 @@ ssize_t handle_msg_s(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, un } int main(int argc, char *argv[]) { + ECPDHKey key_perma_c; + ECPDHKey key_perma_s; + ECPNode node; int rv; /* server */ @@ -96,4 +96,4 @@ int main(int argc, char *argv[]) { printf("ecp_conn_open RV:%d\n", rv); while (1) sleep(1); -} \ No newline at end of file +} diff --git a/ecp/test/client.c b/ecp/test/client.c index 577a888..d526f76 100644 --- a/ecp/test/client.c +++ b/ecp/test/client.c @@ -1,80 +1,78 @@ -#include +#include #include #include -#include +#include + +#include -#include "core.h" -#include "util.h" +#include ECPContext ctx; ECPSocket sock; ECPConnHandler handler; - -ECPNode node; ECPConnection conn; #define CTYPE_TEST 0 -#define MTYPE_MSG 8 - -ssize_t handle_open(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - uint32_t seq = 0; - - ecp_conn_handle_open(conn, sq, t, p, s, b); - if (s < 0) { - printf("OPEN ERR:%ld\n", s); - return s; - } - - char *msg = "PERA JE CAR!"; - unsigned char buf[1000]; - - strcpy((char *)buf, msg); - ssize_t _rv = ecp_send(conn, MTYPE_MSG, buf, 1000); - - return s; -} +#define MTYPE_MSG 0 + +static int handle_open(ECPConnection *conn, ECP2Buffer *b) { + char *_msg = "PERA JE CAR!"; + ssize_t rv; + + printf("OPEN\n"); + rv = ecp_msg_send(conn, MTYPE_MSG, (unsigned char *)_msg, strlen(_msg)+1); -ssize_t handle_msg(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - printf("MSG C:%s size:%ld\n", p, s); - return s; + return ECP_OK; } +static ssize_t handle_msg(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { + printf("MSG C:%s size:%ld\n", msg, msg_size); + return msg_size; +} static void usage(char *arg) { - fprintf(stderr, "Usage: %s \n", arg); + fprintf(stderr, "Usage: %s
\n", arg); exit(1); } int main(int argc, char *argv[]) { + ECPDHKey key_perma; + ECPNode node; + ecp_ecdh_public_t node_pub; int rv; - - if (argc != 2) usage(argv[0]); - + + /* client */ + if (argc != 3) usage(argv[0]); + rv = ecp_init(&ctx); printf("ecp_init RV:%d\n", rv); - rv = ecp_conn_handler_init(&handler); - handler.msg[ECP_MTYPE_OPEN] = handle_open; - handler.msg[MTYPE_MSG] = handle_msg; - ctx.handler[CTYPE_TEST] = &handler; - - rv = ecp_sock_init(&sock, &ctx, NULL); - printf("ecp_sock_init RV:%d\n", rv); + ecp_conn_handler_init(&handler, handle_msg, handle_open, NULL, NULL); + ecp_ctx_set_handler(&ctx, &handler, CTYPE_TEST); + + rv = ecp_dhkey_gen(&key_perma); + printf("ecp_dhkey_gen RV:%d\n", rv); + + rv = ecp_sock_create(&sock, &ctx, &key_perma); + printf("ecp_sock_create RV:%d\n", rv); rv = ecp_sock_open(&sock, NULL); printf("ecp_sock_open RV:%d\n", rv); - + rv = ecp_start_receiver(&sock); printf("ecp_start_receiver RV:%d\n", rv); - rv = ecp_util_node_load(&ctx, &node, argv[1]); - printf("ecp_util_node_load RV:%d\n", rv); + rv = ecp_conn_create(&conn, &sock, CTYPE_TEST); + printf("ecp_conn_create RV:%d\n", rv); + + rv = ecp_util_load_pub(&node_pub, argv[2]); + printf("ecp_util_load_pub RV:%d\n", rv); - rv = ecp_conn_init(&conn, &sock, CTYPE_TEST); - printf("ecp_conn_init RV:%d\n", rv); + rv = ecp_node_init(&node, &node_pub, argv[1]); + printf("ecp_node_init RV:%d\n", rv); rv = ecp_conn_open(&conn, &node); printf("ecp_conn_open RV:%d\n", rv); - + while (1) sleep(1); -} \ No newline at end of file +} diff --git a/ecp/test/dir.c b/ecp/test/dir.c deleted file mode 100644 index 0c2ac72..0000000 --- a/ecp/test/dir.c +++ /dev/null @@ -1,93 +0,0 @@ -#include -#include -#include - -#include "core.h" -#include "cr.h" -#include "dir.h" -#include "dir_srv.h" - -ECPContext ctx_s; -ECPSocket sock_s; -ECPDHKey key_perma_s; - -ECPContext ctx_c; -ECPSocket sock_c; -ECPDHKey key_perma_c; -ECPConnHandler handler_c; - -ECPNode node; -ECPConnection conn; - -static ECPDirList dir_online; -static ECPDirList dir_shadow; - -#define CTYPE_TEST 0 - -ssize_t handle_dir(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, ssize_t size, ECP2Buffer *b) { - ECPDirList dir; - ssize_t rv; - - dir.count = 0; - rv = ecp_dir_parse(&dir, msg, size); - if (rv < 0) return rv; - - printf("DIR: %s %ld\n", (char *)ecp_cr_dh_pub_get_buf(&dir.item[0].node.public), size); - - return rv; -} - -int main(int argc, char *argv[]) { - int rv; - - dir_online.count = 1; - strcpy((char *)ecp_cr_dh_pub_get_buf(&dir_online.item[0].node.public), "PERA"); - - rv = ecp_init(&ctx_s); - printf("ecp_init RV:%d\n", rv); - - rv = ecp_dir_init(&ctx_s, &dir_online, &dir_shadow); - printf("ecp_dir_init RV:%d\n", rv); - - rv = ecp_dhkey_gen(&ctx_s, &key_perma_s); - printf("ecp_dhkey_gen RV:%d\n", rv); - - rv = ecp_sock_init(&sock_s, &ctx_s, &key_perma_s); - printf("ecp_sock_init RV:%d\n", rv); - - rv = ecp_sock_open(&sock_s, "0.0.0.0:3000"); - printf("ecp_sock_open RV:%d\n", rv); - - rv = ecp_start_receiver(&sock_s); - printf("ecp_start_receiver RV:%d\n", rv); - - rv = ecp_init(&ctx_c); - printf("ecp_init RV:%d\n", rv); - - rv = ecp_conn_handler_init(&handler_c); - handler_c.msg[ECP_MTYPE_DIR] = handle_dir; - ctx_c.handler[CTYPE_TEST] = &handler_c; - - rv = ecp_dhkey_gen(&ctx_c, &key_perma_c); - printf("ecp_dhkey_gen RV:%d\n", rv); - - rv = ecp_sock_init(&sock_c, &ctx_c, &key_perma_c); - printf("ecp_sock_init RV:%d\n", rv); - - rv = ecp_sock_open(&sock_c, NULL); - printf("ecp_sock_open RV:%d\n", rv); - - rv = ecp_start_receiver(&sock_c); - printf("ecp_start_receiver RV:%d\n", rv); - - rv = ecp_node_init(&node, &key_perma_s.public, "127.0.0.1:3000"); - printf("ecp_node_init RV:%d\n", rv); - - rv = ecp_conn_init(&conn, &sock_c, CTYPE_TEST); - printf("ecp_conn_init RV:%d\n", rv); - - rv = ecp_conn_get_dirlist(&conn, &node); - printf("ecp_conn_get_dirlist RV:%d\n", rv); - - while (1) sleep(1); -} \ No newline at end of file diff --git a/ecp/test/echo.c b/ecp/test/echo.c deleted file mode 100644 index f3057df..0000000 --- a/ecp/test/echo.c +++ /dev/null @@ -1,56 +0,0 @@ -#include -#include -#include -#include - -#include "core.h" -#include "util.h" - -ECPContext ctx_s; -ECPSocket sock_s; -ECPDHKey key_perma_s; -ECPConnHandler handler_s; - -#define CTYPE_TEST 0 -#define MTYPE_MSG 8 - -ssize_t handle_msg_s(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - unsigned char buf[ECP_MAX_PLD]; - - memcpy(buf, p, s); - ssize_t _rv = ecp_send(conn, t, buf, s); - - return s; -} - -static void usage(char *arg) { - fprintf(stderr, "Usage: %s
\n", arg); - exit(1); -} - -int main(int argc, char *argv[]) { - int rv; - - if (argc != 3) usage(argv[0]); - - rv = ecp_init(&ctx_s); - printf("ecp_init RV:%d\n", rv); - - rv = ecp_conn_handler_init(&handler_s); - handler_s.msg[MTYPE_MSG] = handle_msg_s; - ctx_s.handler[CTYPE_TEST] = &handler_s; - - rv = ecp_util_key_load(&ctx_s, &key_perma_s, argv[2]); - printf("ecp_util_key_load RV:%d\n", rv); - - rv = ecp_sock_init(&sock_s, &ctx_s, &key_perma_s); - printf("ecp_sock_init RV:%d\n", rv); - - rv = ecp_sock_open(&sock_s, argv[1]); - printf("ecp_sock_open RV:%d\n", rv); - - rv = ecp_start_receiver(&sock_s); - printf("ecp_start_receiver RV:%d\n", rv); - - while (1) sleep(1); -} \ No newline at end of file diff --git a/ecp/test/frag.c b/ecp/test/frag.c deleted file mode 100644 index 70b20de..0000000 --- a/ecp/test/frag.c +++ /dev/null @@ -1,122 +0,0 @@ -#include -#include -#include - -#include "core.h" - -ECPContext ctx_s; -ECPSocket sock_s; -ECPDHKey key_perma_s; -ECPConnHandler handler_s; - -ECPContext ctx_c; -ECPSocket sock_c; -ECPDHKey key_perma_c; -ECPConnHandler handler_c; - -ECPNode node; -ECPConnection conn; - -ECPRBRecv rbuf_recv; -ECPRBMessage rbuf_r_msg[128]; -ECPFragIter frag_iter; -unsigned char frag_buffer[8192]; - -#define CTYPE_TEST 0 -#define MTYPE_MSG 8 - -ssize_t handle_open_c(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - uint32_t seq = 0; - - ecp_conn_handle_open(conn, sq, t, p, s, b); - if (s < 0) { - printf("OPEN ERR:%ld\n", s); - return s; - } - - unsigned char content[1000]; - char *msg = "PERA JE CAR!"; - - strcpy((char *)content, msg); - ssize_t _rv = ecp_send(conn, MTYPE_MSG, content, sizeof(content)); - return s; -} - -ssize_t handle_msg_c(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - printf("MSG C:%s size:%ld\n", p, s); - - ECPRBuffer *rbuf = &conn->rbuf.recv->rbuf; - printf("RBUF: %d %d %d %d\n", rbuf->seq_start, rbuf->seq_max, rbuf->idx_start, rbuf->arr_size); - return s; -} - -ssize_t handle_msg_s(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - printf("MSG S:%s size:%ld\n", p, s); - - unsigned char content[5000]; - char *msg = "VAISTINU JE CAR!"; - - strcpy((char *)content, msg); - ssize_t _rv = ecp_send(conn, MTYPE_MSG, content, sizeof(content)); - return s; -} - -int main(int argc, char *argv[]) { - int rv; - - rv = ecp_init(&ctx_s); - printf("ecp_init RV:%d\n", rv); - - rv = ecp_conn_handler_init(&handler_s); - handler_s.msg[MTYPE_MSG] = handle_msg_s; - ctx_s.handler[CTYPE_TEST] = &handler_s; - - rv = ecp_dhkey_gen(&ctx_s, &key_perma_s); - printf("ecp_dhkey_gen RV:%d\n", rv); - - rv = ecp_sock_init(&sock_s, &ctx_s, &key_perma_s); - printf("ecp_sock_init RV:%d\n", rv); - - rv = ecp_sock_open(&sock_s, "0.0.0.0:3000"); - printf("ecp_sock_open RV:%d\n", rv); - - rv = ecp_start_receiver(&sock_s); - printf("ecp_start_receiver RV:%d\n", rv); - - rv = ecp_init(&ctx_c); - printf("ecp_init RV:%d\n", rv); - - rv = ecp_conn_handler_init(&handler_c); - handler_c.msg[ECP_MTYPE_OPEN] = handle_open_c; - handler_c.msg[MTYPE_MSG] = handle_msg_c; - ctx_c.handler[CTYPE_TEST] = &handler_c; - - rv = ecp_dhkey_gen(&ctx_c, &key_perma_c); - printf("ecp_dhkey_gen RV:%d\n", rv); - - rv = ecp_sock_init(&sock_c, &ctx_c, &key_perma_c); - printf("ecp_sock_init RV:%d\n", rv); - - rv = ecp_sock_open(&sock_c, NULL); - printf("ecp_sock_open RV:%d\n", rv); - - rv = ecp_start_receiver(&sock_c); - printf("ecp_start_receiver RV:%d\n", rv); - - rv = ecp_node_init(&node, &key_perma_s.public, "127.0.0.1:3000"); - printf("ecp_node_init RV:%d\n", rv); - - rv = ecp_conn_init(&conn, &sock_c, CTYPE_TEST); - printf("ecp_conn_init RV:%d\n", rv); - - rv = ecp_rbuf_create(&conn, NULL, NULL, 0, &rbuf_recv, rbuf_r_msg, 128); - printf("ecp_rbuf_create RV:%d\n", rv); - - ecp_frag_iter_init(&frag_iter, frag_buffer, 8192); - rbuf_recv.frag_iter = &frag_iter; - - rv = ecp_conn_open(&conn, &node); - printf("ecp_conn_open RV:%d\n", rv); - - while (1) sleep(1); -} \ No newline at end of file diff --git a/ecp/test/init_vconn.c b/ecp/test/init_vconn.c index 59e9517..88b6fa0 100644 --- a/ecp/test/init_vconn.c +++ b/ecp/test/init_vconn.c @@ -1,18 +1,12 @@ #include -#include #include +#include -#include "core.h" -#include "vconn/vconn.h" +#include +#include -static int v_rng(void *buf, size_t bufsize) { - int fd; - - if((fd = open("/dev/urandom", O_RDONLY)) < 0) return -1; - size_t nb = read(fd, buf, bufsize); - close(fd); - if (nb != bufsize) return -1; - return 0; +void handle_err(ECPConnection *conn, unsigned char mtype, int err) { + printf("ERR: CTYPE:0x%x MTYPE:0x%x ERR:%d\n", conn->type, mtype, err); } static ECPConnection *conn_alloc(ECPSocket *sock, unsigned char type) { @@ -21,40 +15,37 @@ static ECPConnection *conn_alloc(ECPSocket *sock, unsigned char type) { switch (type) { case ECP_CTYPE_VCONN: - conn = malloc(sizeof(ECPVConnIn)); + conn = malloc(sizeof(ECPVConn)); + if (conn) rv = ecp_vconn_create_inb((ECPVConn *)conn, sock); + break; + + case ECP_CTYPE_VLINK: + conn = malloc(sizeof(ECPConnection)); + if (conn) rv = ecp_vlink_create_inb(conn, sock); break; + default: conn = malloc(sizeof(ECPConnection)); + if (conn) rv = ecp_conn_create_inb(conn, sock, type); break; } - if (conn == NULL) return NULL; - rv = ecp_conn_init(conn, sock, type); + if (conn == NULL) return NULL; if (rv) { - printf("free1\n"); free(conn); return NULL; } + return conn; } static void conn_free(ECPConnection *conn) { - printf("free2\n"); free(conn); } int ecp_init(ECPContext *ctx) { int rv; - rv = ecp_ctx_init(ctx); - if (rv) return rv; - - rv = ecp_vconn_ctx_init(ctx); - if (rv) return rv; - - ctx->rng = v_rng; - ctx->conn_alloc = conn_alloc; - ctx->conn_free = conn_free; - - return ECP_OK; + rv = ecp_ctx_init(ctx, handle_err, NULL, conn_alloc, conn_free); + return rv; } \ No newline at end of file diff --git a/ecp/test/server.c b/ecp/test/server.c index fabaf4e..228dbea 100644 --- a/ecp/test/server.c +++ b/ecp/test/server.c @@ -1,10 +1,11 @@ -#include +#include #include #include -#include +#include -#include "core.h" -#include "util.h" +#include + +#include ECPContext ctx; ECPSocket sock; @@ -12,18 +13,16 @@ ECPDHKey key_perma; ECPConnHandler handler; #define CTYPE_TEST 0 -#define MTYPE_MSG 8 - -ssize_t handle_msg(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - printf("MSG S:%s size:%ld\n", p, s); +#define MTYPE_MSG 0 - char *msg = "VAISTINU JE CAR!"; - unsigned char buf[1000]; +static ssize_t handle_msg(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { + char *_msg = "VAISTINU JE CAR!"; + ssize_t rv; - strcpy((char *)buf, msg); - ssize_t _rv = ecp_send(conn, MTYPE_MSG, buf, 1000); + printf("MSG S:%s size:%ld\n", msg, msg_size); + rv = ecp_msg_send(conn, MTYPE_MSG, (unsigned char *)_msg, strlen(_msg)+1); - return s; + return msg_size; } static void usage(char *arg) { @@ -32,28 +31,30 @@ static void usage(char *arg) { } int main(int argc, char *argv[]) { + ECPDHKey key_perma; int rv; - + + /* server */ if (argc != 3) usage(argv[0]); - + rv = ecp_init(&ctx); printf("ecp_init RV:%d\n", rv); - - rv = ecp_conn_handler_init(&handler); - handler.msg[MTYPE_MSG] = handle_msg; - ctx.handler[CTYPE_TEST] = &handler; - - rv = ecp_util_key_load(&ctx, &key_perma, argv[2]); - printf("ecp_util_key_load RV:%d\n", rv); - - rv = ecp_sock_init(&sock, &ctx, &key_perma); - printf("ecp_sock_init RV:%d\n", rv); + + ecp_conn_handler_init(&handler, handle_msg, NULL, NULL, NULL); + ecp_ctx_set_handler(&ctx, &handler, CTYPE_TEST); + + rv = ecp_util_load_key(&key_perma.public, &key_perma.private, argv[2]); + printf("ecp_util_load_key RV:%d\n", rv); + key_perma.valid = 1; + + rv = ecp_sock_create(&sock, &ctx, &key_perma); + printf("ecp_sock_create RV:%d\n", rv); rv = ecp_sock_open(&sock, argv[1]); printf("ecp_sock_open RV:%d\n", rv); - + rv = ecp_start_receiver(&sock); printf("ecp_start_receiver RV:%d\n", rv); while (1) sleep(1); -} \ No newline at end of file +} diff --git a/ecp/test/vc_client.c b/ecp/test/vc_client.c index cd0ea44..89602ca 100644 --- a/ecp/test/vc_client.c +++ b/ecp/test/vc_client.c @@ -1,70 +1,63 @@ -#include +#include #include #include -#include +#include + +#include +#include -#include "core.h" -#include "vconn/vconn.h" -#include "util.h" +#include ECPContext ctx; ECPSocket sock; ECPConnHandler handler; - ECPConnection conn; -ECPNode node; - -ECPVConnOut vconn[20]; -ECPNode vconn_node[20]; +ECPConnection vconn[3]; #define CTYPE_TEST 0 -#define MTYPE_MSG 8 - -ssize_t handle_open(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - uint32_t seq = 0; - - ecp_conn_handle_open(conn, sq, t, p, s, b); - if (s < 0) { - printf("OPEN ERR:%ld\n", s); - return s; - } - - printf("OPEN!\n"); +#define MTYPE_MSG 0 - char *msg = "PERA JE CAR!"; - unsigned char buf[1156]; +static int handle_open(ECPConnection *conn, ECP2Buffer *b) { + char *_msg = "PERA JE CAR!"; + ssize_t rv; - strcpy((char *)buf, msg); - ssize_t _rv = ecp_send(conn, MTYPE_MSG, buf, 1156); + printf("OPEN\n"); + rv = ecp_msg_send(conn, MTYPE_MSG, (unsigned char *)_msg, strlen(_msg)+1); - return s; + return ECP_OK; } -ssize_t handle_msg(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - printf("MSG S:%s size:%ld\n", p, s); - return s; +static ssize_t handle_msg(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { + printf("MSG:%s size:%ld\n", msg, msg_size); + + return msg_size; } static void usage(char *arg) { - fprintf(stderr, "Usage: %s ... \n", arg); + fprintf(stderr, "Usage: %s
[ ... ]\n", arg); exit(1); } int main(int argc, char *argv[]) { + ECPDHKey key_perma; + ECPNode node; + ecp_ecdh_public_t node_pub; + ecp_ecdh_public_t vconn_pub[3]; int rv, i; - if ((argc < 3) || (argc > 22)) usage(argv[0]); + if ((argc < 4) || (argc > 6)) usage(argv[0]); rv = ecp_init(&ctx); printf("ecp_init RV:%d\n", rv); - rv = ecp_conn_handler_init(&handler); - handler.msg[ECP_MTYPE_OPEN] = handle_open; - handler.msg[MTYPE_MSG] = handle_msg; - ctx.handler[CTYPE_TEST] = &handler; + ecp_conn_handler_init(&handler, handle_msg, handle_open, NULL, NULL); + ecp_ctx_set_handler(&ctx, &handler, CTYPE_TEST); - rv = ecp_sock_init(&sock, &ctx, NULL); - printf("ecp_sock_init RV:%d\n", rv); + rv = ecp_dhkey_gen(&key_perma); + printf("ecp_dhkey_gen RV:%d\n", rv); + + rv = ecp_sock_create(&sock, &ctx, &key_perma); + printf("ecp_sock_create RV:%d\n", rv); rv = ecp_sock_open(&sock, NULL); printf("ecp_sock_open RV:%d\n", rv); @@ -72,19 +65,25 @@ int main(int argc, char *argv[]) { rv = ecp_start_receiver(&sock); printf("ecp_start_receiver RV:%d\n", rv); - rv = ecp_util_node_load(&ctx, &node, argv[1]); - printf("ecp_util_node_load RV:%d\n", rv); - - for (i=0; i +#include #include #include -#include +#include -#include "core.h" -#include "vconn/vconn.h" -#include "util.h" +#include +#include + +#include ECPContext ctx; ECPSocket sock; -ECPDHKey key_perma; ECPConnHandler handler; - -ECPNode node; ECPConnection conn; +ECPConnection vconn[3]; #define CTYPE_TEST 0 -#define MTYPE_MSG 8 +#define MTYPE_MSG 0 -ssize_t handle_open(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - printf("OPEN RECEIVED\n"); - return ecp_conn_handle_open(conn, sq, t, p, s, b); -} +static int handle_open(ECPConnection *conn, ECP2Buffer *b) { + printf("OPEN\n"); -ssize_t handle_msg(ECPConnection *conn, ecp_seq_t sq, unsigned char t, unsigned char *p, ssize_t s, ECP2Buffer *b) { - printf("MSG S:%s size:%ld\n", p, s); + return ECP_OK; +} - char *msg = "VAISTINU JE CAR!"; - unsigned char buf[1000]; +static ssize_t handle_msg(ECPConnection *conn, ecp_seq_t seq, unsigned char mtype, unsigned char *msg, size_t msg_size, ECP2Buffer *b) { + char *_msg = "VAISTINU JE CAR!"; + ssize_t rv; - strcpy((char *)buf, msg); - ssize_t _rv = ecp_send(conn, MTYPE_MSG, buf, strlen(msg)+1); + printf("MSG:%s size:%ld\n", msg, msg_size); + rv = ecp_msg_send(conn, MTYPE_MSG, (unsigned char *)_msg, strlen(_msg)+1); - return s; + return msg_size; } static void usage(char *arg) { - fprintf(stderr, "Usage: %s \n", arg); + fprintf(stderr, "Usage: %s
[ ... ]\n", arg); exit(1); } int main(int argc, char *argv[]) { - int rv; + ECPDHKey key_perma; + ECPNode node; + ecp_ecdh_public_t node_pub; + int rv, i; - if (argc != 3) usage(argv[0]); + if ((argc < 4) || (argc > 7)) usage(argv[0]); rv = ecp_init(&ctx); printf("ecp_init RV:%d\n", rv); - rv = ecp_conn_handler_init(&handler); - handler.msg[ECP_MTYPE_OPEN] = handle_open; - handler.msg[MTYPE_MSG] = handle_msg; - ctx.handler[CTYPE_TEST] = &handler; + ecp_conn_handler_init(&handler, handle_msg, handle_open, NULL, NULL); + ecp_ctx_set_handler(&ctx, &handler, CTYPE_TEST); - rv = ecp_util_key_load(&ctx, &key_perma, argv[1]); - printf("ecp_util_key_load RV:%d\n", rv); + rv = ecp_util_load_key(&key_perma.public, &key_perma.private, argv[1]); + printf("ecp_util_load_key RV:%d\n", rv); + key_perma.valid = 1; - rv = ecp_sock_init(&sock, &ctx, &key_perma); - printf("ecp_sock_init RV:%d\n", rv); + rv = ecp_sock_create(&sock, &ctx, &key_perma); + printf("ecp_sock_create RV:%d\n", rv); rv = ecp_sock_open(&sock, NULL); printf("ecp_sock_open RV:%d\n", rv); @@ -65,14 +65,29 @@ int main(int argc, char *argv[]) { rv = ecp_start_receiver(&sock); printf("ecp_start_receiver RV:%d\n", rv); - rv = ecp_util_node_load(&ctx, &node, argv[2]); - printf("ecp_util_node_load RV:%d\n", rv); + rv = ecp_vlink_create(&conn, &sock); + printf("ecp_vlink_create RV:%d\n", rv); + + if (argc > 4) { + ecp_ecdh_public_t vconn_key[3]; + + for (i=3; i +#include #include #include -#include +#include -#include "core.h" -#include "util.h" -#include "vconn/vconn.h" +#include +#include + +#include ECPContext ctx; ECPSocket sock; -ECPDHKey key_perma; - -ECPNode node; ECPConnection conn; static void usage(char *arg) { - fprintf(stderr, "Usage: %s
[node.pub]\n", arg); + fprintf(stderr, "Usage: %s [ ]\n", arg); exit(1); } int main(int argc, char *argv[]) { + ECPDHKey key_perma; int rv; - - if ((argc < 3) || (argc > 4)) usage(argv[0]); - + + if ((argc < 3) || (argc > 5)) usage(argv[0]); + rv = ecp_init(&ctx); printf("ecp_init RV:%d\n", rv); - - rv = ecp_util_key_load(&ctx, &key_perma, argv[2]); - printf("ecp_util_key_load RV:%d\n", rv); - - rv = ecp_sock_init(&sock, &ctx, &key_perma); - printf("ecp_sock_init RV:%d\n", rv); + + rv = ecp_util_load_key(&key_perma.public, &key_perma.private, argv[2]); + printf("ecp_util_load_key RV:%d\n", rv); + key_perma.valid = 1; + + rv = ecp_sock_create(&sock, &ctx, &key_perma); + printf("ecp_sock_create RV:%d\n", rv); rv = ecp_sock_open(&sock, argv[1]); printf("ecp_sock_open RV:%d\n", rv); - + rv = ecp_start_receiver(&sock); printf("ecp_start_receiver RV:%d\n", rv); - - if (argc == 4) { - rv = ecp_util_node_load(&ctx, &node, argv[3]); - printf("ecp_util_node_load RV:%d\n", rv); - rv = ecp_conn_init(&conn, &sock, ECP_CTYPE_VLINK); - printf("ecp_conn_init RV:%d\n", rv); + if (argc == 5) { + ECPNode node; + ecp_ecdh_public_t node_pub; + + rv = ecp_vlink_create(&conn, &sock); + printf("ecp_vlink_create RV:%d\n", rv); + + rv = ecp_util_load_pub(&node_pub, argv[4]); + printf("ecp_util_load_pub RV:%d\n", rv); + + rv = ecp_node_init(&node, &node_pub, argv[3]); + printf("ecp_node_init RV:%d\n", rv); rv = ecp_conn_open(&conn, &node); printf("ecp_conn_open RV:%d\n", rv); } while (1) sleep(1); -} \ No newline at end of file +} diff --git a/ecp/test/vid/Makefile b/ecp/test/vid/Makefile deleted file mode 100644 index a9b92eb..0000000 --- a/ecp/test/vid/Makefile +++ /dev/null @@ -1,23 +0,0 @@ -include ../../ecp/Makefile.platform - -LIBVPX_HOME = /opt/my/libvpx -CFLAGS += -D_V4L2_KERNEL_ -I/usr/src/linux-headers-$(uname -r) -I$(LIBVPX_HOME) -I/opt/local/include/SDL2 -I../../ecp -I../../util -Wno-int-to-void-pointer-cast -LDFLAGS += -L$(LIBVPX_HOME) -L/opt/local/lib - -dep=../init_vconn.o ../../ecp/build-posix/*.a ../../util/libecputil.a - -all: cap - -%.o: %.c - $(CC) $(CFLAGS) -c $< - -cap: cap.o enc.o tools.o server.o - $(CC) -o $@ $< enc.o tools.o server.o $(dep) -lvpx $(LDFLAGS) - -client: client.o display.o tools.o - $(CC) -o $@ $< display.o tools.o $(dep) -lvpx -lSDL2 $(LDFLAGS) - -clean: - rm -f *.o - rm -f cap client - diff --git a/ecp/test/vid/cap.c b/ecp/test/vid/cap.c deleted file mode 100644 index e37c28f..0000000 --- a/ecp/test/vid/cap.c +++ /dev/null @@ -1,576 +0,0 @@ -/* - * OpenCV BSD3 License - * videodev2.h BSD License (dual license) - * If you raise some license issue here simply don't use it and let us know - * - * Copyright (C) 2016 the contributors - * - * Luiz Vitor Martinez Cardoso - * Jules Thuillier - * @lex (avafinger) - * - * gcc cap.c -o cap $(pkg-config --libs --cflags opencv) -lm - * - * gcc -I/usr/src/linux-headers-VERSION/ cap.c -o cap $(pkg-config --libs --cflags opencv) -lm -O3 - * -*/ - -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -/* ----------------------------------------------------------------------------- - * BananaPi M64 / Pine64+ (A64) or if you want to control Exposure,Hflip,Vflip - * ----------------------------------------------------------------------------- - * _V4L2_KERNEL_ should be defined and point to: /usr/src/linux-headers-version - * - * build with: gcc -I/usr/src/linux-headers-3.10.102/ cap.c -o cap $(pkg-config --libs --cflags opencv) -lm -O3 - * - * - * ----------------------------------------------------------------------------- - * OrangePi / BananaPi / NanoPi (H3) / BPI-M3 (A83T - ov5640 & ov8865) - * ----------------------------------------------------------------------------- - * _V4L2_KERNEL_ should not be defined unless you want Exposure, Hflip and Vflip - * - * build with: gcc cap.c -o cap $(pkg-config --libs --cflags opencv) -lm - * - * -*/ -//#define _V4L2_KERNEL_ // BananaPi M64 / Pine64+ only or for setting Exposure,Hflip,Vflip - -#ifdef _V4L2_KERNEL_ -/* --- A64 --- */ -#include -#else -/* --- H3 / A83T --- */ -#include "videodev2.h" -#endif - -#ifdef _V4L2_KERNEL_ -#define V4L2_MODE_VIDEO 0x0002 /* video capture */ -#define V4L2_MODE_IMAGE 0x0003 /* image capture */ -#define V4L2_MODE_PREVIEW 0x0004 /* preview capture */ -#endif - -#define N_BUFFERS 4 -#define CAP_OK 0 -#define CAP_ERROR -1 -#define CAP_ERROR_RET(s) { \ - fprintf(stderr, "v4l2: %s\n", s); \ - return CAP_ERROR; \ - } -#define CAP_CLIP(val, min, max) (((val) > (max)) ? (max) : (((val) < (min)) ? (min) : (val))) - -#define CLEAR(x) memset (&(x), 0, sizeof (x)) -#define ALIGN_4K(x) (((x) + (4095)) & ~(4095)) -#define ALIGN_16B(x) (((x) + (15)) & ~(15)) - -#include "server.h" -#include "enc.h" - -typedef struct { - void *start; - size_t length; -} v4l2_buffer_t; - -int width; -int height; -v4l2_buffer_t *buffers = NULL; -int n_buffers = N_BUFFERS; -int sensor_video_mode; -int sensor_exposure; -int sensor_hflip; -int sensor_vflip; - -double get_wall_time() -{ - struct timeval time; - if (gettimeofday(&time, NULL)) - return 0.; - return (double) time.tv_sec + (double) time.tv_usec * .000001; -} - -int yuv420p_to_bgr(void *in, int length, unsigned char *out) -{ - uint8_t *yptr, *uptr, *vptr; - uint32_t x, y, p; - - if (length < (width * height * 3) / 2) - return CAP_ERROR; - - yptr = (uint8_t *) in; - uptr = yptr + (width * height); - vptr = uptr + (width * height / 4); - p = 0; - - for (y = 0; y < height; y++) { - for (x = 0; x < width; x++) { - int r, g, b; - int y, u, v; - - y = *(yptr++) << 8; - u = uptr[p] - 128; - v = vptr[p] - 128; - - r = (y + (359 * v)) >> 8; - g = (y - (88 * u) - (183 * v)) >> 8; - b = (y + (454 * u)) >> 8; - - *(out++) += CAP_CLIP(b, 0x00, 0xFF); - *(out++) += CAP_CLIP(g, 0x00, 0xFF); - *(out++) += CAP_CLIP(r, 0x00, 0xFF); - - if (x & 1) - p++; - } - - if (!(y & 1)) - p -= width / 2; - } - - return CAP_ERROR; -} - -static int xioctl(int fd, int request, void *arg) -{ - int r; - int tries = 3; - - do { - r = ioctl(fd, request, arg); - } while (--tries > 0 && -1 == r && EINTR == errno); - - return r; -} - -int v4l2_display_sizes_pix_format(int fd) -{ - int ret = 0; - int fsizeind = 0; /*index for supported sizes*/ - struct v4l2_frmsizeenum fsize; - - fprintf(stderr, "V4L2 pixel sizes:\n"); - - CLEAR(fsize); - fsize.index = 0; - fsize.pixel_format = V4L2_PIX_FMT_YUV420; - - while ((ret = xioctl(fd, VIDIOC_ENUM_FRAMESIZES, &fsize)) == 0) { - fsize.index++; - if (fsize.type == V4L2_FRMSIZE_TYPE_DISCRETE) { - fprintf(stderr, "( %u x %u ) Pixels\n", fsize.discrete.width, fsize.discrete.height); - fsizeind++; - } - } - return fsizeind; -} - -int v4l2_display_pix_format(int fd) -{ - struct v4l2_fmtdesc fmt; - int index; - - fprintf(stderr, "V4L2 pixel formats:\n"); - - index = 0; - CLEAR(fmt); - fmt.index = index; - fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - - while (ioctl(fd, VIDIOC_ENUM_FMT, &fmt) != -1) { - fprintf(stderr, "%i: [0x%08X] '%c%c%c%c' (%s)\n", index, fmt.pixelformat, fmt.pixelformat >> 0, fmt.pixelformat >> 8, fmt.pixelformat >> 16, fmt.pixelformat >> 24, fmt.description); - - memset(&fmt, 0, sizeof(fmt)); - fmt.index = ++index; - fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - } - // fprintf(stderr, "\n"); -} - -#ifdef _V4L2_KERNEL_ -int v4l2_set_exposure(int fd, int exposure) -{ - struct v4l2_queryctrl queryctrl; - struct v4l2_control control; - int rc; - - fprintf(stderr, "set Exposure: %d\n", exposure); - rc = 0; - memset(&control, 0, sizeof(control)); - control.id = V4L2_CID_EXPOSURE; - rc = xioctl(fd, VIDIOC_G_CTRL, &control); - fprintf(stderr, "rc: %d - get exposure: %d\n", rc, control.value); - control.value = exposure; - rc = xioctl(fd, VIDIOC_S_CTRL, &control); - fprintf(stderr, "rc: %d - new exposure: %d\n", rc, exposure); - return rc; -} - -int v4l2_set_hflip(int fd, int hflip) -{ - struct v4l2_queryctrl queryctrl; - struct v4l2_control control; - int rc; - - fprintf(stderr, "set Hflip: %d\n", hflip); - rc = 0; - memset(&control, 0, sizeof(control)); - control.id = V4L2_CID_HFLIP; - rc = xioctl(fd, VIDIOC_G_CTRL, &control); - fprintf(stderr, "rc: %d - get value: %d\n", rc, control.value); - control.value = hflip; - rc = xioctl(fd, VIDIOC_S_CTRL, &control); - fprintf(stderr, "rc: %d - new value: %d\n", rc, control.value); - return rc; -} - -int v4l2_set_vflip(int fd, int vflip) -{ - struct v4l2_queryctrl queryctrl; - struct v4l2_control control; - int rc; - - fprintf(stderr, "set Vflip: %d\n", vflip); - rc = 0; - memset(&control, 0, sizeof(control)); - control.id = V4L2_CID_VFLIP; - rc = xioctl(fd, VIDIOC_G_CTRL, &control); - fprintf(stderr, "rc: %d - get value: %d\n", rc, control.value); - control.value = vflip; - rc = xioctl(fd, VIDIOC_S_CTRL, &control); - fprintf(stderr, "rc: %d - new value: %d\n", rc, control.value); - return rc; -} -#endif - -int v4l2_init_camera(int fd) -{ - uint32_t i; - uint32_t index; - struct v4l2_streamparm parms; - struct v4l2_format fmt; - struct v4l2_input input; - struct v4l2_capability caps; - - CLEAR(fmt); - CLEAR(input); - CLEAR(caps); - - - if (xioctl(fd, VIDIOC_QUERYCAP, &caps) == -1) { - CAP_ERROR_RET("unable to query capabilities."); - } - - if (!(caps.capabilities & V4L2_CAP_VIDEO_CAPTURE)) { - CAP_ERROR_RET("doesn't support video capturing."); - } - - fprintf(stderr, "Driver: \"%s\"\n", caps.driver); - fprintf(stderr, "Card: \"%s\"\n", caps.card); - fprintf(stderr, "Bus: \"%s\"\n", caps.bus_info); - fprintf(stderr, "Version: %d.%d\n", (caps.version >> 16) && 0xff, (caps.version >> 24) && 0xff); - fprintf(stderr, "Capabilities: %08x\n", caps.capabilities); - - input.index = 0; - if (xioctl(fd, VIDIOC_ENUMINPUT, &input) == -1) { - CAP_ERROR_RET("unable to enumerate input."); - } - - fprintf(stderr, "Input: %d\n", input.index); - if (xioctl(fd, VIDIOC_S_INPUT, &input.index) == -1) { - CAP_ERROR_RET("unable to set input."); - } - - parms.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - parms.parm.capture.capturemode = sensor_video_mode ? V4L2_MODE_VIDEO : V4L2_MODE_IMAGE; - parms.parm.capture.timeperframe.numerator = 1; - parms.parm.capture.timeperframe.denominator = sensor_video_mode ? 30 : 7; - if (-1 == xioctl(fd, VIDIOC_S_PARM, &parms)) { - CAP_ERROR_RET("unable to set stream parm."); - } - - v4l2_display_pix_format(fd); - v4l2_display_sizes_pix_format(fd); - fprintf(stderr, "\n"); - - fmt.fmt.pix.width = width; - fmt.fmt.pix.height = height; - fmt.fmt.pix.field = V4L2_FIELD_NONE; // V4L2_FIELD_ANY; - fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_YUV420; - //fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_RGB24; - - if (xioctl(fd, VIDIOC_TRY_FMT, &fmt) == -1) { - CAP_ERROR_RET("failed trying to set pixel format."); - } - - if (fmt.fmt.pix.width != width || fmt.fmt.pix.height != height) { - width = fmt.fmt.pix.width; - height = fmt.fmt.pix.height; - fprintf(stderr, "Sensor size adjusted to: %dx%d pixels\n", width, height); - } else { - fprintf(stderr, "Sensor size: %dx%d pixels\n", width, height); - } - - if (xioctl(fd, VIDIOC_S_FMT, &fmt) == -1) { - CAP_ERROR_RET("failed to set pixel format."); - } - - switch (fmt.fmt.pix.pixelformat) { - case V4L2_PIX_FMT_RGB24: - fprintf(stderr, "Pixel Format: V4L2_PIX_FMT_RGB24 [0x%08X]\n",fmt.fmt.pix.pixelformat); - break; - - case V4L2_PIX_FMT_YUV420: - fprintf(stderr, "Pixel Format: V4L2_PIX_FMT_YUV420 [0x%08X]\n",fmt.fmt.pix.pixelformat); - break; - - } - - return CAP_OK; -} - -int v4l2_set_mmap(int fd, int *buffers_count) -{ - int i; - int nbf; - enum v4l2_buf_type type; - struct v4l2_requestbuffers req; - struct v4l2_buffer buf; - - CLEAR(req); - req.count = sensor_video_mode ? n_buffers : 1; - req.memory = V4L2_MEMORY_MMAP; - req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - if (xioctl(fd, VIDIOC_REQBUFS, &req) == -1) { - CAP_ERROR_RET("failed requesting buffers."); - } - nbf = req.count; - if (n_buffers != nbf) { - CAP_ERROR_RET("insufficient buffer memory."); - } - - buffers = (v4l2_buffer_t *) calloc(nbf, sizeof(v4l2_buffer_t)); - if (!buffers) { - CAP_ERROR_RET("failed to allocated buffers memory."); - } - - for (i = 0; i < nbf; i++) { - CLEAR(buf); - buf.index = i; - buf.memory = V4L2_MEMORY_MMAP; - buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - if (xioctl(fd, VIDIOC_QUERYBUF, &buf) == -1) { - CAP_ERROR_RET("failed to query buffer."); - } - buffers[i].length = buf.length; - buffers[i].start = mmap(NULL, buf.length, PROT_READ | PROT_WRITE, MAP_SHARED, fd, buf.m.offset); - if (MAP_FAILED == buffers[i].start) { - CAP_ERROR_RET("failed to mmap buffer."); - } - } - - for (i = 0; i < nbf; i++) { - CLEAR(buf); - buf.index = i; - buf.memory = V4L2_MEMORY_MMAP; - buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - - if (xioctl(fd, VIDIOC_QBUF, &buf) == -1) { - CAP_ERROR_RET("failed to queue buffer."); - } - } - - type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - if (xioctl(fd, VIDIOC_STREAMON, &type) == -1) { - CAP_ERROR_RET("failed to stream on."); - } - - *buffers_count = nbf; - - return CAP_OK; -} - -int v4l2_retrieve_frame(int fd, int buffers_count, vpx_image_t *raw, vpx_codec_ctx_t *codec, int frame_index, int kframe_interval) -{ - int sz; - fd_set fds; - unsigned char *frame_yuv; - struct timeval tv; - struct v4l2_buffer buf; - int rc; - char err_msg[128]; - int flags = 0; - - CLEAR(tv); - CLEAR(buf); - - rc = 1; - while (rc > 0) { - FD_ZERO(&fds); - FD_SET(fd, &fds); - - tv.tv_sec = 2; - tv.tv_usec = 0; - - rc = select(fd + 1, &fds, NULL, NULL, &tv); - if (-1 == rc) { - if (EINTR == errno) { - rc = 1; // try again - continue; - } - CAP_ERROR_RET("failed to select frame."); - } - /* we got something */ - break; - } - if (rc <= 0) { - sprintf(err_msg, "errno: %d - check sensor, something wrong.", errno); - CAP_ERROR_RET(err_msg); - } - - buf.memory = V4L2_MEMORY_MMAP; - buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - if (xioctl(fd, VIDIOC_DQBUF, &buf) == -1) { - CAP_ERROR_RET("failed to retrieve frame."); - } - - // fprintf(stderr, "Length: %d \tBytesused: %d \tAddress: %p\n", buf.length, buf.bytesused, &buffers[buf.index]); - - sz = ALIGN_16B(width) * height * 3 / 2; - if (!vpx_img_read(raw, buffers[buf.index].start, sz)) { - die_codec(NULL, "Failed to read image."); - } - if (frame_index % kframe_interval == 0) flags |= VPX_EFLAG_FORCE_KF; - vpx_encode_frame(codec, raw, frame_index, flags); - - if (xioctl(fd, VIDIOC_QBUF, &buf) == -1) { - CAP_ERROR_RET("failed to queue buffer."); - } - - return CAP_OK; -} - -int v4l2_close_camera(int fd, int buffers_count) -{ - int i; - enum v4l2_buf_type type; - - type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - if (xioctl(fd, VIDIOC_STREAMOFF, &type) == -1) { - CAP_ERROR_RET("failed to stream off."); - } - - for (i = 0; i < buffers_count; i++) - munmap(buffers[i].start, buffers[i].length); - - close(fd); -} - -int main(int argc, char *argv[]) -{ - int fd; - int target_bitrate = 200; - double after; - double before; - double avg, fps; - int buffers_count; - int kframe_interval; - vpx_codec_er_flags_t err_resilient; - char *address; - char *my_key; - char *vcs_key; - - if (argc != 14) { - CAP_ERROR_RET("./cap