123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396 |
- /*
- This software is available to you under a choice of one of two
- licenses. You may choose to be licensed under the terms of the GNU
- General Public License (GPL) Version 2, available at
- <http://www.fsf.org/copyleft/gpl.html>, or the OpenIB.org BSD
- license, available in the LICENSE.TXT file accompanying this
- software. These details are also available at
- <http://openib.org/license.html>.
-
- THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
- EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
- MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
- NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
- BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
- ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
- CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
- SOFTWARE.
-
- Copyright (c) 2004 Mellanox Technologies Ltd. All rights reserved.
- */
-
- #include "ib_mad.h"
- #include "mad_attrib.h"
- #include "cmdif.h"
- #include "ib_driver.h"
-
- #define TID_START 0x1234
- #define TID_INC 117
-
- static u32 next_tid = TID_START;
-
- /*
- * get_port_info
- *
- * query the local device for the portinfo attribute
- *
- * port(in) port number to query
- * buf(out) buffer to hold the result
- */
- static int get_port_info(__u8 port, struct port_info_st *buf, __u16 * status)
- {
- union port_info_mad_u *inprm;
- union port_info_mad_u *outprm;
- int rc;
-
- inprm = get_inprm_buf();
- outprm = get_outprm_buf();
- memset(inprm, 0, sizeof *inprm);
-
- inprm->mad.mad_hdr.method = IB_MGMT_METHOD_GET;
- inprm->mad.mad_hdr.mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED;
- inprm->mad.mad_hdr.class_version = 1;
- inprm->mad.mad_hdr.base_version = IB_MGMT_BASE_VERSION;
- inprm->mad.mad_hdr.attr_id = IB_SMP_ATTR_PORT_INFO;
- inprm->mad.mad_hdr.attr_mod = port;
-
- rc = cmd_mad_ifc(inprm, (struct ib_mad_st *)outprm, port);
- if (!rc) {
- memcpy(buf, &outprm->mad.port_info,
- sizeof(outprm->mad.port_info));
- *status = inprm->mad.mad_hdr.status;
- if (!(*status)) {
- ib_data.sm_lid = outprm->mad.port_info.mastersm_lid;
- memcpy(&ib_data.port_gid.raw[0],
- outprm->mad.port_info.gid_prefix, 8);
- cpu_to_be_buf(&ib_data.port_gid.raw[0], 8);
- }
- }
- return rc;
- }
-
- /*
- * get_guid_info
- *
- * query the local device for the guidinfo attribute
- *
- * buf(out) buffer to hold the result
- */
- static int get_guid_info(__u16 * status)
- {
- union guid_info_mad_u *inprm;
- union guid_info_mad_u *outprm;
- int rc;
-
- inprm = get_inprm_buf();
- outprm = get_outprm_buf();
- memset(inprm, 0, sizeof *inprm);
-
- inprm->mad.mad_hdr.method = IB_MGMT_METHOD_GET;
- inprm->mad.mad_hdr.mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED;
- inprm->mad.mad_hdr.class_version = 1;
- inprm->mad.mad_hdr.base_version = IB_MGMT_BASE_VERSION;
- inprm->mad.mad_hdr.attr_id = IB_SMP_ATTR_GUID_INFO;
- inprm->mad.mad_hdr.attr_mod = 0;
-
- rc = cmd_mad_ifc(inprm, (struct ib_mad_st *)outprm, ib_data.port);
- if (!rc) {
- *status = inprm->mad.mad_hdr.status;
- if (!(*status)) {
- memcpy(&ib_data.port_gid.raw[8],
- &outprm->mad.guid_info.gid_tbl[0], 8);
- cpu_to_be_buf(&ib_data.port_gid.raw[8], 8);
- }
- }
- return rc;
- }
-
- static int get_pkey_tbl(struct pkey_tbl_st *pkey_tbl, __u16 * status)
- {
- union pkey_tbl_mad_u *inprm;
- union pkey_tbl_mad_u *outprm;
- int rc;
-
- inprm = get_inprm_buf();
- outprm = get_outprm_buf();
- memset(inprm, 0, sizeof *inprm);
- memset(outprm, 0, sizeof *outprm);
-
- inprm->mad.mad_hdr.method = IB_MGMT_METHOD_GET;
- inprm->mad.mad_hdr.mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED;
- inprm->mad.mad_hdr.class_version = 1;
- inprm->mad.mad_hdr.base_version = IB_MGMT_BASE_VERSION;
- inprm->mad.mad_hdr.attr_id = IB_SMP_ATTR_PKEY_TABLE;
- inprm->mad.mad_hdr.attr_mod = 0;
-
- rc = cmd_mad_ifc(inprm, (struct ib_mad_st *)outprm, 1);
- if (!rc) {
- if (pkey_tbl)
- memcpy(pkey_tbl, &outprm->mad.pkey_tbl, 2);
- *status = inprm->mad.mad_hdr.status;
- if (!(*status)) {
- ib_data.pkey = outprm->mad.pkey_tbl.pkey_tbl[0][1];
- ib_data.bcast_gid.raw[4] =
- outprm->mad.pkey_tbl.pkey_tbl[0][1] >> 8;
- ib_data.bcast_gid.raw[5] =
- outprm->mad.pkey_tbl.pkey_tbl[0][1] & 0xff;
- }
- }
- return rc;
- }
-
- static int join_mc_group(__u32 * qkey_p, __u16 * mlid_p, __u8 join)
- {
- struct mc_member_mad_st *mad, *rcv_mad;
- void *snd_wqe;
- void *tmp_wqe;
- udqp_t qp;
- void *av;
- int rc;
- u32 tid;
- void *rcv_wqe;
- int is_good;
-
- qp = ib_data.mads_qp;
-
- snd_wqe = alloc_send_wqe(qp);
- if (!snd_wqe) {
- eprintf("");
- return -1;
- }
- tprintf("allocated snd_wqe=0x%lx", snd_wqe);
-
- mad = get_send_wqe_buf(snd_wqe, 0);
- memset(mad, 0, 256);
-
- av = alloc_ud_av();
- if (!av) {
- eprintf("");
- free_wqe(snd_wqe);
- return -1;
- }
- modify_av_params(av, ib_data.sm_lid, 0, 0, 0, NULL, SA_QPN);
-
- prep_send_wqe_buf(qp, av, snd_wqe, NULL, 0, 256, 0);
-
- mad->mad_hdr.method = join ? IB_MGMT_METHOD_SET : IB_MGMT_METHOD_DELETE;
- mad->mad_hdr.mgmt_class = IB_MGMT_CLASS_SUBN_ADM;
- mad->mad_hdr.class_version = 2;
- mad->mad_hdr.base_version = IB_MGMT_BASE_VERSION;
- mad->mad_hdr.attr_id = IB_SA_ATTR_MC_MEMBER_REC;
- tid = next_tid;
- next_tid += TID_INC;
- mad->mad_hdr.tid[1] = tid;
-
- mad->sa_hdr.comp_mask[1] = IB_SA_MCMEMBER_REC_MGID |
- IB_SA_MCMEMBER_REC_PORT_GID | IB_SA_MCMEMBER_REC_JOIN_STATE;
-
- mad->mc_member.combined4 |= (1 << 24); /*mad->mc_member.join_state = 1; */
-
- be_to_cpu_buf(mad, sizeof *mad);
- memcpy(mad->mc_member.mgid, ib_data.bcast_gid.raw, 16);
- memcpy(mad->mc_member.port_gid, ib_data.port_gid.raw, 16);
-
- rc = post_send_req(qp, snd_wqe, 1);
- if (rc) {
- eprintf("");
- free_ud_av(av);
- free_wqe(snd_wqe);
- return -1;
- }
-
- tprintf("");
- /* poll the CQ to get the completions
- on the send and the expected receive */
-
- /* send completion */
- rc = poll_cqe_tout(ib_data.mads_snd_cq, SEND_CQE_POLL_TOUT, &tmp_wqe,
- &is_good);
- if (rc) {
- eprintf("");
- return -1;
- }
-
- if (tmp_wqe != snd_wqe) {
- eprintf("");
- return -1;
- }
-
- if (free_wqe(snd_wqe)) {
- eprintf("");
- return -1;
- }
- free_ud_av(av);
-
- if (!is_good) {
- eprintf("");
- return -1;
- }
-
- /* receive completion */
- rc = poll_cqe_tout(ib_data.mads_rcv_cq, SA_RESP_POLL_TOUT, &rcv_wqe,
- &is_good);
- if (rc) {
- eprintf("");
- return -1;
- }
-
- if (is_good) {
- rcv_mad = get_rcv_wqe_buf(rcv_wqe, 1);
- be_to_cpu_buf(rcv_mad, sizeof *rcv_mad);
- if (rcv_mad->mad_hdr.tid[1] == tid) {
- /* that's our response */
- if (mad->mad_hdr.status == 0) {
- /* good response - save results */
- *qkey_p = rcv_mad->mc_member.q_key;
- *mlid_p = rcv_mad->mc_member.combined1 >> 16; // rcv_mad->mc_member.mlid;
- } else {
- /* join failed */
- eprintf("");
- return -1;
- }
- } else {
- /* not our response */
- eprintf("");
- return -1;
- }
- }
-
- if (free_wqe(rcv_wqe)) {
- eprintf("");
- return -1;
- }
-
- return is_good ? 0 : -1;
- }
-
- static int get_path_record(union ib_gid_u *dgid, __u16 * dlid_p, u8 * sl_p,
- u8 * rate_p)
- {
- struct path_record_mad_st *mad, *rcv_mad;
- void *snd_wqe;
- udqp_t qp;
- ud_av_t av;
- void *tmp_wqe;
- void *rcv_wqe;
- u32 tid;
- int rc;
- int is_good;
-
- tprintf("gid=%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:"
- "%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x",
- dgid->raw[0], dgid->raw[1], dgid->raw[2], dgid->raw[3],
- dgid->raw[4], dgid->raw[5], dgid->raw[6], dgid->raw[7],
- dgid->raw[8], dgid->raw[9], dgid->raw[10], dgid->raw[11],
- dgid->raw[12], dgid->raw[13], dgid->raw[14], dgid->raw[15]);
- qp = ib_data.mads_qp;
-
- snd_wqe = alloc_send_wqe(qp);
- if (!snd_wqe) {
- eprintf("");
- return -1;
- }
-
- mad = get_send_wqe_buf(snd_wqe, 0);
- memset(mad, 0, 256);
-
- av = alloc_ud_av();
- if (!av) {
- eprintf("");
- free_wqe(snd_wqe);
- return -1;
- }
- modify_av_params(av, ib_data.sm_lid, 0, 0, 0, NULL, SA_QPN);
-
- prep_send_wqe_buf(qp, av, snd_wqe, NULL, 0, 256, 0);
-
- mad->mad_hdr.method = IB_MGMT_METHOD_GET;
- mad->mad_hdr.mgmt_class = IB_MGMT_CLASS_SUBN_ADM;
- mad->mad_hdr.class_version = 2;
- mad->mad_hdr.base_version = IB_MGMT_BASE_VERSION;
- mad->mad_hdr.attr_id = IB_SA_ATTR_PATH_REC;
- tid = next_tid;
- next_tid += TID_INC;
- mad->mad_hdr.tid[1] = tid;
-
- memcpy(mad->path_record.dgid.raw, dgid->raw, 16);
- cpu_to_be_buf(mad->path_record.dgid.raw, 16);
-
- mad->sa_hdr.comp_mask[1] = IB_SA_PATH_REC_DGID | IB_SA_PATH_REC_SGID;
-
- cpu_to_be_buf(mad, sizeof *mad);
- memcpy(mad->path_record.sgid.raw, ib_data.port_gid.raw, 16);
-
- rc = post_send_req(qp, snd_wqe, 1);
- if (rc) {
- eprintf("");
- free_ud_av(av);
- free_wqe(snd_wqe);
- return rc;
- }
-
- /* poll the CQ to get the completions
- on the send and the expected receive */
-
- /* send completion */
- rc = poll_cqe_tout(ib_data.mads_snd_cq, SEND_CQE_POLL_TOUT, &tmp_wqe,
- &is_good);
- if (rc) {
- eprintf("");
- return -1;
- }
-
- if (tmp_wqe != snd_wqe) {
- eprintf("");
- return -1;
- }
-
- if (free_wqe(snd_wqe)) {
- eprintf("");
- return -1;
- }
- free_ud_av(av);
-
- if (!is_good) {
- eprintf("");
- return -1;
- }
-
- /* receive completion */
- rc = poll_cqe_tout(ib_data.mads_rcv_cq, SA_RESP_POLL_TOUT, &rcv_wqe,
- &is_good);
- if (rc) {
- eprintf("");
- return -1;
- }
-
- if (is_good) {
- rcv_mad = get_rcv_wqe_buf(rcv_wqe, 1);
- be_to_cpu_buf(rcv_mad, sizeof *rcv_mad);
- if (rcv_mad->mad_hdr.tid[1] == tid) {
- /* that's our response */
- if (mad->mad_hdr.status == 0) {
- /* good response - save results */
- *dlid_p = rcv_mad->path_record.dlid;
- *sl_p = (rcv_mad->path_record.combined3 >> 16) & 0xf; // rcv_mad->path_record.sl;
- *rate_p = rcv_mad->path_record.combined3 & 0x3f; //rcv_mad->path_record.rate;
- } else {
- /* join failed */
- eprintf("");
- return -1;
- }
- } else {
- /* not our response */
- eprintf("");
- return -1;
- }
- }
-
- if (free_wqe(rcv_wqe)) {
- eprintf("");
- return -1;
- }
-
- tprintf("");
- return is_good ? 0 : -1;
- }
|