T2080 SRIO DOORBELL例程

/* Copyright (c) 2011-2012 Freescale Semiconductor, Inc. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * Neither the name of Freescale Semiconductor nor the * names of its contributors may be used to endorse or promote products * derived from this software without specific prior written permission. * * * ALTERNATIVELY, this software may be distributed under the terms of the * GNU General Public License ("GPL") as published by the Free Software * Foundation, either version 2 of that License or (at your option) any * later version. * * THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include <fra_cfg_parser.h> #include <usdpaa/fman.h> #include <libxml/parser.h> #define FRA_CFG_FILE_ROOT_NODE ("fra_cfg") #define FRA_DEFCFG_NODE ("defcfg") #define FRA_DEFCFG_FILE ("file") #define RMAN_CFG_NODE ("rman_cfg") #define RMAN_CFG_TYPE ("type") #define RMAN_CFG_VALUE ("value") #define RMAN_CFG_INDEX ("index") #define RMAN_FQ_BITS_NODE ("fqbits") #define MD_CREATE_NODE ("md_create") #define MD_CREATE_MODE ("mode") #define RMAN_OSID_NODE ("osid") #define BPID_NODE ("bpid") #define SG_BPID_NODE ("sgbpid") #define RMAN_EFQ_NODE ("efq") #define NETWORK_CFG_NODE ("network_cfg") #define FMAN_PORT_NODE ("port") #define FMAN_PORT_NAME ("name") #define FMAN_PORT_TYPE ("type") #define FMAN_PORT_NUM ("number") #define FMAN_NUM ("fm") #define TRANS_CFG_NODE ("trans_cfg") #define TRAN_NODE ("transaction") #define TRAN_NAME ("name") #define TRAN_TYPE ("type") #define TRAN_COMMON_VALUE ("value") #define TRAN_COMMON_MASK ("mask") #define TRAN_FLOWLVL_NODE ("flowlvl") #define TRAN_MBOX_NODE ("mbox") #define TRAN_LTR_NODE ("ltr") #define TRAN_MSGLEN_NODE ("msglen") #define TRAN_COS_NODE ("cos") #define TRAN_STREAMID_NODE ("streamid") #define DISTS_CFG_NODE ("dists_cfg") #define DIST_NODE ("distribution") #define DIST_NAME ("name") #define DIST_TYPE ("type") #define DISTREF_NODE ("distributionref") #define DIST_RIO_PORT_NODE ("rio_port") #define DIST_RIO_PORT_MASK ("mask") #define DIST_PORT_NUMBER ("number") #define DIST_SID_NODE ("sid") #define DIST_SID_VALUE ("value") #define DIST_SID_MASK ("mask") #define DIST_DID_NODE ("did") #define DIST_DID_VALUE ("value") #define DIST_FQ_NODE ("queue") #define DIST_FQ_ID ("base") #define DIST_FQ_MODE ("mode") #define DIST_FQ_COUNT ("count") #define DIST_FQ_WQ ("wq") #define DIST_TRANREF_NODE ("transactionref") #define DIST_TRANREF_NAME ("name") #define DIST_FMAN_PORT_NODE ("fman_port") #define POLICIES_CFG_NODE ("policies_cfg") #define POLICY_NODE ("policy") #define POLICY_NAME ("name") #define POLICY_ENABLE ("enable") #define POLICY_DISTORDER_NODE ("dist_order") #define POLICY_DISTREF_NODE ("distributionref") #define POLICY_DISTREF_NAME ("name") const char *RIO_TYPE_TO_STR[] = { [RIO_TYPE0] = "Implementation-defined", [RIO_TYPE1] = "reserved", [RIO_TYPE2] = "NREAD", [RIO_TYPE3] = "reserved", [RIO_TYPE4] = "reserved", [RIO_TYPE5] = "NWrite", [RIO_TYPE6] = "SWrite", [RIO_TYPE7] = "reserved", [RIO_TYPE8] = "Port-Write", [RIO_TYPE9] = "Data-streaming", [RIO_TYPE10] = "Doorbell", [RIO_TYPE11] = "Mailbox" }; const char *DIST_TYPE_STR[] = { [DIST_TYPE_UNKNOWN] = "UNKNOWN", [DIST_TYPE_RMAN_RX] = "RMAN_RX", [DIST_TYPE_RMAN_TX] = "RMAN_TX", [DIST_TYPE_FMAN_RX] = "FMAN_RX", [DIST_TYPE_FMAN_TX] = "FMAN_TX", [DIST_TYPE_FMAN_TO_RMAN] = "FMAN_TO_RMAN", [DIST_TYPE_RMAN_TO_FMAN] = "RMAN_TO_FMAN" }; const char *FQ_MODE_STR[] = {"direct", "algorithmic"}; const char *MD_CREATE_MODE_STR[] = {"yes", "no"}; static struct fra_cfg *fracfg; xmlNodePtr fra_cfg_root_node; #define for_all_sibling_nodes(node) \ for (; unlikely(node != NULL); node = node->next) static void fra_cfg_parse_error(void *ctx, xmlErrorPtr xep) { error(0, 0, "%s:%hu:%s() fra_cfg_parse_error(context(%p)," "error pointer %p", __FILE__, __LINE__, __func__, ctx, xep); } static inline int is_node(xmlNodePtr node, xmlChar *name) { return xmlStrcmp(node->name, name) ? 0 : 1; } static void *get_attributes(xmlNodePtr node, xmlChar *attr) { char *atr = (char *)xmlGetProp(node, attr); if (unlikely(atr == NULL)) error(0, 0, "%s:%hu:%s() error: " "(Node(%s)->Attribute (%s) not found", __FILE__, __LINE__, __func__, node->name, attr); return atr; } static enum dist_type dist_type_str_to_idx(const char *type) { int idx; for (idx = 0; idx < ARRAY_SIZE(DIST_TYPE_STR); idx++) { if (!strcmp(type, DIST_TYPE_STR[idx])) return idx; } return DIST_TYPE_UNKNOWN; } static enum RIO_TYPE rio_type_str_to_idx(const char *type) { int idx; for (idx = 0; idx < ARRAY_SIZE(RIO_TYPE_TO_STR); idx++) { if (!strcmp(type, RIO_TYPE_TO_STR[idx])) return idx; } return RIO_TYPE0; } static void strip_blanks(char *str) { int i, j; int len = strlen(str); for (i = 0; (i < len) && (str[i] == ' '); i++) ; for (j = 0; (i < len) && (str[i] != ' '); ++i, j++) str[j] = str[i]; str[j] = '\0'; } #define tran_parse_element(node, value, mask) \ do { \ char *ptr; \ ptr = get_attributes(node, BAD_CAST TRAN_COMMON_VALUE); \ if (unlikely(ptr == NULL)) \ return -EINVAL; \ value = strtoul(ptr, NULL, 0); \ ptr = get_attributes(node, BAD_CAST TRAN_COMMON_MASK); \ if (unlikely(ptr == NULL)) \ return -EINVAL; \ mask = strtoul(ptr, NULL, 0); \ } while (0) #define search_member(member, nm, list) \ do { \ typeof(member) tmp; \ member = NULL; \ if (!nm) \ break; \ list_for_each_entry(tmp, list, node) { \ if (!strncmp(tmp->name, nm, sizeof(tmp->name))) { \ member = tmp; \ break; \ } \ } \ } while (0) static int parse_defcfg_file(char *cfg_file, struct list_head *list, int (*parse_node)(xmlNodePtr node, struct list_head *list)) { xmlErrorPtr xep; xmlDocPtr doc; xmlNodePtr cur; if (!cfg_file || !list || !parse_node) return -EINVAL; xmlInitParser(); LIBXML_TEST_VERSION; xmlSetStructuredErrorFunc(&xep, fra_cfg_parse_error); xmlKeepBlanksDefault(0); doc = xmlParseFile(cfg_file); if (unlikely(doc == NULL)) { error(0, 0, "%s:%hu:%s() xmlParseFile(%s)", __FILE__, __LINE__, __func__, cfg_file); return -EINVAL; } cur = xmlDocGetRootElement(doc); if (unlikely(cur == NULL)) { error(0, 0, "%s:%hu:%s() xml file(%s) empty", __FILE__, __LINE__, __func__, cfg_file); goto _err; } parse_node(cur, list); xmlFreeDoc(doc); return 0; _err: xmlFreeDoc(doc); return -EINVAL; } static int parse_tran(xmlNodePtr tran_node, struct list_head *list) { char *name; char *type; xmlNodePtr tranp; struct rio_tran *tran; if (!tran_node) return -EINVAL; name = get_attributes(tran_node, BAD_CAST TRAN_NAME); search_member(tran, name, list); if (!tran)