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