ethsw.c 27 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2015 Freescale Semiconductor, Inc.
  4. *
  5. * Ethernet Switch commands
  6. */
  7. #include <common.h>
  8. #include <command.h>
  9. #include <env.h>
  10. #include <errno.h>
  11. #include <env_flags.h>
  12. #include <ethsw.h>
  13. #include <net.h>
  14. static const char *ethsw_name;
  15. #define ETHSW_PORT_STATS_HELP "ethsw [port <port_no>] statistics " \
  16. "{ [help] | [clear] } - show an l2 switch port's statistics"
  17. static int ethsw_port_stats_help_key_func(struct ethsw_command_def *parsed_cmd)
  18. {
  19. printf(ETHSW_PORT_STATS_HELP"\n");
  20. return CMD_RET_SUCCESS;
  21. }
  22. #define ETHSW_LEARN_HELP "ethsw [port <port_no>] learning " \
  23. "{ [help] | show | auto | disable } " \
  24. "- enable/disable/show learning configuration on a port"
  25. static int ethsw_learn_help_key_func(struct ethsw_command_def *parsed_cmd)
  26. {
  27. printf(ETHSW_LEARN_HELP"\n");
  28. return CMD_RET_SUCCESS;
  29. }
  30. #define ETHSW_FDB_HELP "ethsw [port <port_no>] [vlan <vid>] fdb " \
  31. "{ [help] | show | flush | { add | del } <mac> } " \
  32. "- Add/delete a mac entry in FDB; use show to see FDB entries; " \
  33. "if vlan <vid> is missing, VID 1 will be used"
  34. static int ethsw_fdb_help_key_func(struct ethsw_command_def *parsed_cmd)
  35. {
  36. printf(ETHSW_FDB_HELP"\n");
  37. return CMD_RET_SUCCESS;
  38. }
  39. #define ETHSW_PVID_HELP "ethsw [port <port_no>] " \
  40. "pvid { [help] | show | <pvid> } " \
  41. "- set/show PVID (ingress and egress VLAN tagging) for a port"
  42. static int ethsw_pvid_help_key_func(struct ethsw_command_def *parsed_cmd)
  43. {
  44. printf(ETHSW_PVID_HELP"\n");
  45. return CMD_RET_SUCCESS;
  46. }
  47. #define ETHSW_VLAN_HELP "ethsw [port <port_no>] vlan " \
  48. "{ [help] | show | add <vid> | del <vid> } " \
  49. "- add a VLAN to a port (VLAN members)"
  50. static int ethsw_vlan_help_key_func(struct ethsw_command_def *parsed_cmd)
  51. {
  52. printf(ETHSW_VLAN_HELP"\n");
  53. return CMD_RET_SUCCESS;
  54. }
  55. #define ETHSW_PORT_UNTAG_HELP "ethsw [port <port_no>] untagged " \
  56. "{ [help] | show | all | none | pvid } " \
  57. " - set egress tagging mode for a port"
  58. static int ethsw_port_untag_help_key_func(struct ethsw_command_def *parsed_cmd)
  59. {
  60. printf(ETHSW_PORT_UNTAG_HELP"\n");
  61. return CMD_RET_SUCCESS;
  62. }
  63. #define ETHSW_EGR_VLAN_TAG_HELP "ethsw [port <port_no>] egress tag " \
  64. "{ [help] | show | pvid | classified } " \
  65. "- Configure VID source for egress tag. " \
  66. "Tag's VID could be the frame's classified VID or the PVID of the port"
  67. static int ethsw_egr_tag_help_key_func(struct ethsw_command_def *parsed_cmd)
  68. {
  69. printf(ETHSW_EGR_VLAN_TAG_HELP"\n");
  70. return CMD_RET_SUCCESS;
  71. }
  72. #define ETHSW_VLAN_FDB_HELP "ethsw vlan fdb " \
  73. "{ [help] | show | shared | private } " \
  74. "- make VLAN learning shared or private"
  75. static int ethsw_vlan_learn_help_key_func(struct ethsw_command_def *parsed_cmd)
  76. {
  77. printf(ETHSW_VLAN_FDB_HELP"\n");
  78. return CMD_RET_SUCCESS;
  79. }
  80. #define ETHSW_PORT_INGR_FLTR_HELP "ethsw [port <port_no>] ingress filtering" \
  81. " { [help] | show | enable | disable } " \
  82. "- enable/disable VLAN ingress filtering on port"
  83. static int ethsw_ingr_fltr_help_key_func(struct ethsw_command_def *parsed_cmd)
  84. {
  85. printf(ETHSW_PORT_INGR_FLTR_HELP"\n");
  86. return CMD_RET_SUCCESS;
  87. }
  88. #define ETHSW_PORT_AGGR_HELP "ethsw [port <port_no>] aggr" \
  89. " { [help] | show | <lag_group_no> } " \
  90. "- get/set LAG group for a port"
  91. static int ethsw_port_aggr_help_key_func(struct ethsw_command_def *parsed_cmd)
  92. {
  93. printf(ETHSW_PORT_AGGR_HELP"\n");
  94. return CMD_RET_SUCCESS;
  95. }
  96. static struct keywords_to_function {
  97. enum ethsw_keyword_id cmd_keyword[ETHSW_MAX_CMD_PARAMS];
  98. int cmd_func_offset;
  99. int (*keyword_function)(struct ethsw_command_def *parsed_cmd);
  100. } ethsw_cmd_def[] = {
  101. {
  102. .cmd_keyword = {
  103. ethsw_id_enable,
  104. ethsw_id_key_end,
  105. },
  106. .cmd_func_offset = offsetof(struct ethsw_command_func,
  107. port_enable),
  108. .keyword_function = NULL,
  109. }, {
  110. .cmd_keyword = {
  111. ethsw_id_disable,
  112. ethsw_id_key_end,
  113. },
  114. .cmd_func_offset = offsetof(struct ethsw_command_func,
  115. port_disable),
  116. .keyword_function = NULL,
  117. }, {
  118. .cmd_keyword = {
  119. ethsw_id_show,
  120. ethsw_id_key_end,
  121. },
  122. .cmd_func_offset = offsetof(struct ethsw_command_func,
  123. port_show),
  124. .keyword_function = NULL,
  125. }, {
  126. .cmd_keyword = {
  127. ethsw_id_statistics,
  128. ethsw_id_help,
  129. ethsw_id_key_end,
  130. },
  131. .cmd_func_offset = -1,
  132. .keyword_function = &ethsw_port_stats_help_key_func,
  133. }, {
  134. .cmd_keyword = {
  135. ethsw_id_statistics,
  136. ethsw_id_key_end,
  137. },
  138. .cmd_func_offset = offsetof(struct ethsw_command_func,
  139. port_stats),
  140. .keyword_function = NULL,
  141. }, {
  142. .cmd_keyword = {
  143. ethsw_id_statistics,
  144. ethsw_id_clear,
  145. ethsw_id_key_end,
  146. },
  147. .cmd_func_offset = offsetof(struct ethsw_command_func,
  148. port_stats_clear),
  149. .keyword_function = NULL,
  150. }, {
  151. .cmd_keyword = {
  152. ethsw_id_learning,
  153. ethsw_id_key_end,
  154. },
  155. .cmd_func_offset = -1,
  156. .keyword_function = &ethsw_learn_help_key_func,
  157. }, {
  158. .cmd_keyword = {
  159. ethsw_id_learning,
  160. ethsw_id_help,
  161. ethsw_id_key_end,
  162. },
  163. .cmd_func_offset = -1,
  164. .keyword_function = &ethsw_learn_help_key_func,
  165. }, {
  166. .cmd_keyword = {
  167. ethsw_id_learning,
  168. ethsw_id_show,
  169. ethsw_id_key_end,
  170. },
  171. .cmd_func_offset = offsetof(struct ethsw_command_func,
  172. port_learn_show),
  173. .keyword_function = NULL,
  174. }, {
  175. .cmd_keyword = {
  176. ethsw_id_learning,
  177. ethsw_id_auto,
  178. ethsw_id_key_end,
  179. },
  180. .cmd_func_offset = offsetof(struct ethsw_command_func,
  181. port_learn),
  182. .keyword_function = NULL,
  183. }, {
  184. .cmd_keyword = {
  185. ethsw_id_learning,
  186. ethsw_id_disable,
  187. ethsw_id_key_end,
  188. },
  189. .cmd_func_offset = offsetof(struct ethsw_command_func,
  190. port_learn),
  191. .keyword_function = NULL,
  192. }, {
  193. .cmd_keyword = {
  194. ethsw_id_fdb,
  195. ethsw_id_key_end,
  196. },
  197. .cmd_func_offset = -1,
  198. .keyword_function = &ethsw_fdb_help_key_func,
  199. }, {
  200. .cmd_keyword = {
  201. ethsw_id_fdb,
  202. ethsw_id_help,
  203. ethsw_id_key_end,
  204. },
  205. .cmd_func_offset = -1,
  206. .keyword_function = &ethsw_fdb_help_key_func,
  207. }, {
  208. .cmd_keyword = {
  209. ethsw_id_fdb,
  210. ethsw_id_show,
  211. ethsw_id_key_end,
  212. },
  213. .cmd_func_offset = offsetof(struct ethsw_command_func,
  214. fdb_show),
  215. .keyword_function = NULL,
  216. }, {
  217. .cmd_keyword = {
  218. ethsw_id_fdb,
  219. ethsw_id_flush,
  220. ethsw_id_key_end,
  221. },
  222. .cmd_func_offset = offsetof(struct ethsw_command_func,
  223. fdb_flush),
  224. .keyword_function = NULL,
  225. }, {
  226. .cmd_keyword = {
  227. ethsw_id_fdb,
  228. ethsw_id_add,
  229. ethsw_id_add_del_mac,
  230. ethsw_id_key_end,
  231. },
  232. .cmd_func_offset = offsetof(struct ethsw_command_func,
  233. fdb_entry_add),
  234. .keyword_function = NULL,
  235. }, {
  236. .cmd_keyword = {
  237. ethsw_id_fdb,
  238. ethsw_id_del,
  239. ethsw_id_add_del_mac,
  240. ethsw_id_key_end,
  241. },
  242. .cmd_func_offset = offsetof(struct ethsw_command_func,
  243. fdb_entry_del),
  244. .keyword_function = NULL,
  245. }, {
  246. .cmd_keyword = {
  247. ethsw_id_pvid,
  248. ethsw_id_key_end,
  249. },
  250. .cmd_func_offset = -1,
  251. .keyword_function = &ethsw_pvid_help_key_func,
  252. }, {
  253. .cmd_keyword = {
  254. ethsw_id_pvid,
  255. ethsw_id_help,
  256. ethsw_id_key_end,
  257. },
  258. .cmd_func_offset = -1,
  259. .keyword_function = &ethsw_pvid_help_key_func,
  260. }, {
  261. .cmd_keyword = {
  262. ethsw_id_pvid,
  263. ethsw_id_show,
  264. ethsw_id_key_end,
  265. },
  266. .cmd_func_offset = offsetof(struct ethsw_command_func,
  267. pvid_show),
  268. .keyword_function = NULL,
  269. }, {
  270. .cmd_keyword = {
  271. ethsw_id_pvid,
  272. ethsw_id_pvid_no,
  273. ethsw_id_key_end,
  274. },
  275. .cmd_func_offset = offsetof(struct ethsw_command_func,
  276. pvid_set),
  277. .keyword_function = NULL,
  278. }, {
  279. .cmd_keyword = {
  280. ethsw_id_vlan,
  281. ethsw_id_key_end,
  282. },
  283. .cmd_func_offset = -1,
  284. .keyword_function = &ethsw_vlan_help_key_func,
  285. }, {
  286. .cmd_keyword = {
  287. ethsw_id_vlan,
  288. ethsw_id_help,
  289. ethsw_id_key_end,
  290. },
  291. .cmd_func_offset = -1,
  292. .keyword_function = &ethsw_vlan_help_key_func,
  293. }, {
  294. .cmd_keyword = {
  295. ethsw_id_vlan,
  296. ethsw_id_show,
  297. ethsw_id_key_end,
  298. },
  299. .cmd_func_offset = offsetof(struct ethsw_command_func,
  300. vlan_show),
  301. .keyword_function = NULL,
  302. }, {
  303. .cmd_keyword = {
  304. ethsw_id_vlan,
  305. ethsw_id_add,
  306. ethsw_id_add_del_no,
  307. ethsw_id_key_end,
  308. },
  309. .cmd_func_offset = offsetof(struct ethsw_command_func,
  310. vlan_set),
  311. .keyword_function = NULL,
  312. }, {
  313. .cmd_keyword = {
  314. ethsw_id_vlan,
  315. ethsw_id_del,
  316. ethsw_id_add_del_no,
  317. ethsw_id_key_end,
  318. },
  319. .cmd_func_offset = offsetof(struct ethsw_command_func,
  320. vlan_set),
  321. .keyword_function = NULL,
  322. }, {
  323. .cmd_keyword = {
  324. ethsw_id_untagged,
  325. ethsw_id_key_end,
  326. },
  327. .cmd_func_offset = -1,
  328. .keyword_function = &ethsw_port_untag_help_key_func,
  329. }, {
  330. .cmd_keyword = {
  331. ethsw_id_untagged,
  332. ethsw_id_help,
  333. ethsw_id_key_end,
  334. },
  335. .cmd_func_offset = -1,
  336. .keyword_function = &ethsw_port_untag_help_key_func,
  337. }, {
  338. .cmd_keyword = {
  339. ethsw_id_untagged,
  340. ethsw_id_show,
  341. ethsw_id_key_end,
  342. },
  343. .cmd_func_offset = offsetof(struct ethsw_command_func,
  344. port_untag_show),
  345. .keyword_function = NULL,
  346. }, {
  347. .cmd_keyword = {
  348. ethsw_id_untagged,
  349. ethsw_id_all,
  350. ethsw_id_key_end,
  351. },
  352. .cmd_func_offset = offsetof(struct ethsw_command_func,
  353. port_untag_set),
  354. .keyword_function = NULL,
  355. }, {
  356. .cmd_keyword = {
  357. ethsw_id_untagged,
  358. ethsw_id_none,
  359. ethsw_id_key_end,
  360. },
  361. .cmd_func_offset = offsetof(struct ethsw_command_func,
  362. port_untag_set),
  363. .keyword_function = NULL,
  364. }, {
  365. .cmd_keyword = {
  366. ethsw_id_untagged,
  367. ethsw_id_pvid,
  368. ethsw_id_key_end,
  369. },
  370. .cmd_func_offset = offsetof(struct ethsw_command_func,
  371. port_untag_set),
  372. .keyword_function = NULL,
  373. }, {
  374. .cmd_keyword = {
  375. ethsw_id_egress,
  376. ethsw_id_tag,
  377. ethsw_id_key_end,
  378. },
  379. .cmd_func_offset = -1,
  380. .keyword_function = &ethsw_egr_tag_help_key_func,
  381. }, {
  382. .cmd_keyword = {
  383. ethsw_id_egress,
  384. ethsw_id_tag,
  385. ethsw_id_help,
  386. ethsw_id_key_end,
  387. },
  388. .cmd_func_offset = -1,
  389. .keyword_function = &ethsw_egr_tag_help_key_func,
  390. }, {
  391. .cmd_keyword = {
  392. ethsw_id_egress,
  393. ethsw_id_tag,
  394. ethsw_id_show,
  395. ethsw_id_key_end,
  396. },
  397. .cmd_func_offset = offsetof(struct ethsw_command_func,
  398. port_egr_vlan_show),
  399. .keyword_function = NULL,
  400. }, {
  401. .cmd_keyword = {
  402. ethsw_id_egress,
  403. ethsw_id_tag,
  404. ethsw_id_pvid,
  405. ethsw_id_key_end,
  406. },
  407. .cmd_func_offset = offsetof(struct ethsw_command_func,
  408. port_egr_vlan_set),
  409. .keyword_function = NULL,
  410. }, {
  411. .cmd_keyword = {
  412. ethsw_id_egress,
  413. ethsw_id_tag,
  414. ethsw_id_classified,
  415. ethsw_id_key_end,
  416. },
  417. .cmd_func_offset = offsetof(struct ethsw_command_func,
  418. port_egr_vlan_set),
  419. .keyword_function = NULL,
  420. }, {
  421. .cmd_keyword = {
  422. ethsw_id_vlan,
  423. ethsw_id_fdb,
  424. ethsw_id_key_end,
  425. },
  426. .cmd_func_offset = -1,
  427. .keyword_function = &ethsw_vlan_learn_help_key_func,
  428. }, {
  429. .cmd_keyword = {
  430. ethsw_id_vlan,
  431. ethsw_id_fdb,
  432. ethsw_id_help,
  433. ethsw_id_key_end,
  434. },
  435. .cmd_func_offset = -1,
  436. .keyword_function = &ethsw_vlan_learn_help_key_func,
  437. }, {
  438. .cmd_keyword = {
  439. ethsw_id_vlan,
  440. ethsw_id_fdb,
  441. ethsw_id_show,
  442. ethsw_id_key_end,
  443. },
  444. .cmd_func_offset = offsetof(struct ethsw_command_func,
  445. vlan_learn_show),
  446. .keyword_function = NULL,
  447. }, {
  448. .cmd_keyword = {
  449. ethsw_id_vlan,
  450. ethsw_id_fdb,
  451. ethsw_id_shared,
  452. ethsw_id_key_end,
  453. },
  454. .cmd_func_offset = offsetof(struct ethsw_command_func,
  455. vlan_learn_set),
  456. .keyword_function = NULL,
  457. }, {
  458. .cmd_keyword = {
  459. ethsw_id_vlan,
  460. ethsw_id_fdb,
  461. ethsw_id_private,
  462. ethsw_id_key_end,
  463. },
  464. .cmd_func_offset = offsetof(struct ethsw_command_func,
  465. vlan_learn_set),
  466. .keyword_function = NULL,
  467. }, {
  468. .cmd_keyword = {
  469. ethsw_id_ingress,
  470. ethsw_id_filtering,
  471. ethsw_id_key_end,
  472. },
  473. .cmd_func_offset = -1,
  474. .keyword_function = &ethsw_ingr_fltr_help_key_func,
  475. }, {
  476. .cmd_keyword = {
  477. ethsw_id_ingress,
  478. ethsw_id_filtering,
  479. ethsw_id_help,
  480. ethsw_id_key_end,
  481. },
  482. .cmd_func_offset = -1,
  483. .keyword_function = &ethsw_ingr_fltr_help_key_func,
  484. }, {
  485. .cmd_keyword = {
  486. ethsw_id_ingress,
  487. ethsw_id_filtering,
  488. ethsw_id_show,
  489. ethsw_id_key_end,
  490. },
  491. .cmd_func_offset = offsetof(struct ethsw_command_func,
  492. port_ingr_filt_show),
  493. .keyword_function = NULL,
  494. }, {
  495. .cmd_keyword = {
  496. ethsw_id_ingress,
  497. ethsw_id_filtering,
  498. ethsw_id_enable,
  499. ethsw_id_key_end,
  500. },
  501. .cmd_func_offset = offsetof(struct ethsw_command_func,
  502. port_ingr_filt_set),
  503. .keyword_function = NULL,
  504. }, {
  505. .cmd_keyword = {
  506. ethsw_id_ingress,
  507. ethsw_id_filtering,
  508. ethsw_id_disable,
  509. ethsw_id_key_end,
  510. },
  511. .cmd_func_offset = offsetof(struct ethsw_command_func,
  512. port_ingr_filt_set),
  513. .keyword_function = NULL,
  514. }, {
  515. .cmd_keyword = {
  516. ethsw_id_aggr,
  517. ethsw_id_key_end,
  518. },
  519. .cmd_func_offset = -1,
  520. .keyword_function = &ethsw_port_aggr_help_key_func,
  521. }, {
  522. .cmd_keyword = {
  523. ethsw_id_aggr,
  524. ethsw_id_help,
  525. ethsw_id_key_end,
  526. },
  527. .cmd_func_offset = -1,
  528. .keyword_function = &ethsw_port_aggr_help_key_func,
  529. }, {
  530. .cmd_keyword = {
  531. ethsw_id_aggr,
  532. ethsw_id_show,
  533. ethsw_id_key_end,
  534. },
  535. .cmd_func_offset = offsetof(struct ethsw_command_func,
  536. port_aggr_show),
  537. .keyword_function = NULL,
  538. }, {
  539. .cmd_keyword = {
  540. ethsw_id_aggr,
  541. ethsw_id_aggr_no,
  542. ethsw_id_key_end,
  543. },
  544. .cmd_func_offset = offsetof(struct ethsw_command_func,
  545. port_aggr_set),
  546. .keyword_function = NULL,
  547. },
  548. };
  549. struct keywords_optional {
  550. int cmd_keyword[ETHSW_MAX_CMD_PARAMS];
  551. } cmd_opt_def[] = {
  552. {
  553. .cmd_keyword = {
  554. ethsw_id_port,
  555. ethsw_id_port_no,
  556. ethsw_id_key_end,
  557. },
  558. }, {
  559. .cmd_keyword = {
  560. ethsw_id_vlan,
  561. ethsw_id_vlan_no,
  562. ethsw_id_key_end,
  563. },
  564. }, {
  565. .cmd_keyword = {
  566. ethsw_id_port,
  567. ethsw_id_port_no,
  568. ethsw_id_vlan,
  569. ethsw_id_vlan_no,
  570. ethsw_id_key_end,
  571. },
  572. },
  573. };
  574. static int keyword_match_gen(enum ethsw_keyword_id key_id, int argc, char
  575. *const argv[], int *argc_nr,
  576. struct ethsw_command_def *parsed_cmd);
  577. static int keyword_match_port(enum ethsw_keyword_id key_id, int argc,
  578. char *const argv[], int *argc_nr,
  579. struct ethsw_command_def *parsed_cmd);
  580. static int keyword_match_vlan(enum ethsw_keyword_id key_id, int argc,
  581. char *const argv[], int *argc_nr,
  582. struct ethsw_command_def *parsed_cmd);
  583. static int keyword_match_pvid(enum ethsw_keyword_id key_id, int argc,
  584. char *const argv[], int *argc_nr,
  585. struct ethsw_command_def *parsed_cmd);
  586. static int keyword_match_mac_addr(enum ethsw_keyword_id key_id, int argc,
  587. char *const argv[], int *argc_nr,
  588. struct ethsw_command_def *parsed_cmd);
  589. static int keyword_match_aggr(enum ethsw_keyword_id key_id, int argc,
  590. char *const argv[], int *argc_nr,
  591. struct ethsw_command_def *parsed_cmd);
  592. /*
  593. * Define properties for each keyword;
  594. * keep the order synced with enum ethsw_keyword_id
  595. */
  596. struct keyword_def {
  597. const char *keyword_name;
  598. int (*match)(enum ethsw_keyword_id key_id, int argc, char *const argv[],
  599. int *argc_nr, struct ethsw_command_def *parsed_cmd);
  600. } keyword[] = {
  601. {
  602. .keyword_name = "help",
  603. .match = &keyword_match_gen,
  604. }, {
  605. .keyword_name = "show",
  606. .match = &keyword_match_gen,
  607. }, {
  608. .keyword_name = "port",
  609. .match = &keyword_match_port
  610. }, {
  611. .keyword_name = "enable",
  612. .match = &keyword_match_gen,
  613. }, {
  614. .keyword_name = "disable",
  615. .match = &keyword_match_gen,
  616. }, {
  617. .keyword_name = "statistics",
  618. .match = &keyword_match_gen,
  619. }, {
  620. .keyword_name = "clear",
  621. .match = &keyword_match_gen,
  622. }, {
  623. .keyword_name = "learning",
  624. .match = &keyword_match_gen,
  625. }, {
  626. .keyword_name = "auto",
  627. .match = &keyword_match_gen,
  628. }, {
  629. .keyword_name = "vlan",
  630. .match = &keyword_match_vlan,
  631. }, {
  632. .keyword_name = "fdb",
  633. .match = &keyword_match_gen,
  634. }, {
  635. .keyword_name = "add",
  636. .match = &keyword_match_mac_addr,
  637. }, {
  638. .keyword_name = "del",
  639. .match = &keyword_match_mac_addr,
  640. }, {
  641. .keyword_name = "flush",
  642. .match = &keyword_match_gen,
  643. }, {
  644. .keyword_name = "pvid",
  645. .match = &keyword_match_pvid,
  646. }, {
  647. .keyword_name = "untagged",
  648. .match = &keyword_match_gen,
  649. }, {
  650. .keyword_name = "all",
  651. .match = &keyword_match_gen,
  652. }, {
  653. .keyword_name = "none",
  654. .match = &keyword_match_gen,
  655. }, {
  656. .keyword_name = "egress",
  657. .match = &keyword_match_gen,
  658. }, {
  659. .keyword_name = "tag",
  660. .match = &keyword_match_gen,
  661. }, {
  662. .keyword_name = "classified",
  663. .match = &keyword_match_gen,
  664. }, {
  665. .keyword_name = "shared",
  666. .match = &keyword_match_gen,
  667. }, {
  668. .keyword_name = "private",
  669. .match = &keyword_match_gen,
  670. }, {
  671. .keyword_name = "ingress",
  672. .match = &keyword_match_gen,
  673. }, {
  674. .keyword_name = "filtering",
  675. .match = &keyword_match_gen,
  676. }, {
  677. .keyword_name = "aggr",
  678. .match = &keyword_match_aggr,
  679. },
  680. };
  681. /*
  682. * Function used by an Ethernet Switch driver to set the functions
  683. * that must be called by the parser when an ethsw command is given
  684. */
  685. int ethsw_define_functions(const struct ethsw_command_func *cmd_func)
  686. {
  687. int i;
  688. void **aux_p;
  689. int (*cmd_func_aux)(struct ethsw_command_def *);
  690. if (!cmd_func->ethsw_name)
  691. return -EINVAL;
  692. ethsw_name = cmd_func->ethsw_name;
  693. for (i = 0; i < ARRAY_SIZE(ethsw_cmd_def); i++) {
  694. /*
  695. * get the pointer to the function send by the Ethernet Switch
  696. * driver that corresponds to the proper ethsw command
  697. */
  698. if (ethsw_cmd_def[i].keyword_function)
  699. continue;
  700. aux_p = (void *)cmd_func + ethsw_cmd_def[i].cmd_func_offset;
  701. cmd_func_aux = (int (*)(struct ethsw_command_def *)) *aux_p;
  702. ethsw_cmd_def[i].keyword_function = cmd_func_aux;
  703. }
  704. return 0;
  705. }
  706. /* Generic function used to match a keyword only by a string */
  707. static int keyword_match_gen(enum ethsw_keyword_id key_id, int argc,
  708. char *const argv[], int *argc_nr,
  709. struct ethsw_command_def *parsed_cmd)
  710. {
  711. if (strcmp(argv[*argc_nr], keyword[key_id].keyword_name) == 0) {
  712. parsed_cmd->cmd_to_keywords[*argc_nr] = key_id;
  713. return 1;
  714. }
  715. return 0;
  716. }
  717. /* Function used to match the command's port */
  718. static int keyword_match_port(enum ethsw_keyword_id key_id, int argc,
  719. char *const argv[], int *argc_nr,
  720. struct ethsw_command_def *parsed_cmd)
  721. {
  722. unsigned long val;
  723. if (!keyword_match_gen(key_id, argc, argv, argc_nr, parsed_cmd))
  724. return 0;
  725. if (*argc_nr + 1 >= argc)
  726. return 0;
  727. if (strict_strtoul(argv[*argc_nr + 1], 10, &val) != -EINVAL) {
  728. parsed_cmd->port = val;
  729. (*argc_nr)++;
  730. parsed_cmd->cmd_to_keywords[*argc_nr] = ethsw_id_port_no;
  731. return 1;
  732. }
  733. return 0;
  734. }
  735. /* Function used to match the command's vlan */
  736. static int keyword_match_vlan(enum ethsw_keyword_id key_id, int argc,
  737. char *const argv[], int *argc_nr,
  738. struct ethsw_command_def *parsed_cmd)
  739. {
  740. unsigned long val;
  741. int aux;
  742. if (!keyword_match_gen(key_id, argc, argv, argc_nr, parsed_cmd))
  743. return 0;
  744. if (*argc_nr + 1 >= argc)
  745. return 0;
  746. if (strict_strtoul(argv[*argc_nr + 1], 10, &val) != -EINVAL) {
  747. parsed_cmd->vid = val;
  748. (*argc_nr)++;
  749. parsed_cmd->cmd_to_keywords[*argc_nr] = ethsw_id_vlan_no;
  750. return 1;
  751. }
  752. aux = *argc_nr + 1;
  753. if (keyword_match_gen(ethsw_id_add, argc, argv, &aux, parsed_cmd))
  754. parsed_cmd->cmd_to_keywords[*argc_nr + 1] = ethsw_id_add;
  755. else if (keyword_match_gen(ethsw_id_del, argc, argv, &aux, parsed_cmd))
  756. parsed_cmd->cmd_to_keywords[*argc_nr + 1] = ethsw_id_del;
  757. else
  758. return 0;
  759. if (*argc_nr + 2 >= argc)
  760. return 0;
  761. if (strict_strtoul(argv[*argc_nr + 2], 10, &val) != -EINVAL) {
  762. parsed_cmd->vid = val;
  763. (*argc_nr) += 2;
  764. parsed_cmd->cmd_to_keywords[*argc_nr] = ethsw_id_add_del_no;
  765. return 1;
  766. }
  767. return 0;
  768. }
  769. /* Function used to match the command's pvid */
  770. static int keyword_match_pvid(enum ethsw_keyword_id key_id, int argc,
  771. char *const argv[], int *argc_nr,
  772. struct ethsw_command_def *parsed_cmd)
  773. {
  774. unsigned long val;
  775. if (!keyword_match_gen(key_id, argc, argv, argc_nr, parsed_cmd))
  776. return 0;
  777. if (*argc_nr + 1 >= argc)
  778. return 1;
  779. if (strict_strtoul(argv[*argc_nr + 1], 10, &val) != -EINVAL) {
  780. parsed_cmd->vid = val;
  781. (*argc_nr)++;
  782. parsed_cmd->cmd_to_keywords[*argc_nr] = ethsw_id_pvid_no;
  783. }
  784. return 1;
  785. }
  786. /* Function used to match the command's MAC address */
  787. static int keyword_match_mac_addr(enum ethsw_keyword_id key_id, int argc,
  788. char *const argv[], int *argc_nr,
  789. struct ethsw_command_def *parsed_cmd)
  790. {
  791. if (!keyword_match_gen(key_id, argc, argv, argc_nr, parsed_cmd))
  792. return 0;
  793. if ((*argc_nr + 1 >= argc) ||
  794. !is_broadcast_ethaddr(parsed_cmd->ethaddr))
  795. return 1;
  796. if (eth_validate_ethaddr_str(argv[*argc_nr + 1])) {
  797. printf("Invalid MAC address: %s\n", argv[*argc_nr + 1]);
  798. return 0;
  799. }
  800. string_to_enetaddr(argv[*argc_nr + 1], parsed_cmd->ethaddr);
  801. if (is_broadcast_ethaddr(parsed_cmd->ethaddr)) {
  802. memset(parsed_cmd->ethaddr, 0xFF, sizeof(parsed_cmd->ethaddr));
  803. return 0;
  804. }
  805. parsed_cmd->cmd_to_keywords[*argc_nr + 1] = ethsw_id_add_del_mac;
  806. return 1;
  807. }
  808. /* Function used to match the command's aggregation number */
  809. static int keyword_match_aggr(enum ethsw_keyword_id key_id, int argc,
  810. char *const argv[], int *argc_nr,
  811. struct ethsw_command_def *parsed_cmd)
  812. {
  813. unsigned long val;
  814. if (!keyword_match_gen(key_id, argc, argv, argc_nr, parsed_cmd))
  815. return 0;
  816. if (*argc_nr + 1 >= argc)
  817. return 1;
  818. if (strict_strtoul(argv[*argc_nr + 1], 10, &val) != -EINVAL) {
  819. parsed_cmd->aggr_grp = val;
  820. (*argc_nr)++;
  821. parsed_cmd->cmd_to_keywords[*argc_nr] = ethsw_id_aggr_no;
  822. }
  823. return 1;
  824. }
  825. /* Finds optional keywords and modifies *argc_va to skip them */
  826. static void cmd_keywords_opt_check(const struct ethsw_command_def *parsed_cmd,
  827. int *argc_val)
  828. {
  829. int i;
  830. int keyw_opt_matched;
  831. int argc_val_max;
  832. int const *cmd_keyw_p;
  833. int const *cmd_keyw_opt_p;
  834. /* remember the best match */
  835. argc_val_max = *argc_val;
  836. /*
  837. * check if our command's optional keywords match the optional
  838. * keywords of an available command
  839. */
  840. for (i = 0; i < ARRAY_SIZE(cmd_opt_def); i++) {
  841. keyw_opt_matched = 0;
  842. cmd_keyw_p = &parsed_cmd->cmd_to_keywords[keyw_opt_matched];
  843. cmd_keyw_opt_p = &cmd_opt_def[i].cmd_keyword[keyw_opt_matched];
  844. /*
  845. * increase the number of keywords that
  846. * matched with a command
  847. */
  848. while (keyw_opt_matched + *argc_val <
  849. parsed_cmd->cmd_keywords_nr &&
  850. *cmd_keyw_opt_p != ethsw_id_key_end &&
  851. *(cmd_keyw_p + *argc_val) == *cmd_keyw_opt_p) {
  852. keyw_opt_matched++;
  853. cmd_keyw_p++;
  854. cmd_keyw_opt_p++;
  855. }
  856. /*
  857. * if all our optional command's keywords perfectly match an
  858. * optional pattern, then we can move to the next defined
  859. * keywords in our command; remember the one that matched the
  860. * greatest number of keywords
  861. */
  862. if (keyw_opt_matched + *argc_val <=
  863. parsed_cmd->cmd_keywords_nr &&
  864. *cmd_keyw_opt_p == ethsw_id_key_end &&
  865. *argc_val + keyw_opt_matched > argc_val_max)
  866. argc_val_max = *argc_val + keyw_opt_matched;
  867. }
  868. *argc_val = argc_val_max;
  869. }
  870. /*
  871. * Finds the function to call based on keywords and
  872. * modifies *argc_va to skip them
  873. */
  874. static void cmd_keywords_check(struct ethsw_command_def *parsed_cmd,
  875. int *argc_val)
  876. {
  877. int i;
  878. int keyw_matched;
  879. int *cmd_keyw_p;
  880. int *cmd_keyw_def_p;
  881. /*
  882. * check if our command's keywords match the
  883. * keywords of an available command
  884. */
  885. for (i = 0; i < ARRAY_SIZE(ethsw_cmd_def); i++) {
  886. keyw_matched = 0;
  887. cmd_keyw_p = &parsed_cmd->cmd_to_keywords[keyw_matched];
  888. cmd_keyw_def_p = &ethsw_cmd_def[i].cmd_keyword[keyw_matched];
  889. /*
  890. * increase the number of keywords that
  891. * matched with a command
  892. */
  893. while (keyw_matched + *argc_val < parsed_cmd->cmd_keywords_nr &&
  894. *cmd_keyw_def_p != ethsw_id_key_end &&
  895. *(cmd_keyw_p + *argc_val) == *cmd_keyw_def_p) {
  896. keyw_matched++;
  897. cmd_keyw_p++;
  898. cmd_keyw_def_p++;
  899. }
  900. /*
  901. * if all our command's keywords perfectly match an
  902. * available command, then we get the function we need to call
  903. * to configure the Ethernet Switch
  904. */
  905. if (keyw_matched && keyw_matched + *argc_val ==
  906. parsed_cmd->cmd_keywords_nr &&
  907. *cmd_keyw_def_p == ethsw_id_key_end) {
  908. *argc_val += keyw_matched;
  909. parsed_cmd->cmd_function =
  910. ethsw_cmd_def[i].keyword_function;
  911. return;
  912. }
  913. }
  914. }
  915. /* find all the keywords in the command */
  916. static int keywords_find(int argc, char *const argv[],
  917. struct ethsw_command_def *parsed_cmd)
  918. {
  919. int i;
  920. int j;
  921. int argc_val;
  922. int rc = CMD_RET_SUCCESS;
  923. for (i = 1; i < argc; i++) {
  924. for (j = 0; j < ethsw_id_count; j++) {
  925. if (keyword[j].match(j, argc, argv, &i, parsed_cmd))
  926. break;
  927. }
  928. }
  929. /* if there is no keyword match for a word, the command is invalid */
  930. for (i = 1; i < argc; i++)
  931. if (parsed_cmd->cmd_to_keywords[i] == ethsw_id_key_end)
  932. rc = CMD_RET_USAGE;
  933. parsed_cmd->cmd_keywords_nr = argc;
  934. argc_val = 1;
  935. /* get optional parameters first */
  936. cmd_keywords_opt_check(parsed_cmd, &argc_val);
  937. if (argc_val == parsed_cmd->cmd_keywords_nr)
  938. return CMD_RET_USAGE;
  939. /*
  940. * check the keywords and if a match is found,
  941. * get the function to call
  942. */
  943. cmd_keywords_check(parsed_cmd, &argc_val);
  944. /* error if not all commands' parameters were matched */
  945. if (argc_val == parsed_cmd->cmd_keywords_nr) {
  946. if (!parsed_cmd->cmd_function) {
  947. printf("Command not available for: %s\n", ethsw_name);
  948. rc = CMD_RET_FAILURE;
  949. }
  950. } else {
  951. rc = CMD_RET_USAGE;
  952. }
  953. return rc;
  954. }
  955. static void command_def_init(struct ethsw_command_def *parsed_cmd)
  956. {
  957. int i;
  958. for (i = 0; i < ETHSW_MAX_CMD_PARAMS; i++)
  959. parsed_cmd->cmd_to_keywords[i] = ethsw_id_key_end;
  960. parsed_cmd->port = ETHSW_CMD_PORT_ALL;
  961. parsed_cmd->vid = ETHSW_CMD_VLAN_ALL;
  962. parsed_cmd->aggr_grp = ETHSW_CMD_AGGR_GRP_NONE;
  963. parsed_cmd->cmd_function = NULL;
  964. /* We initialize the MAC address with the Broadcast address */
  965. memset(parsed_cmd->ethaddr, 0xff, sizeof(parsed_cmd->ethaddr));
  966. }
  967. /* function to interpret commands starting with "ethsw " */
  968. static int do_ethsw(struct cmd_tbl *cmdtp, int flag, int argc,
  969. char *const argv[])
  970. {
  971. struct ethsw_command_def parsed_cmd;
  972. int rc = CMD_RET_SUCCESS;
  973. if (argc == 1 || argc >= ETHSW_MAX_CMD_PARAMS)
  974. return CMD_RET_USAGE;
  975. command_def_init(&parsed_cmd);
  976. rc = keywords_find(argc, argv, &parsed_cmd);
  977. if (rc == CMD_RET_SUCCESS)
  978. rc = parsed_cmd.cmd_function(&parsed_cmd);
  979. return rc;
  980. }
  981. #define ETHSW_PORT_CONF_HELP "[port <port_no>] { enable | disable | show } " \
  982. "- enable/disable a port; show a port's configuration"
  983. U_BOOT_CMD(ethsw, ETHSW_MAX_CMD_PARAMS, 0, do_ethsw,
  984. "Ethernet l2 switch commands",
  985. ETHSW_PORT_CONF_HELP"\n"
  986. ETHSW_PORT_STATS_HELP"\n"
  987. ETHSW_LEARN_HELP"\n"
  988. ETHSW_FDB_HELP"\n"
  989. ETHSW_PVID_HELP"\n"
  990. ETHSW_VLAN_HELP"\n"
  991. ETHSW_PORT_UNTAG_HELP"\n"
  992. ETHSW_EGR_VLAN_TAG_HELP"\n"
  993. ETHSW_VLAN_FDB_HELP"\n"
  994. ETHSW_PORT_INGR_FLTR_HELP"\n"
  995. ETHSW_PORT_AGGR_HELP"\n"
  996. );