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 if (err) { 50 mlx4_err(dev, "Sense command failed for port: %d\n", port); 51 return err; 52 } 53 54 if (out_param > 2) { 55 mlx4_err(dev, "Sense returned illegal value: 0x%llx\n", out_param); 56 return -EINVAL; 57 } 58 59 *type = out_param; 60 return 0; 61 } 62 63 void mlx4_do_sense_ports(struct mlx4_dev *dev, 64 enum mlx4_port_type *stype, 65 enum mlx4_port_type *defaults) 66 { 67 struct mlx4_sense *sense = &mlx4_priv(dev)->sense; 68 int err; 69 int i; 70 71 for (i = 1; i <= dev->caps.num_ports; i++) { 72 stype[i - 1] = 0; 73 if (sense->do_sense_port[i] && sense->sense_allowed[i] && 74 dev->caps.possible_type[i] == MLX4_PORT_TYPE_AUTO) { 75 err = mlx4_SENSE_PORT(dev, i, &stype[i - 1]); 76 if (err) 77 stype[i - 1] = defaults[i - 1]; 78 } else 79 stype[i - 1] = defaults[i - 1]; 80 } 81 82 /* 83 * Adjust port configuration: 84 * If port 1 sensed nothing and port 2 is IB, set both as IB 85 * If port 2 sensed nothing and port 1 is Eth, set both as Eth 86 */ 87 if (stype[0] == MLX4_PORT_TYPE_ETH) { 88 for (i = 1; i < dev->caps.num_ports; i++) 89 stype[i] = stype[i] ? stype[i] : MLX4_PORT_TYPE_ETH; 90 } 91 if (stype[dev->caps.num_ports - 1] == MLX4_PORT_TYPE_IB) { 92 for (i = 0; i < dev->caps.num_ports - 1; i++) 93 stype[i] = stype[i] ? stype[i] : MLX4_PORT_TYPE_IB; 94 } 95 96 /* 97 * If sensed nothing, remain in current configuration. 98 */ 99 for (i = 0; i < dev->caps.num_ports; i++) 100 stype[i] = stype[i] ? stype[i] : defaults[i]; 101 102 } 103 104 static void mlx4_sense_port(struct work_struct *work) 105 { 106 struct delayed_work *delay = to_delayed_work(work); 107 struct mlx4_sense *sense = container_of(delay, struct mlx4_sense, 108 sense_poll); 109 struct mlx4_dev *dev = sense->dev; 110 struct mlx4_priv *priv = mlx4_priv(dev); 111 enum mlx4_port_type stype[MLX4_MAX_PORTS]; 112 113 mutex_lock(&priv->port_mutex); 114 mlx4_do_sense_ports(dev, stype, &dev->caps.port_type[1]); 115 116 if (mlx4_check_port_params(dev, stype)) 117 goto sense_again; 118 119 if (mlx4_change_port_types(dev, stype)) 120 mlx4_err(dev, "Failed to change port_types\n"); 121 122 sense_again: 123 mutex_unlock(&priv->port_mutex); 124 queue_delayed_work(mlx4_wq , &sense->sense_poll, 125 round_jiffies_relative(MLX4_SENSE_RANGE)); 126 } 127 128 void mlx4_start_sense(struct mlx4_dev *dev) 129 { 130 struct mlx4_priv *priv = mlx4_priv(dev); 131 struct mlx4_sense *sense = &priv->sense; 132 133 if (!(dev->caps.flags & MLX4_DEV_CAP_FLAG_DPDP)) 134 return; 135 136 queue_delayed_work(mlx4_wq , &sense->sense_poll, 137 round_jiffies_relative(MLX4_SENSE_RANGE)); 138 } 139 140 void mlx4_stop_sense(struct mlx4_dev *dev) 141 { 142 cancel_delayed_work_sync(&mlx4_priv(dev)->sense.sense_poll); 143 } 144 145 void mlx4_sense_init(struct mlx4_dev *dev) 146 { 147 struct mlx4_priv *priv = mlx4_priv(dev); 148 struct mlx4_sense *sense = &priv->sense; 149 int port; 150 151 sense->dev = dev; 152 for (port = 1; port <= dev->caps.num_ports; port++) 153 sense->do_sense_port[port] = 1; 154 155 INIT_DELAYED_WORK_DEFERRABLE(&sense->sense_poll, mlx4_sense_port); 156 } 157