]>
Commit | Line | Data |
---|---|---|
1a59d1b8 | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
1da177e4 LT |
2 | |
3 | /* | |
4 | * IBM ASM Service Processor Device Driver | |
5 | * | |
1da177e4 LT |
6 | * Copyright (C) IBM Corporation, 2004 |
7 | * | |
d36b6910 | 8 | * Author: Max Asböck <amax@us.ibm.com> |
1da177e4 LT |
9 | */ |
10 | ||
d43c36dc | 11 | #include <linux/sched.h> |
5a0e3ad6 | 12 | #include <linux/slab.h> |
1da177e4 | 13 | #include "ibmasm.h" |
88187605 | 14 | #include "lowlevel.h" |
1da177e4 LT |
15 | |
16 | static void exec_next_command(struct service_processor *sp); | |
1da177e4 | 17 | |
88187605 | 18 | static atomic_t command_count = ATOMIC_INIT(0); |
1da177e4 | 19 | |
88187605 | 20 | struct command *ibmasm_new_command(struct service_processor *sp, size_t buffer_size) |
1da177e4 LT |
21 | { |
22 | struct command *cmd; | |
23 | ||
24 | if (buffer_size > IBMASM_CMD_MAX_BUFFER_SIZE) | |
25 | return NULL; | |
26 | ||
dd00cc48 | 27 | cmd = kzalloc(sizeof(struct command), GFP_KERNEL); |
1da177e4 LT |
28 | if (cmd == NULL) |
29 | return NULL; | |
30 | ||
1da177e4 | 31 | |
dd00cc48 | 32 | cmd->buffer = kzalloc(buffer_size, GFP_KERNEL); |
1da177e4 LT |
33 | if (cmd->buffer == NULL) { |
34 | kfree(cmd); | |
35 | return NULL; | |
36 | } | |
1da177e4 LT |
37 | cmd->buffer_size = buffer_size; |
38 | ||
a045171f | 39 | kref_init(&cmd->kref); |
88187605 | 40 | cmd->lock = &sp->lock; |
1da177e4 LT |
41 | |
42 | cmd->status = IBMASM_CMD_PENDING; | |
43 | init_waitqueue_head(&cmd->wait); | |
44 | INIT_LIST_HEAD(&cmd->queue_node); | |
45 | ||
88187605 MA |
46 | atomic_inc(&command_count); |
47 | dbg("command count: %d\n", atomic_read(&command_count)); | |
48 | ||
1da177e4 LT |
49 | return cmd; |
50 | } | |
51 | ||
a045171f | 52 | void ibmasm_free_command(struct kref *kref) |
1da177e4 | 53 | { |
a045171f | 54 | struct command *cmd = to_command(kref); |
3110dc7a | 55 | |
1da177e4 | 56 | list_del(&cmd->queue_node); |
88187605 MA |
57 | atomic_dec(&command_count); |
58 | dbg("command count: %d\n", atomic_read(&command_count)); | |
1da177e4 LT |
59 | kfree(cmd->buffer); |
60 | kfree(cmd); | |
61 | } | |
62 | ||
63 | static void enqueue_command(struct service_processor *sp, struct command *cmd) | |
64 | { | |
65 | list_add_tail(&cmd->queue_node, &sp->command_queue); | |
66 | } | |
67 | ||
68 | static struct command *dequeue_command(struct service_processor *sp) | |
69 | { | |
70 | struct command *cmd; | |
71 | struct list_head *next; | |
72 | ||
73 | if (list_empty(&sp->command_queue)) | |
74 | return NULL; | |
75 | ||
76 | next = sp->command_queue.next; | |
77 | list_del_init(next); | |
78 | cmd = list_entry(next, struct command, queue_node); | |
79 | ||
80 | return cmd; | |
81 | } | |
82 | ||
83 | static inline void do_exec_command(struct service_processor *sp) | |
84 | { | |
88187605 MA |
85 | char tsbuf[32]; |
86 | ||
6e574195 | 87 | dbg("%s:%d at %s\n", __func__, __LINE__, get_timestamp(tsbuf)); |
88187605 | 88 | |
1da177e4 LT |
89 | if (ibmasm_send_i2o_message(sp)) { |
90 | sp->current_command->status = IBMASM_CMD_FAILED; | |
88187605 MA |
91 | wake_up(&sp->current_command->wait); |
92 | command_put(sp->current_command); | |
1da177e4 LT |
93 | exec_next_command(sp); |
94 | } | |
95 | } | |
3110dc7a | 96 | |
1da177e4 LT |
97 | /** |
98 | * exec_command | |
99 | * send a command to a service processor | |
100 | * Commands are executed sequentially. One command (sp->current_command) | |
101 | * is sent to the service processor. Once the interrupt handler gets a | |
102 | * message of type command_response, the message is copied into | |
3110dc7a | 103 | * the current commands buffer, |
1da177e4 LT |
104 | */ |
105 | void ibmasm_exec_command(struct service_processor *sp, struct command *cmd) | |
106 | { | |
107 | unsigned long flags; | |
88187605 MA |
108 | char tsbuf[32]; |
109 | ||
6e574195 | 110 | dbg("%s:%d at %s\n", __func__, __LINE__, get_timestamp(tsbuf)); |
1da177e4 LT |
111 | |
112 | spin_lock_irqsave(&sp->lock, flags); | |
113 | ||
114 | if (!sp->current_command) { | |
1da177e4 | 115 | sp->current_command = cmd; |
88187605 | 116 | command_get(sp->current_command); |
1da177e4 | 117 | spin_unlock_irqrestore(&sp->lock, flags); |
1da177e4 LT |
118 | do_exec_command(sp); |
119 | } else { | |
120 | enqueue_command(sp, cmd); | |
121 | spin_unlock_irqrestore(&sp->lock, flags); | |
122 | } | |
123 | } | |
124 | ||
125 | static void exec_next_command(struct service_processor *sp) | |
126 | { | |
127 | unsigned long flags; | |
88187605 | 128 | char tsbuf[32]; |
1da177e4 | 129 | |
6e574195 | 130 | dbg("%s:%d at %s\n", __func__, __LINE__, get_timestamp(tsbuf)); |
1da177e4 LT |
131 | |
132 | spin_lock_irqsave(&sp->lock, flags); | |
133 | sp->current_command = dequeue_command(sp); | |
134 | if (sp->current_command) { | |
135 | command_get(sp->current_command); | |
136 | spin_unlock_irqrestore(&sp->lock, flags); | |
137 | do_exec_command(sp); | |
138 | } else { | |
139 | spin_unlock_irqrestore(&sp->lock, flags); | |
140 | } | |
141 | } | |
142 | ||
3110dc7a | 143 | /** |
1da177e4 LT |
144 | * Sleep until a command has failed or a response has been received |
145 | * and the command status been updated by the interrupt handler. | |
146 | * (see receive_response). | |
147 | */ | |
148 | void ibmasm_wait_for_response(struct command *cmd, int timeout) | |
149 | { | |
150 | wait_event_interruptible_timeout(cmd->wait, | |
151 | cmd->status == IBMASM_CMD_COMPLETE || | |
152 | cmd->status == IBMASM_CMD_FAILED, | |
153 | timeout * HZ); | |
154 | } | |
155 | ||
156 | /** | |
157 | * receive_command_response | |
158 | * called by the interrupt handler when a dot command of type command_response | |
159 | * was received. | |
160 | */ | |
161 | void ibmasm_receive_command_response(struct service_processor *sp, void *response, size_t size) | |
162 | { | |
163 | struct command *cmd = sp->current_command; | |
164 | ||
3110dc7a DT |
165 | if (!sp->current_command) |
166 | return; | |
1da177e4 | 167 | |
88187605 | 168 | memcpy_fromio(cmd->buffer, response, min(size, cmd->buffer_size)); |
1da177e4 | 169 | cmd->status = IBMASM_CMD_COMPLETE; |
88187605 MA |
170 | wake_up(&sp->current_command->wait); |
171 | command_put(sp->current_command); | |
1da177e4 LT |
172 | exec_next_command(sp); |
173 | } |