diff options
| author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
|---|---|---|
| committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
| commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
| tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/misc/ibmasm/command.c | |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/misc/ibmasm/command.c')
| -rw-r--r-- | drivers/misc/ibmasm/command.c | 175 |
1 files changed, 175 insertions, 0 deletions
diff --git a/drivers/misc/ibmasm/command.c b/drivers/misc/ibmasm/command.c new file mode 100644 index 000000000000..245b0058381d --- /dev/null +++ b/drivers/misc/ibmasm/command.c | |||
| @@ -0,0 +1,175 @@ | |||
| 1 | |||
| 2 | /* | ||
| 3 | * IBM ASM Service Processor Device Driver | ||
| 4 | * | ||
| 5 | * This program is free software; you can redistribute it and/or modify | ||
| 6 | * it under the terms of the GNU General Public License as published by | ||
| 7 | * the Free Software Foundation; either version 2 of the License, or | ||
| 8 | * (at your option) any later version. | ||
| 9 | * | ||
| 10 | * This program is distributed in the hope that it will be useful, | ||
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 13 | * GNU General Public License for more details. | ||
| 14 | * | ||
| 15 | * You should have received a copy of the GNU General Public License | ||
| 16 | * along with this program; if not, write to the Free Software | ||
| 17 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
| 18 | * | ||
| 19 | * Copyright (C) IBM Corporation, 2004 | ||
| 20 | * | ||
| 21 | * Author: Max Asböck <amax@us.ibm.com> | ||
| 22 | * | ||
| 23 | */ | ||
| 24 | |||
| 25 | #include "ibmasm.h" | ||
| 26 | |||
| 27 | static void exec_next_command(struct service_processor *sp); | ||
| 28 | static void free_command(struct kobject *kobj); | ||
| 29 | |||
| 30 | static struct kobj_type ibmasm_cmd_kobj_type = { | ||
| 31 | .release = free_command, | ||
| 32 | }; | ||
| 33 | |||
| 34 | |||
| 35 | struct command *ibmasm_new_command(size_t buffer_size) | ||
| 36 | { | ||
| 37 | struct command *cmd; | ||
| 38 | |||
| 39 | if (buffer_size > IBMASM_CMD_MAX_BUFFER_SIZE) | ||
| 40 | return NULL; | ||
| 41 | |||
| 42 | cmd = kmalloc(sizeof(struct command), GFP_KERNEL); | ||
| 43 | if (cmd == NULL) | ||
| 44 | return NULL; | ||
| 45 | |||
| 46 | memset(cmd, 0, sizeof(*cmd)); | ||
| 47 | |||
| 48 | cmd->buffer = kmalloc(buffer_size, GFP_KERNEL); | ||
| 49 | if (cmd->buffer == NULL) { | ||
| 50 | kfree(cmd); | ||
| 51 | return NULL; | ||
| 52 | } | ||
| 53 | memset(cmd->buffer, 0, buffer_size); | ||
| 54 | cmd->buffer_size = buffer_size; | ||
| 55 | |||
| 56 | kobject_init(&cmd->kobj); | ||
| 57 | cmd->kobj.ktype = &ibmasm_cmd_kobj_type; | ||
| 58 | |||
| 59 | cmd->status = IBMASM_CMD_PENDING; | ||
| 60 | init_waitqueue_head(&cmd->wait); | ||
| 61 | INIT_LIST_HEAD(&cmd->queue_node); | ||
| 62 | |||
| 63 | return cmd; | ||
| 64 | } | ||
| 65 | |||
| 66 | static void free_command(struct kobject *kobj) | ||
| 67 | { | ||
| 68 | struct command *cmd = to_command(kobj); | ||
| 69 | |||
| 70 | list_del(&cmd->queue_node); | ||
| 71 | kfree(cmd->buffer); | ||
| 72 | kfree(cmd); | ||
| 73 | } | ||
| 74 | |||
| 75 | static void enqueue_command(struct service_processor *sp, struct command *cmd) | ||
| 76 | { | ||
| 77 | list_add_tail(&cmd->queue_node, &sp->command_queue); | ||
| 78 | } | ||
| 79 | |||
| 80 | static struct command *dequeue_command(struct service_processor *sp) | ||
| 81 | { | ||
| 82 | struct command *cmd; | ||
| 83 | struct list_head *next; | ||
| 84 | |||
| 85 | if (list_empty(&sp->command_queue)) | ||
| 86 | return NULL; | ||
| 87 | |||
| 88 | next = sp->command_queue.next; | ||
| 89 | list_del_init(next); | ||
| 90 | cmd = list_entry(next, struct command, queue_node); | ||
| 91 | |||
| 92 | return cmd; | ||
| 93 | } | ||
| 94 | |||
| 95 | static inline void do_exec_command(struct service_processor *sp) | ||
| 96 | { | ||
| 97 | if (ibmasm_send_i2o_message(sp)) { | ||
| 98 | sp->current_command->status = IBMASM_CMD_FAILED; | ||
| 99 | exec_next_command(sp); | ||
| 100 | } | ||
| 101 | } | ||
| 102 | |||
| 103 | /** | ||
| 104 | * exec_command | ||
| 105 | * send a command to a service processor | ||
| 106 | * Commands are executed sequentially. One command (sp->current_command) | ||
| 107 | * is sent to the service processor. Once the interrupt handler gets a | ||
| 108 | * message of type command_response, the message is copied into | ||
| 109 | * the current commands buffer, | ||
| 110 | */ | ||
| 111 | void ibmasm_exec_command(struct service_processor *sp, struct command *cmd) | ||
| 112 | { | ||
| 113 | unsigned long flags; | ||
| 114 | |||
| 115 | spin_lock_irqsave(&sp->lock, flags); | ||
| 116 | |||
| 117 | if (!sp->current_command) { | ||
| 118 | command_get(cmd); | ||
| 119 | sp->current_command = cmd; | ||
| 120 | spin_unlock_irqrestore(&sp->lock, flags); | ||
| 121 | |||
| 122 | do_exec_command(sp); | ||
| 123 | } else { | ||
| 124 | enqueue_command(sp, cmd); | ||
| 125 | spin_unlock_irqrestore(&sp->lock, flags); | ||
| 126 | } | ||
| 127 | } | ||
| 128 | |||
| 129 | static void exec_next_command(struct service_processor *sp) | ||
| 130 | { | ||
| 131 | unsigned long flags; | ||
| 132 | |||
| 133 | wake_up(&sp->current_command->wait); | ||
| 134 | command_put(sp->current_command); | ||
| 135 | |||
| 136 | spin_lock_irqsave(&sp->lock, flags); | ||
| 137 | sp->current_command = dequeue_command(sp); | ||
| 138 | if (sp->current_command) { | ||
| 139 | command_get(sp->current_command); | ||
| 140 | spin_unlock_irqrestore(&sp->lock, flags); | ||
| 141 | do_exec_command(sp); | ||
| 142 | } else { | ||
| 143 | spin_unlock_irqrestore(&sp->lock, flags); | ||
| 144 | } | ||
| 145 | } | ||
| 146 | |||
| 147 | /** | ||
| 148 | * Sleep until a command has failed or a response has been received | ||
| 149 | * and the command status been updated by the interrupt handler. | ||
| 150 | * (see receive_response). | ||
| 151 | */ | ||
| 152 | void ibmasm_wait_for_response(struct command *cmd, int timeout) | ||
| 153 | { | ||
| 154 | wait_event_interruptible_timeout(cmd->wait, | ||
| 155 | cmd->status == IBMASM_CMD_COMPLETE || | ||
| 156 | cmd->status == IBMASM_CMD_FAILED, | ||
| 157 | timeout * HZ); | ||
| 158 | } | ||
| 159 | |||
| 160 | /** | ||
| 161 | * receive_command_response | ||
| 162 | * called by the interrupt handler when a dot command of type command_response | ||
| 163 | * was received. | ||
| 164 | */ | ||
| 165 | void ibmasm_receive_command_response(struct service_processor *sp, void *response, size_t size) | ||
| 166 | { | ||
| 167 | struct command *cmd = sp->current_command; | ||
| 168 | |||
| 169 | if (!sp->current_command) | ||
| 170 | return; | ||
| 171 | |||
| 172 | memcpy(cmd->buffer, response, min(size, cmd->buffer_size)); | ||
| 173 | cmd->status = IBMASM_CMD_COMPLETE; | ||
| 174 | exec_next_command(sp); | ||
| 175 | } | ||
