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, in_param: 0, out_param: &out_param, in_modifier: port, op_modifier: 0, |
48 | op: MLX4_CMD_SENSE_PORT, timeout: MLX4_CMD_TIME_CLASS_B, |
49 | native: 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, port: i, type: &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 | * If sensed nothing, remain in current configuration. |
85 | */ |
86 | for (i = 0; i < dev->caps.num_ports; i++) |
87 | stype[i] = stype[i] ? stype[i] : defaults[i]; |
88 | |
89 | } |
90 | |
91 | static void mlx4_sense_port(struct work_struct *work) |
92 | { |
93 | struct delayed_work *delay = to_delayed_work(work); |
94 | struct mlx4_sense *sense = container_of(delay, struct mlx4_sense, |
95 | sense_poll); |
96 | struct mlx4_dev *dev = sense->dev; |
97 | struct mlx4_priv *priv = mlx4_priv(dev); |
98 | enum mlx4_port_type stype[MLX4_MAX_PORTS]; |
99 | |
100 | mutex_lock(&priv->port_mutex); |
101 | mlx4_do_sense_ports(dev, stype, defaults: &dev->caps.port_type[1]); |
102 | |
103 | if (mlx4_check_port_params(dev, port_type: stype)) |
104 | goto sense_again; |
105 | |
106 | if (mlx4_change_port_types(dev, port_types: stype)) |
107 | mlx4_err(dev, "Failed to change port_types\n" ); |
108 | |
109 | sense_again: |
110 | mutex_unlock(lock: &priv->port_mutex); |
111 | queue_delayed_work(wq: mlx4_wq , dwork: &sense->sense_poll, |
112 | delay: round_jiffies_relative(MLX4_SENSE_RANGE)); |
113 | } |
114 | |
115 | void mlx4_start_sense(struct mlx4_dev *dev) |
116 | { |
117 | struct mlx4_priv *priv = mlx4_priv(dev); |
118 | struct mlx4_sense *sense = &priv->sense; |
119 | |
120 | if (!(dev->caps.flags & MLX4_DEV_CAP_FLAG_DPDP)) |
121 | return; |
122 | |
123 | queue_delayed_work(wq: mlx4_wq , dwork: &sense->sense_poll, |
124 | delay: round_jiffies_relative(MLX4_SENSE_RANGE)); |
125 | } |
126 | |
127 | void mlx4_stop_sense(struct mlx4_dev *dev) |
128 | { |
129 | cancel_delayed_work_sync(dwork: &mlx4_priv(dev)->sense.sense_poll); |
130 | } |
131 | |
132 | void mlx4_sense_init(struct mlx4_dev *dev) |
133 | { |
134 | struct mlx4_priv *priv = mlx4_priv(dev); |
135 | struct mlx4_sense *sense = &priv->sense; |
136 | int port; |
137 | |
138 | sense->dev = dev; |
139 | for (port = 1; port <= dev->caps.num_ports; port++) |
140 | sense->do_sense_port[port] = 1; |
141 | |
142 | INIT_DEFERRABLE_WORK(&sense->sense_poll, mlx4_sense_port); |
143 | } |
144 | |