blob: 0ac18b35bcff4aa481f6358e305e211a0f642cfd (
plain)
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
|
#include "transport_manager/android/local_socket_receiver.h"
#include <thread>
#include "utils/logger.h"
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <sys/un.h>
#include <netinet/in.h>
#include <netdb.h>
SDL_CREATE_LOG_VARIABLE("Ble_Server")
namespace{
const int buffer_size = 131072; // Copied from INI file
std::vector<uint8_t> buffer(buffer_size);
}
namespace transport_manager {
namespace transport_adapter {
LocalSocketReceiver::LocalSocketReceiver( MessageDelegate&& callback)
: callback_(callback)
{}
void LocalSocketReceiver::Init(const std::string& socket_name)
{
SDL_LOG_AUTO_TRACE();
connected_ = false;
stop_requested_ = false;
struct sockaddr_un server_sockaddr;
struct sockaddr_un client_sockaddr;
socklen_t len;
server_sockaddr.sun_family = AF_LOCAL;
server_sockaddr.sun_path[0] = '\0';
strcpy(&server_sockaddr.sun_path[1], socket_name.c_str() );
len = offsetof(struct sockaddr_un, sun_path) + 1 + strlen(&server_sockaddr.sun_path[1]);
int err;
server_sock_ = socket(PF_LOCAL, SOCK_STREAM, 0);
if (server_sock_ < 0) {
err = errno;
SDL_LOG_ERROR("Cannot open socket: " << strerror(err) << " " << socket_name);
return;
}
unlink(socket_name.c_str());
int rc = bind(server_sock_, (struct sockaddr *) &server_sockaddr, len);
if (rc < 0){
err = errno;
SDL_LOG_ERROR("BIND ERROR: " << strerror(err) << " " << socket_name);
close(server_sock_);
return;
}
int backlog = 1;
rc = listen(server_sock_, backlog);
if (rc < 0){
err = errno;
SDL_LOG_ERROR("LISTEN ERROR: " << strerror(err) << " " << socket_name);
close(server_sock_);
return;
}
SDL_LOG_INFO("Socket listening... " << socket_name);
client_sock_ = accept(server_sock_, (struct sockaddr *) &client_sockaddr, &len);
if (client_sock_ < 0){
err = errno;
SDL_LOG_ERROR("ACCEPT ERROR: " << strerror(err) << " " << socket_name);
close(server_sock_);
close(client_sock_);
return;
}
connected_ = true;
}
void LocalSocketReceiver::Run()
{
SDL_LOG_AUTO_TRACE();
while (connected_ && !stop_requested_) {
buffer.resize(buffer_size);
const int n = read(client_sock_, buffer.data(), buffer_size - 1);
if(n > 0) {
buffer.resize(n);
callback_(buffer);
}
}
}
void LocalSocketReceiver::Stop() {
SDL_LOG_DEBUG("Requesting server to stop");
stop_requested_ = true;
close(client_sock_);
close(server_sock_);
connected_ = false;
}
LocalSocketReceiver::~LocalSocketReceiver(){
if(connected_){
close(client_sock_);
close(server_sock_);
}
}
} // namespace transport_adapter
} // namespace transport_manager
|
