| /* |
| * Licensed to the Apache Software Foundation (ASF) under one |
| * or more contributor license agreements. See the NOTICE file |
| * distributed with this work for additional information |
| * regarding copyright ownership. The ASF licenses this file |
| * to you under the Apache License, Version 2.0 (the |
| * "License"); you may not use this file except in compliance |
| * with the License. You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, |
| * software distributed under the License is distributed on an |
| * "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY |
| * KIND, either express or implied. See the License for the |
| * specific language governing permissions and limitations |
| * under the License. |
| */ |
| |
| #include "syscfg/syscfg.h" |
| |
| #if MYNEWT_VAL(BTTESTER_PIPE_RTT) |
| |
| #include "os/mynewt.h" |
| #include "console/console.h" |
| #include "rtt/SEGGER_RTT.h" |
| |
| #include "bttester_pipe.h" |
| |
| static struct hal_timer rtt_timer; |
| |
| static bttester_pipe_recv_cb app_cb; |
| |
| static u8_t *recv_buf; |
| static size_t recv_buf_len; |
| static size_t recv_off; |
| |
| static uint8_t rtt_buf_up[MYNEWT_VAL(BTTESTER_RTT_BUFFER_SIZE_UP)]; |
| static uint8_t rtt_buf_down[MYNEWT_VAL(BTTESTER_RTT_BUFFER_SIZE_DOWN)]; |
| static int rtt_index_up, rtt_index_down; |
| |
| #define RTT_INPUT_POLL_INTERVAL_MIN 10 /* ms */ |
| #define RTT_INPUT_POLL_INTERVAL_STEP 10 /* ms */ |
| #define RTT_INPUT_POLL_INTERVAL_MAX 250 /* ms */ |
| |
| static int rtt_pipe_get_char(unsigned int index) |
| { |
| char c; |
| int r; |
| |
| r = (int)SEGGER_RTT_Read(index, &c, 1u); |
| if (r == 1) { |
| r = (int)(unsigned char)c; |
| } else { |
| r = -1; |
| } |
| |
| return r; |
| } |
| |
| static void |
| rtt_pipe_poll_func(void *arg) |
| { |
| static uint32_t itvl_ms = RTT_INPUT_POLL_INTERVAL_MIN; |
| static int key = -1; |
| int avail = recv_buf_len - recv_off; |
| |
| if (key < 0) { |
| key = rtt_pipe_get_char((unsigned int) rtt_index_down); |
| } |
| |
| if (key < 0) { |
| itvl_ms += RTT_INPUT_POLL_INTERVAL_STEP; |
| itvl_ms = min(itvl_ms, RTT_INPUT_POLL_INTERVAL_MAX); |
| } else { |
| while (key >= 0 && avail > 0) { |
| recv_buf[recv_off] = (u8_t) key; |
| recv_off++; |
| avail = recv_buf_len - recv_off; |
| key = rtt_pipe_get_char((unsigned int) rtt_index_down); |
| } |
| |
| /* |
| * Call application callback with received data. Application |
| * may provide new buffer or alter data offset. |
| */ |
| recv_buf = app_cb(recv_buf, &recv_off); |
| |
| itvl_ms = RTT_INPUT_POLL_INTERVAL_MIN; |
| } |
| |
| os_cputime_timer_relative(&rtt_timer, itvl_ms * 1000); |
| } |
| |
| int |
| bttester_pipe_send(const u8_t *data, int len) |
| { |
| SEGGER_RTT_Write((unsigned int) rtt_index_up, data, (unsigned int) len); |
| return 0; |
| } |
| |
| void |
| bttester_pipe_register(u8_t *buf, size_t len, bttester_pipe_recv_cb cb) |
| { |
| recv_buf = buf; |
| recv_buf_len = len; |
| app_cb = cb; |
| } |
| |
| int |
| bttester_pipe_init(void) |
| { |
| rtt_index_up = SEGGER_RTT_AllocUpBuffer(MYNEWT_VAL(BTTESTER_RTT_BUFFER_NAME), |
| rtt_buf_up, sizeof(rtt_buf_up), |
| SEGGER_RTT_MODE_BLOCK_IF_FIFO_FULL); |
| |
| if (rtt_index_up < 0) { |
| return -1; |
| } |
| |
| rtt_index_down = SEGGER_RTT_AllocDownBuffer(MYNEWT_VAL(BTTESTER_RTT_BUFFER_NAME), |
| rtt_buf_down, sizeof(rtt_buf_down), |
| SEGGER_RTT_MODE_BLOCK_IF_FIFO_FULL); |
| |
| if (rtt_index_down < 0) { |
| return -1; |
| } |
| |
| console_printf("Using up-buffer #%d\n", rtt_index_up); |
| console_printf("Using down-buffer #%d\n", rtt_index_down); |
| |
| os_cputime_timer_init(&rtt_timer, rtt_pipe_poll_func, NULL); |
| os_cputime_timer_relative(&rtt_timer, 200000); |
| return 0; |
| } |
| #endif /* MYNEWT_VAL(BTTESTER_PIPE_RTT) */ |