Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 1 | /* SPDX-License-Identifier: Apache-2.0 OR GPL-2.0-or-later */ |
| 2 | |
| 3 | #define _GNU_SOURCE |
| 4 | |
Andrew Jeffery | 2cda40f | 2020-02-28 15:26:20 +1030 | [diff] [blame] | 5 | #if HAVE_CONFIG_H |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 6 | #include "config.h" |
Andrew Jeffery | 2cda40f | 2020-02-28 15:26:20 +1030 | [diff] [blame] | 7 | #endif |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 8 | |
Andrew Jeffery | 5ab7825 | 2022-02-17 21:04:59 +1030 | [diff] [blame] | 9 | #include "compiler.h" |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 10 | #include "libmctp-log.h" |
| 11 | #include "libmctp-serial.h" |
| 12 | |
| 13 | #ifdef NDEBUG |
| 14 | #undef NDEBUG |
| 15 | #endif |
| 16 | |
| 17 | #include <assert.h> |
Andrew Jeffery | 89a2878 | 2022-09-29 11:46:31 +0930 | [diff] [blame] | 18 | #include <errno.h> |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 19 | #include <fcntl.h> |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 20 | #include <stdbool.h> |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 21 | #include <stdio.h> |
| 22 | #include <string.h> |
| 23 | #include <unistd.h> |
| 24 | |
| 25 | struct mctp_binding_serial_pipe { |
| 26 | int ingress; |
| 27 | int egress; |
| 28 | |
| 29 | struct mctp_binding_serial *serial; |
| 30 | }; |
| 31 | |
| 32 | static int mctp_binding_serial_pipe_tx(void *data, void *buf, size_t len) |
| 33 | { |
| 34 | struct mctp_binding_serial_pipe *ctx = data; |
| 35 | ssize_t rc; |
| 36 | |
| 37 | rc = write(ctx->egress, buf, len); |
Andrew Jeffery | b93b611 | 2020-06-05 14:13:44 +0930 | [diff] [blame] | 38 | assert(rc >= 0); |
| 39 | assert((size_t)rc == len); |
Andrew Jeffery | 89a2b8e | 2020-02-07 17:07:38 +1030 | [diff] [blame] | 40 | |
| 41 | return rc; |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 42 | } |
| 43 | |
| 44 | uint8_t mctp_msg_src[2 * MCTP_BTU]; |
| 45 | |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 46 | static bool seen; |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 47 | static bool received_tag_owner; |
| 48 | static uint8_t received_msg_tag; |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 49 | |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 50 | static void rx_message(uint8_t eid __unused, bool tag_owner, uint8_t msg_tag, |
| 51 | void *data __unused, void *msg, size_t len) |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 52 | { |
| 53 | uint8_t type; |
| 54 | |
| 55 | type = *(uint8_t *)msg; |
| 56 | |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 57 | mctp_prdebug("MCTP message received: len %zd, type %d, tag %d", len, |
| 58 | type, msg_tag); |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 59 | |
| 60 | assert(sizeof(mctp_msg_src) == len); |
| 61 | assert(!memcmp(mctp_msg_src, msg, len)); |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 62 | |
| 63 | seen = true; |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 64 | received_msg_tag = msg_tag; |
| 65 | received_tag_owner = tag_owner; |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 66 | } |
| 67 | |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 68 | struct serial_test { |
| 69 | struct mctp_binding_serial_pipe binding; |
| 70 | struct mctp *mctp; |
| 71 | }; |
| 72 | |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 73 | int main(void) |
| 74 | { |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 75 | struct serial_test scenario[2]; |
| 76 | |
Andrew Jeffery | f0315a3 | 2020-03-10 23:49:41 +1030 | [diff] [blame] | 77 | struct mctp_binding_serial_pipe *a; |
| 78 | struct mctp_binding_serial_pipe *b; |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 79 | uint8_t msg_tag = 2; |
| 80 | bool tag_owner = false; |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 81 | int p[2][2]; |
| 82 | int rc; |
| 83 | |
| 84 | mctp_set_log_stdio(MCTP_LOG_DEBUG); |
| 85 | |
| 86 | memset(&mctp_msg_src[0], 0x5a, MCTP_BTU); |
| 87 | memset(&mctp_msg_src[MCTP_BTU], 0xa5, MCTP_BTU); |
| 88 | |
| 89 | rc = pipe(p[0]); |
| 90 | assert(!rc); |
| 91 | |
| 92 | rc = pipe(p[1]); |
| 93 | assert(!rc); |
| 94 | |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 95 | /* Instantiate the A side of the serial pipe */ |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 96 | scenario[0].mctp = mctp_init(); |
| 97 | assert(scenario[0].mctp); |
Andrew Jeffery | f0315a3 | 2020-03-10 23:49:41 +1030 | [diff] [blame] | 98 | scenario[0].binding.serial = mctp_serial_init(); |
| 99 | assert(scenario[0].binding.serial); |
| 100 | a = &scenario[0].binding; |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 101 | a->ingress = p[0][0]; |
| 102 | a->egress = p[1][1]; |
| 103 | mctp_serial_open_fd(a->serial, a->ingress); |
| 104 | mctp_serial_set_tx_fn(a->serial, mctp_binding_serial_pipe_tx, a); |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 105 | mctp_register_bus(scenario[0].mctp, mctp_binding_serial_core(a->serial), 8); |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 106 | |
| 107 | /* Instantiate the B side of the serial pipe */ |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 108 | scenario[1].mctp = mctp_init(); |
| 109 | assert(scenario[1].mctp); |
| 110 | mctp_set_rx_all(scenario[1].mctp, rx_message, NULL); |
Andrew Jeffery | f0315a3 | 2020-03-10 23:49:41 +1030 | [diff] [blame] | 111 | scenario[1].binding.serial = mctp_serial_init(); |
| 112 | assert(scenario[1].binding.serial); |
| 113 | b = &scenario[1].binding; |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 114 | b->ingress = p[1][0]; |
| 115 | b->egress = p[0][1]; |
| 116 | mctp_serial_open_fd(b->serial, b->ingress); |
| 117 | mctp_serial_set_tx_fn(b->serial, mctp_binding_serial_pipe_tx, a); |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 118 | mctp_register_bus(scenario[1].mctp, mctp_binding_serial_core(b->serial), 9); |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 119 | |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 120 | /* Transmit a message from A to B, with message tag */ |
| 121 | rc = mctp_message_tx(scenario[0].mctp, 9, tag_owner, msg_tag, |
| 122 | mctp_msg_src, sizeof(mctp_msg_src)); |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 123 | assert(rc == 0); |
| 124 | |
| 125 | /* Read the message at B from A */ |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 126 | seen = false; |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 127 | received_tag_owner = true; |
| 128 | received_msg_tag = 0; |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 129 | mctp_serial_read(b->serial); |
Andrew Jeffery | b633b3f | 2020-02-25 15:49:22 +1030 | [diff] [blame] | 130 | assert(seen); |
Sumanth Bhat | f39c385 | 2022-01-10 17:04:10 +0530 | [diff] [blame] | 131 | assert(received_tag_owner == tag_owner); |
| 132 | assert(received_msg_tag == msg_tag); |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 133 | |
Andrew Jeffery | f0315a3 | 2020-03-10 23:49:41 +1030 | [diff] [blame] | 134 | mctp_serial_destroy(scenario[1].binding.serial); |
| 135 | mctp_destroy(scenario[1].mctp); |
| 136 | mctp_serial_destroy(scenario[0].binding.serial); |
| 137 | mctp_destroy(scenario[0].mctp); |
| 138 | |
Andrew Jeffery | 25de093 | 2020-02-06 15:56:12 +1030 | [diff] [blame] | 139 | return 0; |
| 140 | } |