2022-02-16 08:23:49 +01:00
|
|
|
/****************************************************************************
|
2023-12-22 09:09:24 +01:00
|
|
|
* drivers/rpmsg/rpmsg_ping.c
|
2022-02-16 08:23:49 +01:00
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Included Files
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <nuttx/arch.h>
|
2023-12-22 09:09:24 +01:00
|
|
|
#include <nuttx/signal.h>
|
2022-02-16 08:23:49 +01:00
|
|
|
|
|
|
|
#include <inttypes.h>
|
|
|
|
#include <string.h>
|
2023-02-01 14:41:12 +01:00
|
|
|
#include <sys/param.h>
|
2023-09-28 10:37:27 +02:00
|
|
|
#include <time.h>
|
2023-12-22 09:09:24 +01:00
|
|
|
#include <syslog.h>
|
|
|
|
|
|
|
|
#include "rpmsg_ping.h"
|
2022-02-16 08:23:49 +01:00
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Pre-processor definitions
|
|
|
|
****************************************************************************/
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
#define RPMSG_PING_EPT_NAME "rpmsg-ping"
|
|
|
|
#define RPMSG_PING_SEND 1
|
|
|
|
#define RPMSG_PING_SEND_CHECK 2
|
|
|
|
#define RPMSG_PING_SEND_NOACK 3
|
|
|
|
#define RPMSG_PING_ACK 4
|
|
|
|
#define RPMSG_PING_CHECK_DATA 0xee
|
2022-02-16 08:23:49 +01:00
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Types
|
|
|
|
****************************************************************************/
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
begin_packed_struct struct rpmsg_ping_msg_s
|
2022-02-16 08:23:49 +01:00
|
|
|
{
|
|
|
|
uint32_t cmd;
|
|
|
|
uint32_t len;
|
|
|
|
uint64_t cookie;
|
2023-10-31 08:58:38 +01:00
|
|
|
uint8_t data[1];
|
2022-02-16 08:23:49 +01:00
|
|
|
} end_packed_struct;
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
static int rpmsg_ping_ept_cb(FAR struct rpmsg_endpoint *ept,
|
2022-02-16 08:23:49 +01:00
|
|
|
FAR void *data, size_t len, uint32_t src,
|
|
|
|
FAR void *priv)
|
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
FAR struct rpmsg_ping_msg_s *msg = data;
|
2022-02-16 08:23:49 +01:00
|
|
|
FAR sem_t *sem = (FAR sem_t *)(uintptr_t)msg->cookie;
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
if (msg->cmd == RPMSG_PING_SEND)
|
2022-02-16 08:23:49 +01:00
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
msg->cmd = RPMSG_PING_ACK;
|
2023-10-31 08:58:38 +01:00
|
|
|
rpmsg_send(ept, msg, len);
|
|
|
|
}
|
2023-12-22 09:09:24 +01:00
|
|
|
else if (msg->cmd == RPMSG_PING_SEND_CHECK)
|
2023-10-31 08:58:38 +01:00
|
|
|
{
|
2023-11-03 07:41:01 +01:00
|
|
|
size_t data_len;
|
|
|
|
size_t i;
|
2023-10-31 08:58:38 +01:00
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
data_len = msg->len - sizeof(struct rpmsg_ping_msg_s) + 1;
|
2023-10-31 08:58:38 +01:00
|
|
|
for (i = 0; i < data_len; i++)
|
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
if (msg->data[i] != RPMSG_PING_CHECK_DATA)
|
2023-10-31 08:58:38 +01:00
|
|
|
{
|
2023-11-03 07:41:01 +01:00
|
|
|
syslog(LOG_ERR, "rptun ping remote receive data error!\n");
|
2023-10-31 08:58:38 +01:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
msg->data[i] = 0;
|
|
|
|
}
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
msg->cmd = RPMSG_PING_ACK;
|
2022-02-16 08:23:49 +01:00
|
|
|
rpmsg_send(ept, msg, len);
|
|
|
|
}
|
2023-12-22 09:09:24 +01:00
|
|
|
else if (msg->cmd == RPMSG_PING_ACK)
|
2022-02-16 08:23:49 +01:00
|
|
|
{
|
|
|
|
nxsem_post(sem);
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
static int rpmsg_ping_once(FAR struct rpmsg_endpoint *ept,
|
|
|
|
int len, int ack, uint32_t *buf_len)
|
2022-02-16 08:23:49 +01:00
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
FAR struct rpmsg_ping_msg_s *msg;
|
2022-02-16 08:23:49 +01:00
|
|
|
int ret;
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
msg = rpmsg_get_tx_payload_buffer(ept, buf_len, true);
|
2022-02-16 08:23:49 +01:00
|
|
|
if (!msg)
|
|
|
|
{
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
len = MAX(len, sizeof(struct rpmsg_ping_msg_s));
|
|
|
|
len = MIN(len, *buf_len);
|
2022-02-16 08:23:49 +01:00
|
|
|
|
|
|
|
memset(msg, 0, len);
|
|
|
|
|
|
|
|
if (ack)
|
|
|
|
{
|
|
|
|
sem_t sem;
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
msg->cmd = (ack == 1)? RPMSG_PING_SEND : RPMSG_PING_SEND_CHECK;
|
2022-02-16 08:23:49 +01:00
|
|
|
msg->len = len;
|
|
|
|
msg->cookie = (uintptr_t)&sem;
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
if (msg->cmd == RPMSG_PING_SEND_CHECK)
|
2023-10-31 08:58:38 +01:00
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
memset(msg->data, RPMSG_PING_CHECK_DATA,
|
|
|
|
len - sizeof(struct rpmsg_ping_msg_s) + 1);
|
2023-10-31 08:58:38 +01:00
|
|
|
}
|
|
|
|
|
2022-02-16 08:23:49 +01:00
|
|
|
nxsem_init(&sem, 0, 0);
|
|
|
|
|
|
|
|
ret = rpmsg_send_nocopy(ept, msg, len);
|
|
|
|
if (ret >= 0)
|
|
|
|
{
|
|
|
|
nxsem_wait_uninterruptible(&sem);
|
|
|
|
}
|
|
|
|
|
|
|
|
nxsem_destroy(&sem);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
msg->cmd = RPMSG_PING_SEND_NOACK;
|
2022-02-16 08:23:49 +01:00
|
|
|
msg->len = len;
|
|
|
|
ret = rpmsg_send_nocopy(ept, msg, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
static void rpmsg_ping_logout(FAR const char *s, clock_t value)
|
2023-01-10 14:02:22 +01:00
|
|
|
{
|
|
|
|
struct timespec ts;
|
|
|
|
|
2023-09-28 10:37:27 +02:00
|
|
|
perf_convert(value, &ts);
|
2023-01-10 14:02:22 +01:00
|
|
|
|
|
|
|
#ifdef CONFIG_SYSTEM_TIME64
|
2023-10-31 08:58:38 +01:00
|
|
|
syslog(LOG_INFO, "%s: %" PRIu64 " s, %ld ns\n", s, ts.tv_sec, ts.tv_nsec);
|
2023-01-10 14:02:22 +01:00
|
|
|
#else
|
2023-10-31 08:58:38 +01:00
|
|
|
syslog(LOG_INFO, "%s: %" PRIu32 " s, %ld ns\n", s, ts.tv_sec, ts.tv_nsec);
|
2023-01-10 14:02:22 +01:00
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
static void rpmsg_ping_logout_rate(uint64_t len, clock_t avg)
|
2023-10-31 08:58:38 +01:00
|
|
|
{
|
|
|
|
struct timespec ts;
|
2023-11-03 07:41:01 +01:00
|
|
|
size_t ratebits;
|
|
|
|
size_t rateint;
|
|
|
|
size_t ratedec;
|
2023-10-31 08:58:38 +01:00
|
|
|
|
|
|
|
perf_convert(avg, &ts);
|
|
|
|
|
2023-11-03 07:41:01 +01:00
|
|
|
ratebits = len * 8 * 1000000000 / (ts.tv_sec * NSEC_PER_SEC + ts.tv_nsec);
|
|
|
|
rateint = ratebits / 1000000;
|
|
|
|
ratedec = ratebits - rateint * 1000000;
|
|
|
|
|
2023-11-17 05:41:14 +01:00
|
|
|
syslog(LOG_INFO, "rate: %zu.%06zu Mbits/sec\n", rateint, ratedec);
|
2023-10-31 08:58:38 +01:00
|
|
|
}
|
|
|
|
|
2022-02-16 08:23:49 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* Public Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
int rpmsg_ping(FAR struct rpmsg_endpoint *ept,
|
|
|
|
FAR const struct rpmsg_ping_s *ping)
|
2022-02-16 08:23:49 +01:00
|
|
|
{
|
2023-09-28 10:37:27 +02:00
|
|
|
clock_t min = ULONG_MAX;
|
|
|
|
clock_t max = 0;
|
2022-02-16 08:23:49 +01:00
|
|
|
uint64_t total = 0;
|
2023-12-22 09:09:24 +01:00
|
|
|
uint32_t buf_len = 0;
|
|
|
|
int send_len;
|
2022-02-16 08:23:49 +01:00
|
|
|
int i;
|
|
|
|
|
|
|
|
if (!ept || !ping || ping->times <= 0)
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 0; i < ping->times; i++)
|
|
|
|
{
|
2023-09-28 10:37:27 +02:00
|
|
|
clock_t tm = perf_gettime();
|
2022-02-16 08:23:49 +01:00
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
send_len = rpmsg_ping_once(ept, ping->len, ping->ack, &buf_len);
|
|
|
|
if (send_len < 0)
|
2022-02-16 08:23:49 +01:00
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
return send_len;
|
2022-02-16 08:23:49 +01:00
|
|
|
}
|
|
|
|
|
2023-09-28 10:37:27 +02:00
|
|
|
tm = perf_gettime() - tm;
|
2022-02-16 08:23:49 +01:00
|
|
|
min = MIN(min, tm);
|
|
|
|
max = MAX(max, tm);
|
|
|
|
total += tm;
|
2022-05-11 06:20:54 +02:00
|
|
|
|
2023-10-25 05:08:56 +02:00
|
|
|
nxsig_usleep(ping->sleep * USEC_PER_MSEC);
|
2022-02-16 08:23:49 +01:00
|
|
|
}
|
|
|
|
|
2023-09-28 10:37:27 +02:00
|
|
|
syslog(LOG_INFO, "ping times: %d\n", ping->times);
|
2022-02-16 08:23:49 +01:00
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
rpmsg_ping_logout("avg", total / ping->times);
|
|
|
|
rpmsg_ping_logout("min", min);
|
|
|
|
rpmsg_ping_logout("max", max);
|
|
|
|
rpmsg_ping_logout_rate(send_len, total / ping->times);
|
2022-02-16 08:23:49 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
int rpmsg_ping_init(FAR struct rpmsg_device *rdev,
|
2022-02-16 08:23:49 +01:00
|
|
|
FAR struct rpmsg_endpoint *ept)
|
|
|
|
{
|
2023-12-22 09:09:24 +01:00
|
|
|
return rpmsg_create_ept(ept, rdev, RPMSG_PING_EPT_NAME,
|
2022-02-16 08:23:49 +01:00
|
|
|
RPMSG_ADDR_ANY, RPMSG_ADDR_ANY,
|
2023-12-22 09:09:24 +01:00
|
|
|
rpmsg_ping_ept_cb, NULL);
|
2022-02-16 08:23:49 +01:00
|
|
|
}
|
|
|
|
|
2023-12-22 09:09:24 +01:00
|
|
|
void rpmsg_ping_deinit(FAR struct rpmsg_endpoint *ept)
|
2022-02-16 08:23:49 +01:00
|
|
|
{
|
|
|
|
rpmsg_destroy_ept(ept);
|
|
|
|
}
|