[media] imon: Correct call to input_free_device
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / misc / ibmasm / lowlevel.c
blob4b2398e27fd5bf202efa349db4bc4bd4a3e1f899
1 /*
2 * IBM ASM Service Processor Device Driver
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
18 * Copyright (C) IBM Corporation, 2004
20 * Author: Max Asböck <amax@us.ibm.com>
24 #include "ibmasm.h"
25 #include "lowlevel.h"
26 #include "i2o.h"
27 #include "dot_command.h"
28 #include "remote.h"
30 static struct i2o_header header = I2O_HEADER_TEMPLATE;
33 int ibmasm_send_i2o_message(struct service_processor *sp)
35 u32 mfa;
36 unsigned int command_size;
37 struct i2o_message *message;
38 struct command *command = sp->current_command;
40 mfa = get_mfa_inbound(sp->base_address);
41 if (!mfa)
42 return 1;
44 command_size = get_dot_command_size(command->buffer);
45 header.message_size = outgoing_message_size(command_size);
47 message = get_i2o_message(sp->base_address, mfa);
49 memcpy_toio(&message->header, &header, sizeof(struct i2o_header));
50 memcpy_toio(&message->data, command->buffer, command_size);
52 set_mfa_inbound(sp->base_address, mfa);
54 return 0;
57 irqreturn_t ibmasm_interrupt_handler(int irq, void * dev_id)
59 u32 mfa;
60 struct service_processor *sp = (struct service_processor *)dev_id;
61 void __iomem *base_address = sp->base_address;
62 char tsbuf[32];
64 if (!sp_interrupt_pending(base_address))
65 return IRQ_NONE;
67 dbg("respond to interrupt at %s\n", get_timestamp(tsbuf));
69 if (mouse_interrupt_pending(sp)) {
70 ibmasm_handle_mouse_interrupt(sp);
71 clear_mouse_interrupt(sp);
74 mfa = get_mfa_outbound(base_address);
75 if (valid_mfa(mfa)) {
76 struct i2o_message *msg = get_i2o_message(base_address, mfa);
77 ibmasm_receive_message(sp, &msg->data, incoming_data_size(msg));
78 } else
79 dbg("didn't get a valid MFA\n");
81 set_mfa_outbound(base_address, mfa);
82 dbg("finished interrupt at %s\n", get_timestamp(tsbuf));
84 return IRQ_HANDLED;