11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * IBM ASM Service Processor Device Driver 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or modify 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * it under the terms of the GNU General Public License as published by 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (at your option) any later version. 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is distributed in the hope that it will be useful, 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * GNU General Public License for more details. 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * You should have received a copy of the GNU General Public License 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * along with this program; if not, write to the Free Software 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) IBM Corporation, 2004 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 21d36b691077dc59c74efec0d54ed21b86f7a2a21aAl Viro * Author: Max Asböck <amax@us.ibm.com> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25d43c36dc6b357fa1806800f18aa30123c747a6d1Alexey Dobriyan#include <linux/sched.h> 265a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "ibmasm.h" 288818760512424f60ad9fafb7a087b007a9274eb3Max Asbock#include "lowlevel.h" 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void exec_next_command(struct service_processor *sp); 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 328818760512424f60ad9fafb7a087b007a9274eb3Max Asbockstatic atomic_t command_count = ATOMIC_INIT(0); 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 348818760512424f60ad9fafb7a087b007a9274eb3Max Asbockstruct command *ibmasm_new_command(struct service_processor *sp, size_t buffer_size) 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct command *cmd; 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (buffer_size > IBMASM_CMD_MAX_BUFFER_SIZE) 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 41dd00cc486ab1c17049a535413d1751ef3482141cYoann Padioleau cmd = kzalloc(sizeof(struct command), GFP_KERNEL); 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmd == NULL) 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 46dd00cc486ab1c17049a535413d1751ef3482141cYoann Padioleau cmd->buffer = kzalloc(buffer_size, GFP_KERNEL); 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmd->buffer == NULL) { 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(cmd); 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd->buffer_size = buffer_size; 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 53a045171f875cd61f690981a78ab98fbd137c938bGreg Kroah-Hartman kref_init(&cmd->kref); 548818760512424f60ad9fafb7a087b007a9274eb3Max Asbock cmd->lock = &sp->lock; 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd->status = IBMASM_CMD_PENDING; 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&cmd->wait); 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds INIT_LIST_HEAD(&cmd->queue_node); 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 608818760512424f60ad9fafb7a087b007a9274eb3Max Asbock atomic_inc(&command_count); 618818760512424f60ad9fafb7a087b007a9274eb3Max Asbock dbg("command count: %d\n", atomic_read(&command_count)); 628818760512424f60ad9fafb7a087b007a9274eb3Max Asbock 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return cmd; 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 66a045171f875cd61f690981a78ab98fbd137c938bGreg Kroah-Hartmanvoid ibmasm_free_command(struct kref *kref) 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 68a045171f875cd61f690981a78ab98fbd137c938bGreg Kroah-Hartman struct command *cmd = to_command(kref); 693110dc7a8660ea1617afac2a55e3d18ae6ce141bDmitry Torokhov 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del(&cmd->queue_node); 718818760512424f60ad9fafb7a087b007a9274eb3Max Asbock atomic_dec(&command_count); 728818760512424f60ad9fafb7a087b007a9274eb3Max Asbock dbg("command count: %d\n", atomic_read(&command_count)); 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(cmd->buffer); 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(cmd); 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void enqueue_command(struct service_processor *sp, struct command *cmd) 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add_tail(&cmd->queue_node, &sp->command_queue); 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct command *dequeue_command(struct service_processor *sp) 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct command *cmd; 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct list_head *next; 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (list_empty(&sp->command_queue)) 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = sp->command_queue.next; 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del_init(next); 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd = list_entry(next, struct command, queue_node); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return cmd; 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void do_exec_command(struct service_processor *sp) 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 998818760512424f60ad9fafb7a087b007a9274eb3Max Asbock char tsbuf[32]; 1008818760512424f60ad9fafb7a087b007a9274eb3Max Asbock 1016e574195b75543bc6a6240306313988b1952470cHarvey Harrison dbg("%s:%d at %s\n", __func__, __LINE__, get_timestamp(tsbuf)); 1028818760512424f60ad9fafb7a087b007a9274eb3Max Asbock 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ibmasm_send_i2o_message(sp)) { 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sp->current_command->status = IBMASM_CMD_FAILED; 1058818760512424f60ad9fafb7a087b007a9274eb3Max Asbock wake_up(&sp->current_command->wait); 1068818760512424f60ad9fafb7a087b007a9274eb3Max Asbock command_put(sp->current_command); 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds exec_next_command(sp); 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1103110dc7a8660ea1617afac2a55e3d18ae6ce141bDmitry Torokhov 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/** 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * exec_command 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * send a command to a service processor 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Commands are executed sequentially. One command (sp->current_command) 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is sent to the service processor. Once the interrupt handler gets a 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * message of type command_response, the message is copied into 1173110dc7a8660ea1617afac2a55e3d18ae6ce141bDmitry Torokhov * the current commands buffer, 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid ibmasm_exec_command(struct service_processor *sp, struct command *cmd) 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1228818760512424f60ad9fafb7a087b007a9274eb3Max Asbock char tsbuf[32]; 1238818760512424f60ad9fafb7a087b007a9274eb3Max Asbock 1246e574195b75543bc6a6240306313988b1952470cHarvey Harrison dbg("%s:%d at %s\n", __func__, __LINE__, get_timestamp(tsbuf)); 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&sp->lock, flags); 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sp->current_command) { 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sp->current_command = cmd; 1308818760512424f60ad9fafb7a087b007a9274eb3Max Asbock command_get(sp->current_command); 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&sp->lock, flags); 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_exec_command(sp); 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enqueue_command(sp, cmd); 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&sp->lock, flags); 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void exec_next_command(struct service_processor *sp) 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1428818760512424f60ad9fafb7a087b007a9274eb3Max Asbock char tsbuf[32]; 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1446e574195b75543bc6a6240306313988b1952470cHarvey Harrison dbg("%s:%d at %s\n", __func__, __LINE__, get_timestamp(tsbuf)); 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&sp->lock, flags); 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sp->current_command = dequeue_command(sp); 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sp->current_command) { 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds command_get(sp->current_command); 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&sp->lock, flags); 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_exec_command(sp); 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&sp->lock, flags); 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1573110dc7a8660ea1617afac2a55e3d18ae6ce141bDmitry Torokhov/** 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Sleep until a command has failed or a response has been received 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * and the command status been updated by the interrupt handler. 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (see receive_response). 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid ibmasm_wait_for_response(struct command *cmd, int timeout) 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wait_event_interruptible_timeout(cmd->wait, 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd->status == IBMASM_CMD_COMPLETE || 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd->status == IBMASM_CMD_FAILED, 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timeout * HZ); 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/** 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * receive_command_response 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called by the interrupt handler when a dot command of type command_response 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * was received. 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid ibmasm_receive_command_response(struct service_processor *sp, void *response, size_t size) 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct command *cmd = sp->current_command; 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1793110dc7a8660ea1617afac2a55e3d18ae6ce141bDmitry Torokhov if (!sp->current_command) 1803110dc7a8660ea1617afac2a55e3d18ae6ce141bDmitry Torokhov return; 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1828818760512424f60ad9fafb7a087b007a9274eb3Max Asbock memcpy_fromio(cmd->buffer, response, min(size, cmd->buffer_size)); 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd->status = IBMASM_CMD_COMPLETE; 1848818760512424f60ad9fafb7a087b007a9274eb3Max Asbock wake_up(&sp->current_command->wait); 1858818760512424f60ad9fafb7a087b007a9274eb3Max Asbock command_put(sp->current_command); 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds exec_next_command(sp); 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 188