sense.c revision 219820
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 41static 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 63void 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 104static 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 122sense_again: 123 mutex_unlock(&priv->port_mutex); 124 if (sense->resched) 125 queue_delayed_work(sense->sense_wq , &sense->sense_poll, 126 round_jiffies(MLX4_SENSE_RANGE)); 127} 128 129void 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 sense->resched = 1; 138 queue_delayed_work(sense->sense_wq , &sense->sense_poll, 139 round_jiffies(MLX4_SENSE_RANGE)); 140} 141 142 143void mlx4_stop_sense(struct mlx4_dev *dev) 144{ 145 mlx4_priv(dev)->sense.resched = 0; 146} 147 148int mlx4_sense_init(struct mlx4_dev *dev) 149{ 150 struct mlx4_priv *priv = mlx4_priv(dev); 151 struct mlx4_sense *sense = &priv->sense; 152 int port; 153 154 sense->dev = dev; 155 sense->sense_wq = create_singlethread_workqueue("mlx4_sense"); 156 if (!sense->sense_wq) 157 return -ENOMEM; 158 159 for (port = 1; port <= dev->caps.num_ports; port++) 160 sense->do_sense_port[port] = 1; 161 162 INIT_DELAYED_WORK_DEFERRABLE(&sense->sense_poll, mlx4_sense_port); 163 return 0; 164} 165 166void mlx4_sense_cleanup(struct mlx4_dev *dev) 167{ 168 mlx4_stop_sense(dev); 169 cancel_delayed_work(&mlx4_priv(dev)->sense.sense_poll); 170 destroy_workqueue(mlx4_priv(dev)->sense.sense_wq); 171} 172 173