[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/bsp/lk/app/inetsrv/inetsrv.c b/src/bsp/lk/app/inetsrv/inetsrv.c
new file mode 100644
index 0000000..11d412b
--- /dev/null
+++ b/src/bsp/lk/app/inetsrv/inetsrv.c
@@ -0,0 +1,238 @@
+/*
+ * Copyright (c) 2014 Travis Geiselbrecht
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining
+ * a copy of this software and associated documentation files
+ * (the "Software"), to deal in the Software without restriction,
+ * including without limitation the rights to use, copy, modify, merge,
+ * publish, distribute, sublicense, and/or sell copies of the Software,
+ * and to permit persons to whom the Software is furnished to do so,
+ * subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be
+ * included in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
+ * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
+ * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
+ * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+ */
+#include <app.h>
+#include <err.h>
+#include <debug.h>
+#include <trace.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <compiler.h>
+#include <kernel/thread.h>
+#include <lib/minip.h>
+#include <lib/tftp.h>
+#include <lib/cksum.h>
+#include <platform.h>
+
+#include "inetsrv.h"
+
+static int chargen_worker(void *socket)
+{
+ uint64_t count = 0;
+ tcp_socket_t *s = socket;
+
+/* enough buffer to hold an entire defacto chargen sequences */
+#define CHARGEN_BUFSIZE (0x5f * 0x5f) // 9025 bytes
+
+ uint8_t *buf = malloc(CHARGEN_BUFSIZE);
+ if (!buf)
+ return ERR_NO_MEMORY;
+
+ /* generate the sequence */
+ uint8_t c = '!';
+ for (size_t i = 0; i < CHARGEN_BUFSIZE; i++) {
+ buf[i] = c++;
+ if (c == 0x7f)
+ c = ' ';
+ }
+
+ lk_time_t t = current_time();
+ for (;;) {
+ ssize_t ret = tcp_write(s, buf, CHARGEN_BUFSIZE);
+ //TRACEF("tcp_write returns %d\n", ret);
+ if (ret < 0)
+ break;
+
+ count += ret;
+ }
+ t = current_time() - t;
+
+ TRACEF("chargen worker exiting, wrote %llu bytes in %u msecs (%llu bytes/sec)\n",
+ count, (uint32_t)t, count * 1000 / t);
+ free(buf);
+ tcp_close(s);
+
+ return 0;
+}
+
+static int chargen_server(void *arg)
+{
+ status_t err;
+ tcp_socket_t *listen_socket;
+
+ err = tcp_open_listen(&listen_socket, 19);
+ if (err < 0) {
+ TRACEF("error opening chargen listen socket\n");
+ return -1;
+ }
+
+ for (;;) {
+ tcp_socket_t *accept_socket;
+
+ err = tcp_accept(listen_socket, &accept_socket);
+ TRACEF("tcp_accept returns returns %d, handle %p\n", err, accept_socket);
+ if (err < 0) {
+ TRACEF("error accepting socket, retrying\n");
+ continue;
+ }
+
+ TRACEF("starting chargen worker\n");
+ thread_detach_and_resume(thread_create("chargen_worker", &chargen_worker, accept_socket, DEFAULT_PRIORITY, DEFAULT_STACK_SIZE));
+ }
+}
+
+static int discard_worker(void *socket)
+{
+ uint64_t count = 0;
+ uint32_t crc = 0;
+ tcp_socket_t *s = socket;
+
+#define DISCARD_BUFSIZE 1024
+
+ uint8_t *buf = malloc(DISCARD_BUFSIZE);
+ if (!buf) {
+ TRACEF("error allocating buffer\n");
+ }
+
+ lk_time_t t = current_time();
+ for (;;) {
+ ssize_t ret = tcp_read(s, buf, DISCARD_BUFSIZE);
+ if (ret <= 0)
+ break;
+
+ crc = crc32(crc, buf, ret);
+
+ count += ret;
+ }
+ t = current_time() - t;
+
+ TRACEF("discard worker exiting, read %llu bytes in %u msecs (%llu bytes/sec), crc32 0x%x\n",
+ count, (uint32_t)t, count * 1000 / t, crc);
+ tcp_close(s);
+
+ free(buf);
+
+ return 0;
+}
+
+static int discard_server(void *arg)
+{
+ status_t err;
+ tcp_socket_t *listen_socket;
+
+ err = tcp_open_listen(&listen_socket, 9);
+ if (err < 0) {
+ TRACEF("error opening discard listen socket\n");
+ return -1;
+ }
+
+ for (;;) {
+ tcp_socket_t *accept_socket;
+
+ err = tcp_accept(listen_socket, &accept_socket);
+ TRACEF("tcp_accept returns returns %d, handle %p\n", err, accept_socket);
+ if (err < 0) {
+ TRACEF("error accepting socket, retrying\n");
+ continue;
+ }
+
+ TRACEF("starting discard worker\n");
+ thread_detach_and_resume(thread_create("discard_worker", &discard_worker, accept_socket, DEFAULT_PRIORITY, DEFAULT_STACK_SIZE));
+ }
+}
+
+static int echo_worker(void *socket)
+{
+ tcp_socket_t *s = socket;
+
+#define ECHO_BUFSIZE 1024
+
+ uint8_t *buf = malloc(ECHO_BUFSIZE);
+ if (!buf) {
+ TRACEF("error allocating buffer\n");
+ return ERR_NO_MEMORY;
+ }
+
+ for (;;) {
+ ssize_t ret = tcp_read(s, buf, sizeof(buf));
+ if (ret <= 0)
+ break;
+
+ tcp_write(s, buf, ret);
+ if (ret <= 0)
+ break;
+ }
+
+ TRACEF("echo worker exiting\n");
+ tcp_close(s);
+ free(buf);
+
+ return 0;
+}
+
+static int echo_server(void *arg)
+{
+ status_t err;
+ tcp_socket_t *listen_socket;
+
+ err = tcp_open_listen(&listen_socket, 7);
+ if (err < 0) {
+ TRACEF("error opening echo listen socket\n");
+ return -1;
+ }
+
+ for (;;) {
+ tcp_socket_t *accept_socket;
+
+ err = tcp_accept(listen_socket, &accept_socket);
+ TRACEF("tcp_accept returns returns %d, handle %p\n", err, accept_socket);
+ if (err < 0) {
+ TRACEF("error accepting socket, retrying\n");
+ continue;
+ }
+
+ TRACEF("starting echo worker\n");
+ thread_detach_and_resume(thread_create("echo_worker", &echo_worker, accept_socket, DEFAULT_PRIORITY, DEFAULT_STACK_SIZE));
+ }
+}
+
+static void inetsrv_init(const struct app_descriptor *app)
+{
+}
+
+static void inetsrv_entry(const struct app_descriptor *app, void *args)
+{
+ /* XXX wait for the stack to initialize */
+
+ printf("starting internet servers\n");
+
+ thread_detach_and_resume(thread_create("chargen", &chargen_server, NULL, DEFAULT_PRIORITY, DEFAULT_STACK_SIZE));
+ thread_detach_and_resume(thread_create("discard", &discard_server, NULL, DEFAULT_PRIORITY, DEFAULT_STACK_SIZE));
+ thread_detach_and_resume(thread_create("echo", &echo_server, NULL, DEFAULT_PRIORITY, DEFAULT_STACK_SIZE));
+ tftp_server_init(NULL);
+}
+
+APP_START(inetsrv)
+ .init = inetsrv_init,
+ .entry = inetsrv_entry,
+ .flags = 0,
+APP_END