Lines Matching defs:sndev
98 static int switchtec_ntb_part_op(struct switchtec_ntb *sndev,
144 dev_err(&sndev->stdev->dev,
155 static int switchtec_ntb_send_msg(struct switchtec_ntb *sndev, int idx,
158 if (idx < 0 || idx >= ARRAY_SIZE(sndev->mmio_peer_dbmsg->omsg))
161 iowrite32(val, &sndev->mmio_peer_dbmsg->omsg[idx].msg);
168 struct switchtec_ntb *sndev = ntb_sndev(ntb);
169 int nr_direct_mw = sndev->peer_nr_direct_mw;
170 int nr_lut_mw = sndev->peer_nr_lut_mw - sndev->nr_rsvd_luts;
181 static int lut_index(struct switchtec_ntb *sndev, int mw_idx)
183 return mw_idx - sndev->nr_direct_mw + sndev->nr_rsvd_luts;
186 static int peer_lut_index(struct switchtec_ntb *sndev, int mw_idx)
188 return mw_idx - sndev->peer_nr_direct_mw + sndev->nr_rsvd_luts;
196 struct switchtec_ntb *sndev = ntb_sndev(ntb);
203 lut = widx >= sndev->peer_nr_direct_mw;
204 size = ioread64(&sndev->peer_shared->mw_sizes[widx]);
221 static void switchtec_ntb_mw_clr_direct(struct switchtec_ntb *sndev, int idx)
223 struct ntb_ctrl_regs __iomem *ctl = sndev->mmio_peer_ctrl;
224 int bar = sndev->peer_direct_mw_to_bar[idx];
232 iowrite64(sndev->self_partition, &ctl->bar_entry[bar].xlate_addr);
235 static void switchtec_ntb_mw_clr_lut(struct switchtec_ntb *sndev, int idx)
237 struct ntb_ctrl_regs __iomem *ctl = sndev->mmio_peer_ctrl;
239 iowrite64(0, &ctl->lut_entry[peer_lut_index(sndev, idx)]);
242 static void switchtec_ntb_mw_set_direct(struct switchtec_ntb *sndev, int idx,
246 int bar = sndev->peer_direct_mw_to_bar[idx];
247 struct ntb_ctrl_regs __iomem *ctl = sndev->mmio_peer_ctrl;
257 iowrite64(sndev->self_partition | addr,
261 static void switchtec_ntb_mw_set_lut(struct switchtec_ntb *sndev, int idx,
264 struct ntb_ctrl_regs __iomem *ctl = sndev->mmio_peer_ctrl;
266 iowrite64((NTB_CTRL_LUT_EN | (sndev->self_partition << 1) | addr),
267 &ctl->lut_entry[peer_lut_index(sndev, idx)]);
273 struct switchtec_ntb *sndev = ntb_sndev(ntb);
274 struct ntb_ctrl_regs __iomem *ctl = sndev->mmio_peer_ctrl;
276 int nr_direct_mw = sndev->peer_nr_direct_mw;
282 dev_dbg(&sndev->stdev->dev, "MW %d: part %d addr %pad size %pap\n",
299 dev_err(&sndev->stdev->dev,
304 rc = switchtec_ntb_part_op(sndev, ctl, NTB_CTRL_PART_OP_LOCK,
311 switchtec_ntb_mw_clr_direct(sndev, widx);
313 switchtec_ntb_mw_clr_lut(sndev, widx);
316 switchtec_ntb_mw_set_direct(sndev, widx, addr, size);
318 switchtec_ntb_mw_set_lut(sndev, widx, addr, size);
321 rc = switchtec_ntb_part_op(sndev, ctl, NTB_CTRL_PART_OP_CFG,
325 dev_err(&sndev->stdev->dev,
330 switchtec_ntb_mw_clr_direct(sndev, widx);
332 switchtec_ntb_mw_clr_lut(sndev, widx);
334 switchtec_ntb_part_op(sndev, ctl, NTB_CTRL_PART_OP_CFG,
343 struct switchtec_ntb *sndev = ntb_sndev(ntb);
344 int nr_lut_mw = sndev->nr_lut_mw - sndev->nr_rsvd_luts;
346 return sndev->nr_direct_mw + (use_lut_mws ? nr_lut_mw : 0);
349 static int switchtec_ntb_direct_get_addr(struct switchtec_ntb *sndev,
353 int bar = sndev->direct_mw_to_bar[idx];
366 offset = LUT_SIZE * sndev->nr_lut_mw;
370 *base = pci_resource_start(sndev->ntb.pdev, bar) + offset;
373 *size = pci_resource_len(sndev->ntb.pdev, bar) - offset;
384 static int switchtec_ntb_lut_get_addr(struct switchtec_ntb *sndev,
388 int bar = sndev->direct_mw_to_bar[0];
391 offset = LUT_SIZE * lut_index(sndev, idx);
394 *base = pci_resource_start(sndev->ntb.pdev, bar) + offset;
406 struct switchtec_ntb *sndev = ntb_sndev(ntb);
408 if (idx < sndev->nr_direct_mw)
409 return switchtec_ntb_direct_get_addr(sndev, idx, base, size);
411 return switchtec_ntb_lut_get_addr(sndev, idx, base, size);
416 static void switchtec_ntb_part_link_speed(struct switchtec_ntb *sndev,
421 struct switchtec_dev *stdev = sndev->stdev;
435 static void switchtec_ntb_set_link_speed(struct switchtec_ntb *sndev)
440 if (!sndev->link_is_up) {
441 sndev->link_speed = NTB_SPEED_NONE;
442 sndev->link_width = NTB_WIDTH_NONE;
446 switchtec_ntb_part_link_speed(sndev, sndev->self_partition,
448 switchtec_ntb_part_link_speed(sndev, sndev->peer_partition,
451 sndev->link_speed = min(self_speed, peer_speed);
452 sndev->link_width = min(self_width, peer_width);
455 static int crosslink_is_enabled(struct switchtec_ntb *sndev)
457 struct ntb_info_regs __iomem *inf = sndev->mmio_ntb;
459 return ioread8(&inf->ntp_info[sndev->peer_partition].xlink_enabled);
462 static void crosslink_init_dbmsgs(struct switchtec_ntb *sndev)
467 if (!crosslink_is_enabled(sndev))
470 for (i = 0; i < ARRAY_SIZE(sndev->mmio_peer_dbmsg->imsg); i++) {
471 int m = i | sndev->self_partition << 2;
476 iowrite32(msg_map, &sndev->mmio_peer_dbmsg->msg_map);
477 iowrite64(sndev->db_valid_mask << sndev->db_peer_shift,
478 &sndev->mmio_peer_dbmsg->odb_mask);
489 static int switchtec_ntb_reinit_peer(struct switchtec_ntb *sndev);
491 static void switchtec_ntb_link_status_update(struct switchtec_ntb *sndev)
494 int old = sndev->link_is_up;
496 link_sta = sndev->self_shared->link_sta;
498 u64 peer = ioread64(&sndev->peer_shared->magic);
506 sndev->link_is_up = link_sta;
507 switchtec_ntb_set_link_speed(sndev);
510 switchtec_ntb_send_msg(sndev, LINK_MESSAGE, MSG_CHECK_LINK);
511 ntb_link_event(&sndev->ntb);
512 dev_info(&sndev->stdev->dev, "ntb link %s\n",
516 crosslink_init_dbmsgs(sndev);
522 struct switchtec_ntb *sndev;
524 sndev = container_of(work, struct switchtec_ntb,
527 if (sndev->link_force_down) {
528 sndev->link_force_down = false;
529 switchtec_ntb_reinit_peer(sndev);
531 if (sndev->link_is_up) {
532 sndev->link_is_up = 0;
533 ntb_link_event(&sndev->ntb);
534 dev_info(&sndev->stdev->dev, "ntb link forced down\n");
540 switchtec_ntb_link_status_update(sndev);
543 static void switchtec_ntb_check_link(struct switchtec_ntb *sndev,
547 sndev->link_force_down = true;
549 schedule_work(&sndev->check_link_status_work);
554 struct switchtec_ntb *sndev = stdev->sndev;
556 switchtec_ntb_check_link(sndev, MSG_CHECK_LINK);
563 struct switchtec_ntb *sndev = ntb_sndev(ntb);
566 *speed = sndev->link_speed;
568 *width = sndev->link_width;
570 return sndev->link_is_up;
577 struct switchtec_ntb *sndev = ntb_sndev(ntb);
579 dev_dbg(&sndev->stdev->dev, "enabling link\n");
581 sndev->self_shared->link_sta = 1;
582 switchtec_ntb_send_msg(sndev, LINK_MESSAGE, MSG_LINK_UP);
584 switchtec_ntb_link_status_update(sndev);
591 struct switchtec_ntb *sndev = ntb_sndev(ntb);
593 dev_dbg(&sndev->stdev->dev, "disabling link\n");
595 sndev->self_shared->link_sta = 0;
596 switchtec_ntb_send_msg(sndev, LINK_MESSAGE, MSG_LINK_DOWN);
598 switchtec_ntb_link_status_update(sndev);
605 struct switchtec_ntb *sndev = ntb_sndev(ntb);
607 return sndev->db_valid_mask;
617 struct switchtec_ntb *sndev = ntb_sndev(ntb);
622 return sndev->db_valid_mask;
628 struct switchtec_ntb *sndev = ntb_sndev(ntb);
630 ret = ioread64(&sndev->mmio_self_dbmsg->idb) >> sndev->db_shift;
632 return ret & sndev->db_valid_mask;
637 struct switchtec_ntb *sndev = ntb_sndev(ntb);
639 iowrite64(db_bits << sndev->db_shift, &sndev->mmio_self_dbmsg->idb);
647 struct switchtec_ntb *sndev = ntb_sndev(ntb);
649 if (db_bits & ~sndev->db_valid_mask)
652 spin_lock_irqsave(&sndev->db_mask_lock, irqflags);
654 sndev->db_mask |= db_bits << sndev->db_shift;
655 iowrite64(~sndev->db_mask, &sndev->mmio_self_dbmsg->idb_mask);
657 spin_unlock_irqrestore(&sndev->db_mask_lock, irqflags);
665 struct switchtec_ntb *sndev = ntb_sndev(ntb);
667 if (db_bits & ~sndev->db_valid_mask)
670 spin_lock_irqsave(&sndev->db_mask_lock, irqflags);
672 sndev->db_mask &= ~(db_bits << sndev->db_shift);
673 iowrite64(~sndev->db_mask, &sndev->mmio_self_dbmsg->idb_mask);
675 spin_unlock_irqrestore(&sndev->db_mask_lock, irqflags);
682 struct switchtec_ntb *sndev = ntb_sndev(ntb);
684 return (sndev->db_mask >> sndev->db_shift) & sndev->db_valid_mask;
693 struct switchtec_ntb *sndev = ntb_sndev(ntb);
699 offset = (unsigned long)sndev->mmio_peer_dbmsg->odb -
700 (unsigned long)sndev->stdev->mmio;
702 offset += sndev->db_shift / 8;
709 *db_data = BIT_ULL(db_bit) << sndev->db_peer_shift;
716 struct switchtec_ntb *sndev = ntb_sndev(ntb);
718 iowrite64(db_bits << sndev->db_peer_shift,
719 &sndev->mmio_peer_dbmsg->odb);
726 struct switchtec_ntb *sndev = ntb_sndev(ntb);
728 return ARRAY_SIZE(sndev->self_shared->spad);
733 struct switchtec_ntb *sndev = ntb_sndev(ntb);
735 if (idx < 0 || idx >= ARRAY_SIZE(sndev->self_shared->spad))
738 if (!sndev->self_shared)
741 return sndev->self_shared->spad[idx];
746 struct switchtec_ntb *sndev = ntb_sndev(ntb);
748 if (idx < 0 || idx >= ARRAY_SIZE(sndev->self_shared->spad))
751 if (!sndev->self_shared)
754 sndev->self_shared->spad[idx] = val;
762 struct switchtec_ntb *sndev = ntb_sndev(ntb);
767 if (sidx < 0 || sidx >= ARRAY_SIZE(sndev->peer_shared->spad))
770 if (!sndev->peer_shared)
773 return ioread32(&sndev->peer_shared->spad[sidx]);
779 struct switchtec_ntb *sndev = ntb_sndev(ntb);
784 if (sidx < 0 || sidx >= ARRAY_SIZE(sndev->peer_shared->spad))
787 if (!sndev->peer_shared)
790 iowrite32(val, &sndev->peer_shared->spad[sidx]);
798 struct switchtec_ntb *sndev = ntb_sndev(ntb);
804 offset = (unsigned long)&sndev->peer_shared->spad[sidx] -
805 (unsigned long)sndev->stdev->mmio;
840 static int switchtec_ntb_init_sndev(struct switchtec_ntb *sndev)
846 sndev->ntb.pdev = sndev->stdev->pdev;
847 sndev->ntb.topo = NTB_TOPO_SWITCH;
848 sndev->ntb.ops = &switchtec_ntb_ops;
850 INIT_WORK(&sndev->check_link_status_work, check_link_status_work);
851 sndev->link_force_down = false;
853 sndev->self_partition = sndev->stdev->partition;
855 sndev->mmio_ntb = sndev->stdev->mmio_ntb;
857 self = sndev->self_partition;
858 tpart_vec = ioread32(&sndev->mmio_ntb->ntp_info[self].target_part_high);
860 tpart_vec |= ioread32(&sndev->mmio_ntb->ntp_info[self].target_part_low);
862 part_map = ioread64(&sndev->mmio_ntb->ep_map);
864 part_map &= ~(1 << sndev->self_partition);
867 if (sndev->stdev->partition_count != 2) {
868 dev_err(&sndev->stdev->dev,
874 dev_err(&sndev->stdev->dev,
879 sndev->peer_partition = __ffs64(part_map);
882 dev_err(&sndev->stdev->dev,
887 sndev->peer_partition = __ffs64(tpart_vec);
888 if (!(part_map & (1ULL << sndev->peer_partition))) {
889 dev_err(&sndev->stdev->dev,
895 dev_dbg(&sndev->stdev->dev, "Partition ID %d of %d\n",
896 sndev->self_partition, sndev->stdev->partition_count);
898 sndev->mmio_ctrl = (void * __iomem)sndev->mmio_ntb +
900 sndev->mmio_dbmsg = (void * __iomem)sndev->mmio_ntb +
903 sndev->mmio_self_ctrl = &sndev->mmio_ctrl[sndev->self_partition];
904 sndev->mmio_peer_ctrl = &sndev->mmio_ctrl[sndev->peer_partition];
905 sndev->mmio_self_dbmsg = &sndev->mmio_dbmsg[sndev->self_partition];
906 sndev->mmio_peer_dbmsg = sndev->mmio_self_dbmsg;
911 static int config_rsvd_lut_win(struct switchtec_ntb *sndev,
915 int peer_bar = sndev->peer_direct_mw_to_bar[0];
919 rc = switchtec_ntb_part_op(sndev, ctl, NTB_CTRL_PART_OP_LOCK,
928 ctl_val |= (sndev->nr_lut_mw - 1) << 14;
934 rc = switchtec_ntb_part_op(sndev, ctl, NTB_CTRL_PART_OP_CFG,
941 dev_err(&sndev->stdev->dev,
950 static int config_req_id_table(struct switchtec_ntb *sndev,
959 dev_err(&sndev->stdev->dev,
964 rc = switchtec_ntb_part_op(sndev, mmio_ctrl,
975 dev_dbg(&sndev->stdev->dev,
982 rc = switchtec_ntb_part_op(sndev, mmio_ctrl,
988 dev_err(&sndev->stdev->dev,
996 static int crosslink_setup_mws(struct switchtec_ntb *sndev, int ntb_lut_idx,
1000 struct ntb_ctrl_regs __iomem *ctl = sndev->mmio_self_ctrl;
1007 rc = switchtec_ntb_part_op(sndev, ctl, NTB_CTRL_PART_OP_LOCK,
1012 for (i = 0; i < sndev->nr_lut_mw; i++) {
1018 iowrite64((NTB_CTRL_LUT_EN | (sndev->peer_partition << 1) |
1023 sndev->nr_direct_mw = min_t(int, sndev->nr_direct_mw, mw_count);
1025 for (i = 0; i < sndev->nr_direct_mw; i++) {
1026 bar = sndev->direct_mw_to_bar[i];
1027 offset = (i == 0) ? LUT_SIZE * sndev->nr_lut_mw : 0;
1029 size = pci_resource_len(sndev->ntb.pdev, bar) - offset;
1042 iowrite64(sndev->peer_partition | addr,
1046 rc = switchtec_ntb_part_op(sndev, ctl, NTB_CTRL_PART_OP_CFG,
1053 dev_err(&sndev->stdev->dev,
1062 static int crosslink_setup_req_ids(struct switchtec_ntb *sndev,
1070 proxy_id = ioread32(&sndev->mmio_self_ctrl->req_id_table[i]);
1078 return config_req_id_table(sndev, mmio_ctrl, req_ids, i);
1086 static int crosslink_enum_partition(struct switchtec_ntb *sndev,
1090 &sndev->stdev->mmio_part_cfg_all[sndev->peer_partition];
1093 &sndev->stdev->mmio_pff_csr[pff];
1106 dev_dbg(&sndev->stdev->dev,
1119 static int switchtec_ntb_init_crosslink(struct switchtec_ntb *sndev)
1122 int bar = sndev->direct_mw_to_bar[0];
1129 if (!crosslink_is_enabled(sndev))
1132 dev_info(&sndev->stdev->dev, "Using crosslink configuration\n");
1133 sndev->ntb.topo = NTB_TOPO_CROSSLINK;
1135 bar_cnt = crosslink_enum_partition(sndev, bar_addrs);
1136 if (bar_cnt < sndev->nr_direct_mw + 1) {
1137 dev_err(&sndev->stdev->dev,
1144 sizeof(struct ntb_dbmsg_regs) * sndev->peer_partition);
1149 rc = config_rsvd_lut_win(sndev, sndev->mmio_self_ctrl, ntb_lut_idx,
1150 sndev->peer_partition, addr);
1154 rc = crosslink_setup_mws(sndev, ntb_lut_idx, &bar_addrs[1],
1159 rc = crosslink_setup_req_ids(sndev, sndev->mmio_peer_ctrl);
1163 sndev->mmio_xlink_win = pci_iomap_range(sndev->stdev->pdev, bar,
1165 if (!sndev->mmio_xlink_win) {
1170 sndev->mmio_peer_dbmsg = sndev->mmio_xlink_win + offset;
1171 sndev->nr_rsvd_luts++;
1173 crosslink_init_dbmsgs(sndev);
1178 static void switchtec_ntb_deinit_crosslink(struct switchtec_ntb *sndev)
1180 if (sndev->mmio_xlink_win)
1181 pci_iounmap(sndev->stdev->pdev, sndev->mmio_xlink_win);
1199 static void switchtec_ntb_init_mw(struct switchtec_ntb *sndev)
1201 sndev->nr_direct_mw = map_bars(sndev->direct_mw_to_bar,
1202 sndev->mmio_self_ctrl);
1204 sndev->nr_lut_mw = ioread16(&sndev->mmio_self_ctrl->lut_table_entries);
1205 sndev->nr_lut_mw = rounddown_pow_of_two(sndev->nr_lut_mw);
1207 dev_dbg(&sndev->stdev->dev, "MWs: %d direct, %d lut\n",
1208 sndev->nr_direct_mw, sndev->nr_lut_mw);
1210 sndev->peer_nr_direct_mw = map_bars(sndev->peer_direct_mw_to_bar,
1211 sndev->mmio_peer_ctrl);
1213 sndev->peer_nr_lut_mw =
1214 ioread16(&sndev->mmio_peer_ctrl->lut_table_entries);
1215 sndev->peer_nr_lut_mw = rounddown_pow_of_two(sndev->peer_nr_lut_mw);
1217 dev_dbg(&sndev->stdev->dev, "Peer MWs: %d direct, %d lut\n",
1218 sndev->peer_nr_direct_mw, sndev->peer_nr_lut_mw);
1232 static void switchtec_ntb_init_db(struct switchtec_ntb *sndev)
1234 sndev->db_mask = 0x0FFFFFFFFFFFFFFFULL;
1236 if (sndev->mmio_peer_dbmsg != sndev->mmio_self_dbmsg) {
1237 sndev->db_shift = 0;
1238 sndev->db_peer_shift = 0;
1239 sndev->db_valid_mask = sndev->db_mask;
1240 } else if (sndev->self_partition < sndev->peer_partition) {
1241 sndev->db_shift = 0;
1242 sndev->db_peer_shift = 32;
1243 sndev->db_valid_mask = 0x0FFFFFFF;
1245 sndev->db_shift = 32;
1246 sndev->db_peer_shift = 0;
1247 sndev->db_valid_mask = 0x0FFFFFFF;
1250 iowrite64(~sndev->db_mask, &sndev->mmio_self_dbmsg->idb_mask);
1251 iowrite64(sndev->db_valid_mask << sndev->db_peer_shift,
1252 &sndev->mmio_peer_dbmsg->odb_mask);
1254 dev_dbg(&sndev->stdev->dev, "dbs: shift %d/%d, mask %016llx\n",
1255 sndev->db_shift, sndev->db_peer_shift, sndev->db_valid_mask);
1258 static void switchtec_ntb_init_msgs(struct switchtec_ntb *sndev)
1263 for (i = 0; i < ARRAY_SIZE(sndev->mmio_self_dbmsg->imsg); i++) {
1264 int m = i | sndev->peer_partition << 2;
1269 iowrite32(msg_map, &sndev->mmio_self_dbmsg->msg_map);
1271 for (i = 0; i < ARRAY_SIZE(sndev->mmio_self_dbmsg->imsg); i++)
1273 &sndev->mmio_self_dbmsg->imsg[i]);
1277 switchtec_ntb_init_req_id_table(struct switchtec_ntb *sndev)
1289 req_ids[1] = ioread16(&sndev->mmio_ntb->requester_id);
1291 return config_req_id_table(sndev, sndev->mmio_self_ctrl, req_ids,
1295 static void switchtec_ntb_init_shared(struct switchtec_ntb *sndev)
1299 memset(sndev->self_shared, 0, LUT_SIZE);
1300 sndev->self_shared->magic = SWITCHTEC_NTB_MAGIC;
1301 sndev->self_shared->partition_id = sndev->stdev->partition;
1303 for (i = 0; i < sndev->nr_direct_mw; i++) {
1304 int bar = sndev->direct_mw_to_bar[i];
1305 resource_size_t sz = pci_resource_len(sndev->stdev->pdev, bar);
1309 LUT_SIZE * sndev->nr_lut_mw);
1311 sndev->self_shared->mw_sizes[i] = sz;
1314 for (i = 0; i < sndev->nr_lut_mw; i++) {
1315 int idx = sndev->nr_direct_mw + i;
1317 sndev->self_shared->mw_sizes[idx] = LUT_SIZE;
1321 static int switchtec_ntb_init_shared_mw(struct switchtec_ntb *sndev)
1323 int self_bar = sndev->direct_mw_to_bar[0];
1326 sndev->nr_rsvd_luts++;
1327 sndev->self_shared = dma_alloc_coherent(&sndev->stdev->pdev->dev,
1329 &sndev->self_shared_dma,
1331 if (!sndev->self_shared) {
1332 dev_err(&sndev->stdev->dev,
1337 switchtec_ntb_init_shared(sndev);
1339 rc = config_rsvd_lut_win(sndev, sndev->mmio_peer_ctrl, 0,
1340 sndev->self_partition,
1341 sndev->self_shared_dma);
1345 sndev->peer_shared = pci_iomap(sndev->stdev->pdev, self_bar, LUT_SIZE);
1346 if (!sndev->peer_shared) {
1351 dev_dbg(&sndev->stdev->dev, "Shared MW Ready\n");
1355 dma_free_coherent(&sndev->stdev->pdev->dev, LUT_SIZE,
1356 sndev->self_shared, sndev->self_shared_dma);
1361 static void switchtec_ntb_deinit_shared_mw(struct switchtec_ntb *sndev)
1363 if (sndev->peer_shared)
1364 pci_iounmap(sndev->stdev->pdev, sndev->peer_shared);
1366 if (sndev->self_shared)
1367 dma_free_coherent(&sndev->stdev->pdev->dev, LUT_SIZE,
1368 sndev->self_shared,
1369 sndev->self_shared_dma);
1370 sndev->nr_rsvd_luts--;
1375 struct switchtec_ntb *sndev = dev;
1377 dev_dbg(&sndev->stdev->dev, "doorbell\n");
1379 ntb_db_event(&sndev->ntb, 0);
1387 struct switchtec_ntb *sndev = dev;
1389 for (i = 0; i < ARRAY_SIZE(sndev->mmio_self_dbmsg->imsg); i++) {
1390 u64 msg = ioread64(&sndev->mmio_self_dbmsg->imsg[i]);
1393 dev_dbg(&sndev->stdev->dev, "message: %d %08x\n",
1395 iowrite8(1, &sndev->mmio_self_dbmsg->imsg[i].status);
1398 switchtec_ntb_check_link(sndev, msg);
1405 static int switchtec_ntb_init_db_msg_irq(struct switchtec_ntb *sndev)
1412 int idb_vecs = sizeof(sndev->mmio_self_dbmsg->idb_vec_map);
1414 event_irq = ioread32(&sndev->stdev->mmio_part_cfg->vep_vector_number);
1422 dev_dbg(&sndev->stdev->dev, "irqs - event: %d, db: %d, msgs: %d\n",
1427 &sndev->mmio_self_dbmsg->idb_vec_map[i]);
1431 &sndev->mmio_self_dbmsg->idb_vec_map[i]);
1433 sndev->doorbell_irq = pci_irq_vector(sndev->stdev->pdev, doorbell_irq);
1434 sndev->message_irq = pci_irq_vector(sndev->stdev->pdev, message_irq);
1436 rc = request_irq(sndev->doorbell_irq,
1438 "switchtec_ntb_doorbell", sndev);
1442 rc = request_irq(sndev->message_irq,
1444 "switchtec_ntb_message", sndev);
1446 free_irq(sndev->doorbell_irq, sndev);
1453 static void switchtec_ntb_deinit_db_msg_irq(struct switchtec_ntb *sndev)
1455 free_irq(sndev->doorbell_irq, sndev);
1456 free_irq(sndev->message_irq, sndev);
1459 static int switchtec_ntb_reinit_peer(struct switchtec_ntb *sndev)
1463 if (crosslink_is_enabled(sndev))
1466 dev_info(&sndev->stdev->dev, "reinitialize shared memory window\n");
1467 rc = config_rsvd_lut_win(sndev, sndev->mmio_peer_ctrl, 0,
1468 sndev->self_partition,
1469 sndev->self_shared_dma);
1476 struct switchtec_ntb *sndev;
1479 stdev->sndev = NULL;
1484 sndev = kzalloc_node(sizeof(*sndev), GFP_KERNEL, dev_to_node(dev));
1485 if (!sndev)
1488 sndev->stdev = stdev;
1489 rc = switchtec_ntb_init_sndev(sndev);
1493 switchtec_ntb_init_mw(sndev);
1495 rc = switchtec_ntb_init_req_id_table(sndev);
1499 rc = switchtec_ntb_init_crosslink(sndev);
1503 switchtec_ntb_init_db(sndev);
1504 switchtec_ntb_init_msgs(sndev);
1506 rc = switchtec_ntb_init_shared_mw(sndev);
1510 rc = switchtec_ntb_init_db_msg_irq(sndev);
1519 switchtec_ntb_send_msg(sndev, LINK_MESSAGE, MSG_LINK_FORCE_DOWN);
1521 rc = ntb_register_device(&sndev->ntb);
1525 stdev->sndev = sndev;
1532 switchtec_ntb_deinit_db_msg_irq(sndev);
1534 switchtec_ntb_deinit_shared_mw(sndev);
1536 switchtec_ntb_deinit_crosslink(sndev);
1538 kfree(sndev);
1546 struct switchtec_ntb *sndev = stdev->sndev;
1548 if (!sndev)
1552 stdev->sndev = NULL;
1553 ntb_unregister_device(&sndev->ntb);
1554 switchtec_ntb_deinit_db_msg_irq(sndev);
1555 switchtec_ntb_deinit_shared_mw(sndev);
1556 switchtec_ntb_deinit_crosslink(sndev);
1557 kfree(sndev);