Repository navigation
Expand file tree
/
Copy pathmain.cpp
More file actions
122 lines (104 loc) · 3.02 KB
/
Copy pathmain.cpp
File metadata and controls
122 lines (104 loc) · 3.02 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
// Test SSP library in a simple main loop
//
// @see https://www.codeproject.com/Articles/5321271/Simple-Socket-Protocol-for-Embedded-Systems
// David Lafreniere, Jan 2022.
#include "ssp.h"
#include <stdio.h>
#include <string.h>
#include "ssp_fault.h"
static void SspErrorHandler(SspErr err)
{
SSP_TRACE_FORMAT("SspErrorHandler: %d\n", err);
}
static void SspCallbackSocket0(UINT8 socketId, const void* data, UINT16 dataSize,
SspDataType type, SspErr status, void* userData)
{
// Received data callback?
if (type == SSP_RECEIVE)
{
// Received successfully?
if (status == SSP_SUCCESS)
SSP_TRACE_FORMAT("SSP_RECEIVE PORT1: %s", (char*)data);
}
// Send data callback?
else if (type == SSP_SEND)
{
if (status == SSP_SUCCESS)
SSP_TRACE("SSP_SEND PORT1 SUCCESS");
else
SSP_TRACE("SSP_SEND PORT1 FAIL");
}
else
{
SSP_TRACE("UNKNOWN PORT1");
}
}
static void SspCallbackSocket1(UINT8 socketId, const void* data, UINT16 dataSize,
SspDataType type, SspErr status, void* userData)
{
// Received data callback?
if (type == SSP_RECEIVE)
{
// Received successfully?
if (status == SSP_SUCCESS)
SSP_TRACE_FORMAT("SSP_RECEIVE PORT2: %s", (char*)data);
}
// Send data callback?
else if (type == SSP_SEND)
{
if (status == SSP_SUCCESS)
SSP_TRACE("SSP_SEND PORT2 SUCCESS");
else
SSP_TRACE("SSP_SEND PORT2 FAIL");
}
else
{
SSP_TRACE("UNKNOWN PORT2");
}
}
int main()
{
// Register for error callbacks
SSP_SetErrorHandler(SspErrorHandler);
// Initialize the ports
SSP_Init(SSP_PORT1);
SSP_Init(SSP_PORT2);
SspErr err;
// Open two sockets
err = SSP_OpenSocket(SSP_PORT1, 0);
err = SSP_OpenSocket(SSP_PORT2, 1);
// Register for callbacks
err = SSP_Listen(0, &SspCallbackSocket0, NULL);
err = SSP_Listen(1, &SspCallbackSocket1, NULL);
int cntr = 0;
char send[32];
UINT16 sendArrSize[2];
const void* sendArr[2];
while (1)
{
snprintf(send, 32, "CNTR=%d", cntr++);
// Send data
err = SSP_Send(0, 1, send, UINT16(strlen(send))+1);
err = SSP_Send(1, 0, send, UINT16(strlen(send))+1);
sendArr[0] = "Hello ";
sendArrSize[0] = (UINT16)strlen((char*)sendArr[0]);
sendArr[1] = "World\0";
sendArrSize[1] = (UINT16)strlen((char*)sendArr[1]) + 1;
// Send data
err = SSP_SendMultiple(1, 0, 2, sendArr, sendArrSize);
do
{
// Call while there is send or receive data to process
SSP_Process();
} while (!SSP_IsRecvQueueEmpty(SSP_PORT1) ||
!SSP_IsRecvQueueEmpty(SSP_PORT2) ||
SSP_GetSendQueueSize(SSP_PORT1) != 0 ||
SSP_GetSendQueueSize(SSP_PORT2) != 0);
if (SSP_GetLastErr() != SSP_SUCCESS)
break;
}
err = SSP_CloseSocket(0);
err = SSP_CloseSocket(1);
SSP_Term();
return 0;
}