1 /* 2 * Copyright (c) 2007 Mellanox Technologies. All rights reserved. 3 * 4 * This software is available to you under a choice of one of two 5 * licenses. You may choose to be licensed under the terms of the GNU 6 * General Public License (GPL) Version 2, available from the file 7 * COPYING in the main directory of this source tree, or the 8 * OpenIB.org BSD license below: 9 * 10 * Redistribution and use in source and binary forms, with or 11 * without modification, are permitted provided that the following 12 * conditions are met: 13 * 14 * - Redistributions of source code must retain the above 15 * copyright notice, this list of conditions and the following 16 * disclaimer. 17 * 18 * - Redistributions in binary form must reproduce the above 19 * copyright notice, this list of conditions and the following 20 * disclaimer in the documentation and/or other materials 21 * provided with the distribution. 22 * 23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 30 * SOFTWARE. 31 * 32 */ 33 34 #include <linux/errno.h> 35 #include <linux/if_ether.h> 36 37 #include <linux/mlx4/cmd.h> 38 39 #include "mlx4.h" 40 41 int mlx4_SENSE_PORT(struct mlx4_dev *dev, int port, 42 enum mlx4_port_type *type) 43 { 44 u64 out_param; 45 int err = 0; 46 47 err = mlx4_cmd_imm(dev, 0, &out_param, port, 0, 48 MLX4_CMD_SENSE_PORT, MLX4_CMD_TIME_CLASS_B, 49 MLX4_CMD_WRAPPED); 50 if (err) { 51 mlx4_err(dev, "Sense command failed for port: %d\n", port); 52 return err; 53 } 54 55 if (out_param > 2) { 56 mlx4_err(dev, "Sense returned illegal value: 0x%llx\n", out_param); 57 return -EINVAL; 58 } 59 60 *type = out_param; 61 return 0; 62 } 63 64 void mlx4_do_sense_ports(struct mlx4_dev *dev, 65 enum mlx4_port_type *stype, 66 enum mlx4_port_type *defaults) 67 { 68 struct mlx4_sense *sense = &mlx4_priv(dev)->sense; 69 int err; 70 int i; 71 72 for (i = 1; i <= dev->caps.num_ports; i++) { 73 stype[i - 1] = 0; 74 if (sense->do_sense_port[i] && sense->sense_allowed[i] && 75 dev->caps.possible_type[i] == MLX4_PORT_TYPE_AUTO) { 76 err = mlx4_SENSE_PORT(dev, i, &stype[i - 1]); 77 if (err) 78 stype[i - 1] = defaults[i - 1]; 79 } else 80 stype[i - 1] = defaults[i - 1]; 81 } 82 83 /* 84 * Adjust port configuration: 85 * If port 1 sensed nothing and port 2 is IB, set both as IB 86 * If port 2 sensed nothing and port 1 is Eth, set both as Eth 87 */ 88 if (stype[0] == MLX4_PORT_TYPE_ETH) { 89 for (i = 1; i < dev->caps.num_ports; i++) 90 stype[i] = stype[i] ? stype[i] : MLX4_PORT_TYPE_ETH; 91 } 92 if (stype[dev->caps.num_ports - 1] == MLX4_PORT_TYPE_IB) { 93 for (i = 0; i < dev->caps.num_ports - 1; i++) 94 stype[i] = stype[i] ? stype[i] : MLX4_PORT_TYPE_IB; 95 } 96 97 /* 98 * If sensed nothing, remain in current configuration. 99 */ 100 for (i = 0; i < dev->caps.num_ports; i++) 101 stype[i] = stype[i] ? stype[i] : defaults[i]; 102 103 } 104 105 static void mlx4_sense_port(struct work_struct *work) 106 { 107 struct delayed_work *delay = to_delayed_work(work); 108 struct mlx4_sense *sense = container_of(delay, struct mlx4_sense, 109 sense_poll); 110 struct mlx4_dev *dev = sense->dev; 111 struct mlx4_priv *priv = mlx4_priv(dev); 112 enum mlx4_port_type stype[MLX4_MAX_PORTS]; 113 114 mutex_lock(&priv->port_mutex); 115 mlx4_do_sense_ports(dev, stype, &dev->caps.port_type[1]); 116 117 if (mlx4_check_port_params(dev, stype)) 118 goto sense_again; 119 120 if (mlx4_change_port_types(dev, stype)) 121 mlx4_err(dev, "Failed to change port_types\n"); 122 123 sense_again: 124 mutex_unlock(&priv->port_mutex); 125 queue_delayed_work(mlx4_wq , &sense->sense_poll, 126 round_jiffies_relative(MLX4_SENSE_RANGE)); 127 } 128 129 void mlx4_start_sense(struct mlx4_dev *dev) 130 { 131 struct mlx4_priv *priv = mlx4_priv(dev); 132 struct mlx4_sense *sense = &priv->sense; 133 134 if (!(dev->caps.flags & MLX4_DEV_CAP_FLAG_DPDP)) 135 return; 136 137 queue_delayed_work(mlx4_wq , &sense->sense_poll, 138 round_jiffies_relative(MLX4_SENSE_RANGE)); 139 } 140 141 void mlx4_stop_sense(struct mlx4_dev *dev) 142 { 143 cancel_delayed_work_sync(&mlx4_priv(dev)->sense.sense_poll); 144 } 145 146 void mlx4_sense_init(struct mlx4_dev *dev) 147 { 148 struct mlx4_priv *priv = mlx4_priv(dev); 149 struct mlx4_sense *sense = &priv->sense; 150 int port; 151 152 sense->dev = dev; 153 for (port = 1; port <= dev->caps.num_ports; port++) 154 sense->do_sense_port[port] = 1; 155 156 INIT_DELAYED_WORK_DEFERRABLE(&sense->sense_poll, mlx4_sense_port); 157 } 158