blob: d6526ace7c164409a2fc06c645eda9500ac3dc83 [file] [log] [blame]
developer3abe1ad2022-01-24 11:13:32 +08001/* Copyright (C) 2021-2022 Mediatek Inc. */
2
3#include <signal.h>
4#include <sys/select.h>
5#include <sys/wait.h>
6#include "atenl.h"
7
8static const char *progname;
9bool atenl_enable;
10
11void sig_handler(int signum)
12{
13 atenl_enable = false;
14}
15
16void atenl_init_signals()
17{
18 if (signal(SIGINT, sig_handler) == SIG_ERR)
19 goto out;
20 if (signal(SIGTERM, sig_handler) == SIG_ERR)
21 goto out;
22 if (signal(SIGABRT, sig_handler) == SIG_ERR)
23 goto out;
24 if (signal(SIGUSR1, sig_handler) == SIG_ERR)
25 goto out;
26 if (signal(SIGUSR2, sig_handler) == SIG_ERR)
27 goto out;
28
29 return;
30out:
31 perror("signal");
32}
33
34static int phy_lookup_idx(const char *name)
35{
36 char buf[128];
37 FILE *f;
38 size_t len;
39 int ret;
40
41 ret = snprintf(buf, sizeof(buf), "/sys/class/ieee80211/%s/index", name);
42 if (snprintf_error(sizeof(buf), ret))
43 return -1;
44
45 f = fopen(buf, "r");
46 if (!f)
47 return -1;
48
49 len = fread(buf, 1, sizeof(buf) - 1, f);
50 fclose(f);
51
52 if (!len)
53 return -1;
54
55 buf[len] = 0;
56 return atoi(buf);
57}
58
developer22227f42022-10-07 15:54:07 +080059static int get_default_bridge_name(struct atenl *an)
60{
61 char buf[128];
62 FILE *f;
63 size_t len;
64 int ret;
65
66 ret = snprintf(buf, sizeof(buf), "/sbin/procd");
67 if (snprintf_error(sizeof(buf), ret))
68 return -1;
69
70 f = fopen(buf, "r");
71
72 /* This procd is openwrt only */
73 if (f) {
74 an->bridge_name = BRIDGE_NAME_OPENWRT;
75 fclose(f);
76 } else {
77 an->bridge_name = BRIDGE_NAME_RDKB;
78 }
79
80 return 0;
81}
82
developer3abe1ad2022-01-24 11:13:32 +080083static void usage(void)
84{
developer5698c9c2022-05-30 16:40:23 +080085 printf("Usage:\n");
developer3abe1ad2022-01-24 11:13:32 +080086 printf(" %s [-u] [-i phyX]\n", progname);
87 printf("options:\n"
88 " -h = show help text\n"
89 " -i = phy name of driver interface, please use first phy for dbdc\n"
developer22227f42022-10-07 15:54:07 +080090 " -u = use unicast to respond to HQADLL\n"
91 " -b = specify your bridge name\n");
developer3abe1ad2022-01-24 11:13:32 +080092 printf("examples:\n"
developer22227f42022-10-07 15:54:07 +080093 " %s -u -i phy0 -b br-lan\n", progname);
developer3abe1ad2022-01-24 11:13:32 +080094
95 exit(EXIT_FAILURE);
96}
97
developer5698c9c2022-05-30 16:40:23 +080098static void atenl_handler_run(struct atenl *an)
developer3abe1ad2022-01-24 11:13:32 +080099{
developer5698c9c2022-05-30 16:40:23 +0800100 int count, sock_eth = an->sock_eth;
developer3abe1ad2022-01-24 11:13:32 +0800101 fd_set readfds;
102
developer5698c9c2022-05-30 16:40:23 +0800103 atenl_info("Start atenl HQA command handler\n");
developer3abe1ad2022-01-24 11:13:32 +0800104
105 while (atenl_enable) {
106 FD_ZERO(&readfds);
107 FD_SET(sock_eth, &readfds);
108 count = select(sock_eth + 1, &readfds, NULL, NULL, NULL);
109
110 if (count < 0) {
111 atenl_err("%s: select failed, %s\n", __func__, strerror(errno));
developer3abe1ad2022-01-24 11:13:32 +0800112 } else if (count == 0) {
113 usleep(1000);
developer3abe1ad2022-01-24 11:13:32 +0800114 } else {
developer5698c9c2022-05-30 16:40:23 +0800115 if (!FD_ISSET(sock_eth, &readfds))
116 continue;
117 atenl_hqa_proc_cmd(an);
developer3abe1ad2022-01-24 11:13:32 +0800118 }
119 }
120
developer5698c9c2022-05-30 16:40:23 +0800121 atenl_dbg("HQA command handler end\n");
developer3abe1ad2022-01-24 11:13:32 +0800122}
123
developer3abe1ad2022-01-24 11:13:32 +0800124int main(int argc, char **argv)
125{
126 int opt, phy_idx, ret = 0;
127 char *phy = "phy0", *cmd = NULL;
128 struct atenl *an;
129
130 progname = argv[0];
131
132 an = calloc(1, sizeof(struct atenl));
133 if (!an)
134 return -ENOMEM;
135
136 while(1) {
developer22227f42022-10-07 15:54:07 +0800137 opt = getopt(argc, argv, "hi:uc:b:");
developer3abe1ad2022-01-24 11:13:32 +0800138 if (opt == -1)
139 break;
140
141 switch (opt) {
142 case 'h':
143 usage();
developer5698c9c2022-05-30 16:40:23 +0800144 goto out;
developer3abe1ad2022-01-24 11:13:32 +0800145 case 'i':
146 phy = optarg;
147 break;
developer22227f42022-10-07 15:54:07 +0800148 case 'b':
149 an->bridge_name = optarg;
150 break;
developer3abe1ad2022-01-24 11:13:32 +0800151 case 'u':
152 an->unicast = true;
153 printf("Opt: use unicast to send response\n");
154 break;
155 case 'c':
156 cmd = optarg;
157 break;
158 default:
developer5698c9c2022-05-30 16:40:23 +0800159 atenl_err("Not supported option: %c\n", opt);
160 goto out;
developer3abe1ad2022-01-24 11:13:32 +0800161 }
162 }
163
164 phy_idx = phy_lookup_idx(phy);
165 if (phy_idx < 0 || phy_idx > UCHAR_MAX) {
developer5698c9c2022-05-30 16:40:23 +0800166 atenl_err("Could not find phy '%s'\n", phy);
167 goto out;
developer3abe1ad2022-01-24 11:13:32 +0800168 }
169
170 if (cmd) {
171 atenl_eeprom_cmd_handler(an, phy_idx, cmd);
172 goto out;
173 }
174
175 atenl_enable = true;
176 atenl_init_signals();
177
developer22227f42022-10-07 15:54:07 +0800178 if (!an->bridge_name) {
179 ret = get_default_bridge_name(an);
180 if (ret) {
181 atenl_err("Get default bridge name failed\n");
182 goto out;
183 }
184
185 atenl_info("Bridge name is not specified, use default bridge name: %s\n", an->bridge_name);
186 } else {
187 atenl_info("Currently using bridge name: %s\n", an->bridge_name);
188 }
189
developer3abe1ad2022-01-24 11:13:32 +0800190 /* background ourself */
191 if (!fork()) {
developer3abe1ad2022-01-24 11:13:32 +0800192 ret = atenl_eeprom_init(an, phy_idx);
193 if (ret)
194 goto out;
195
196 ret = atenl_eth_init(an);
197 if (ret)
198 goto out;
199
developer5698c9c2022-05-30 16:40:23 +0800200 atenl_handler_run(an);
developer3abe1ad2022-01-24 11:13:32 +0800201 } else {
202 usleep(800000);
203 }
204
205 ret = 0;
206out:
207 if (an->sock_eth)
208 close(an->sock_eth);
209 if (an->eeprom_fd || an->eeprom_data)
210 atenl_eeprom_close(an);
211 free(an);
212
213 return ret;
214}