| // SPDX-License-Identifier: GPL-2.0+ | |
| /* | |
| * ipmi_msghandler.c | |
| * | |
| * Incoming and outgoing message routing for an IPMI interface. | |
| * | |
| * Author: MontaVista Software, Inc. | |
| * Corey Minyard <minyard@mvista.com> | |
| * source@mvista.com | |
| * | |
| * Copyright 2002 MontaVista Software Inc. | |
| */ | |
| #define pr_fmt(fmt) "IPMI message handler: " fmt | |
| #define dev_fmt(fmt) pr_fmt(fmt) | |
| #include <linux/module.h> | |
| #include <linux/errno.h> | |
| #include <linux/panic_notifier.h> | |
| #include <linux/poll.h> | |
| #include <linux/sched.h> | |
| #include <linux/seq_file.h> | |
| #include <linux/spinlock.h> | |
| #include <linux/mutex.h> | |
| #include <linux/slab.h> | |
| #include <linux/ipmi.h> | |
| #include <linux/ipmi_smi.h> | |
| #include <linux/notifier.h> | |
| #include <linux/init.h> | |
| #include <linux/proc_fs.h> | |
| #include <linux/rcupdate.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/moduleparam.h> | |
| #include <linux/workqueue.h> | |
| #include <linux/uuid.h> | |
| #include <linux/nospec.h> | |
| #include <linux/vmalloc.h> | |
| #include <linux/delay.h> | |
| #define IPMI_DRIVER_VERSION "39.2" | |
| static struct ipmi_recv_msg *ipmi_alloc_recv_msg(void); | |
| static int ipmi_init_msghandler(void); | |
| static void smi_recv_tasklet(struct tasklet_struct *t); | |
| static void handle_new_recv_msgs(struct ipmi_smi *intf); | |
| static void need_waiter(struct ipmi_smi *intf); | |
| static int handle_one_recv_msg(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg); | |
| static bool initialized; | |
| static bool drvregistered; | |
| /* Numbers in this enumerator should be mapped to ipmi_panic_event_str */ | |
| enum ipmi_panic_event_op { | |
| IPMI_SEND_PANIC_EVENT_NONE, | |
| IPMI_SEND_PANIC_EVENT, | |
| IPMI_SEND_PANIC_EVENT_STRING, | |
| IPMI_SEND_PANIC_EVENT_MAX | |
| }; | |
| /* Indices in this array should be mapped to enum ipmi_panic_event_op */ | |
| static const char *const ipmi_panic_event_str[] = { "none", "event", "string", NULL }; | |
| #ifdef CONFIG_IPMI_PANIC_STRING | |
| #define IPMI_PANIC_DEFAULT IPMI_SEND_PANIC_EVENT_STRING | |
| #elif defined(CONFIG_IPMI_PANIC_EVENT) | |
| #define IPMI_PANIC_DEFAULT IPMI_SEND_PANIC_EVENT | |
| #else | |
| #define IPMI_PANIC_DEFAULT IPMI_SEND_PANIC_EVENT_NONE | |
| #endif | |
| static enum ipmi_panic_event_op ipmi_send_panic_event = IPMI_PANIC_DEFAULT; | |
| static int panic_op_write_handler(const char *val, | |
| const struct kernel_param *kp) | |
| { | |
| char valcp[16]; | |
| int e; | |
| strscpy(valcp, val, sizeof(valcp)); | |
| e = match_string(ipmi_panic_event_str, -1, strstrip(valcp)); | |
| if (e < 0) | |
| return e; | |
| ipmi_send_panic_event = e; | |
| return 0; | |
| } | |
| static int panic_op_read_handler(char *buffer, const struct kernel_param *kp) | |
| { | |
| const char *event_str; | |
| if (ipmi_send_panic_event >= IPMI_SEND_PANIC_EVENT_MAX) | |
| event_str = "???"; | |
| else | |
| event_str = ipmi_panic_event_str[ipmi_send_panic_event]; | |
| return sprintf(buffer, "%s\n", event_str); | |
| } | |
| static const struct kernel_param_ops panic_op_ops = { | |
| .set = panic_op_write_handler, | |
| .get = panic_op_read_handler | |
| }; | |
| module_param_cb(panic_op, &panic_op_ops, NULL, 0600); | |
| MODULE_PARM_DESC(panic_op, "Sets if the IPMI driver will attempt to store panic information in the event log in the event of a panic. Set to 'none' for no, 'event' for a single event, or 'string' for a generic event and the panic string in IPMI OEM events."); | |
| #define MAX_EVENTS_IN_QUEUE 25 | |
| /* Remain in auto-maintenance mode for this amount of time (in ms). */ | |
| static unsigned long maintenance_mode_timeout_ms = 30000; | |
| module_param(maintenance_mode_timeout_ms, ulong, 0644); | |
| MODULE_PARM_DESC(maintenance_mode_timeout_ms, | |
| "The time (milliseconds) after the last maintenance message that the connection stays in maintenance mode."); | |
| /* | |
| * Don't let a message sit in a queue forever, always time it with at lest | |
| * the max message timer. This is in milliseconds. | |
| */ | |
| #define MAX_MSG_TIMEOUT 60000 | |
| /* | |
| * Timeout times below are in milliseconds, and are done off a 1 | |
| * second timer. So setting the value to 1000 would mean anything | |
| * between 0 and 1000ms. So really the only reasonable minimum | |
| * setting it 2000ms, which is between 1 and 2 seconds. | |
| */ | |
| /* The default timeout for message retries. */ | |
| static unsigned long default_retry_ms = 2000; | |
| module_param(default_retry_ms, ulong, 0644); | |
| MODULE_PARM_DESC(default_retry_ms, | |
| "The time (milliseconds) between retry sends"); | |
| /* The default timeout for maintenance mode message retries. */ | |
| static unsigned long default_maintenance_retry_ms = 3000; | |
| module_param(default_maintenance_retry_ms, ulong, 0644); | |
| MODULE_PARM_DESC(default_maintenance_retry_ms, | |
| "The time (milliseconds) between retry sends in maintenance mode"); | |
| /* The default maximum number of retries */ | |
| static unsigned int default_max_retries = 4; | |
| module_param(default_max_retries, uint, 0644); | |
| MODULE_PARM_DESC(default_max_retries, | |
| "The time (milliseconds) between retry sends in maintenance mode"); | |
| /* The default maximum number of users that may register. */ | |
| static unsigned int max_users = 30; | |
| module_param(max_users, uint, 0644); | |
| MODULE_PARM_DESC(max_users, | |
| "The most users that may use the IPMI stack at one time."); | |
| /* The default maximum number of message a user may have outstanding. */ | |
| static unsigned int max_msgs_per_user = 100; | |
| module_param(max_msgs_per_user, uint, 0644); | |
| MODULE_PARM_DESC(max_msgs_per_user, | |
| "The most message a user may have outstanding."); | |
| /* Call every ~1000 ms. */ | |
| #define IPMI_TIMEOUT_TIME 1000 | |
| /* How many jiffies does it take to get to the timeout time. */ | |
| #define IPMI_TIMEOUT_JIFFIES ((IPMI_TIMEOUT_TIME * HZ) / 1000) | |
| /* | |
| * Request events from the queue every second (this is the number of | |
| * IPMI_TIMEOUT_TIMES between event requests). Hopefully, in the | |
| * future, IPMI will add a way to know immediately if an event is in | |
| * the queue and this silliness can go away. | |
| */ | |
| #define IPMI_REQUEST_EV_TIME (1000 / (IPMI_TIMEOUT_TIME)) | |
| /* How long should we cache dynamic device IDs? */ | |
| #define IPMI_DYN_DEV_ID_EXPIRY (10 * HZ) | |
| /* | |
| * The main "user" data structure. | |
| */ | |
| struct ipmi_user { | |
| struct list_head link; | |
| /* | |
| * Set to NULL when the user is destroyed, a pointer to myself | |
| * so srcu_dereference can be used on it. | |
| */ | |
| struct ipmi_user *self; | |
| struct srcu_struct release_barrier; | |
| struct kref refcount; | |
| /* The upper layer that handles receive messages. */ | |
| const struct ipmi_user_hndl *handler; | |
| void *handler_data; | |
| /* The interface this user is bound to. */ | |
| struct ipmi_smi *intf; | |
| /* Does this interface receive IPMI events? */ | |
| bool gets_events; | |
| atomic_t nr_msgs; | |
| /* Free must run in process context for RCU cleanup. */ | |
| struct work_struct remove_work; | |
| }; | |
| static struct workqueue_struct *remove_work_wq; | |
| static struct ipmi_user *acquire_ipmi_user(struct ipmi_user *user, int *index) | |
| __acquires(user->release_barrier) | |
| { | |
| struct ipmi_user *ruser; | |
| *index = srcu_read_lock(&user->release_barrier); | |
| ruser = srcu_dereference(user->self, &user->release_barrier); | |
| if (!ruser) | |
| srcu_read_unlock(&user->release_barrier, *index); | |
| return ruser; | |
| } | |
| static void release_ipmi_user(struct ipmi_user *user, int index) | |
| { | |
| srcu_read_unlock(&user->release_barrier, index); | |
| } | |
| struct cmd_rcvr { | |
| struct list_head link; | |
| struct ipmi_user *user; | |
| unsigned char netfn; | |
| unsigned char cmd; | |
| unsigned int chans; | |
| /* | |
| * This is used to form a linked lised during mass deletion. | |
| * Since this is in an RCU list, we cannot use the link above | |
| * or change any data until the RCU period completes. So we | |
| * use this next variable during mass deletion so we can have | |
| * a list and don't have to wait and restart the search on | |
| * every individual deletion of a command. | |
| */ | |
| struct cmd_rcvr *next; | |
| }; | |
| struct seq_table { | |
| unsigned int inuse : 1; | |
| unsigned int broadcast : 1; | |
| unsigned long timeout; | |
| unsigned long orig_timeout; | |
| unsigned int retries_left; | |
| /* | |
| * To verify on an incoming send message response that this is | |
| * the message that the response is for, we keep a sequence id | |
| * and increment it every time we send a message. | |
| */ | |
| long seqid; | |
| /* | |
| * This is held so we can properly respond to the message on a | |
| * timeout, and it is used to hold the temporary data for | |
| * retransmission, too. | |
| */ | |
| struct ipmi_recv_msg *recv_msg; | |
| }; | |
| /* | |
| * Store the information in a msgid (long) to allow us to find a | |
| * sequence table entry from the msgid. | |
| */ | |
| #define STORE_SEQ_IN_MSGID(seq, seqid) \ | |
| ((((seq) & 0x3f) << 26) | ((seqid) & 0x3ffffff)) | |
| #define GET_SEQ_FROM_MSGID(msgid, seq, seqid) \ | |
| do { \ | |
| seq = (((msgid) >> 26) & 0x3f); \ | |
| seqid = ((msgid) & 0x3ffffff); \ | |
| } while (0) | |
| #define NEXT_SEQID(seqid) (((seqid) + 1) & 0x3ffffff) | |
| #define IPMI_MAX_CHANNELS 16 | |
| struct ipmi_channel { | |
| unsigned char medium; | |
| unsigned char protocol; | |
| }; | |
| struct ipmi_channel_set { | |
| struct ipmi_channel c[IPMI_MAX_CHANNELS]; | |
| }; | |
| struct ipmi_my_addrinfo { | |
| /* | |
| * My slave address. This is initialized to IPMI_BMC_SLAVE_ADDR, | |
| * but may be changed by the user. | |
| */ | |
| unsigned char address; | |
| /* | |
| * My LUN. This should generally stay the SMS LUN, but just in | |
| * case... | |
| */ | |
| unsigned char lun; | |
| }; | |
| /* | |
| * Note that the product id, manufacturer id, guid, and device id are | |
| * immutable in this structure, so dyn_mutex is not required for | |
| * accessing those. If those change on a BMC, a new BMC is allocated. | |
| */ | |
| struct bmc_device { | |
| struct platform_device pdev; | |
| struct list_head intfs; /* Interfaces on this BMC. */ | |
| struct ipmi_device_id id; | |
| struct ipmi_device_id fetch_id; | |
| int dyn_id_set; | |
| unsigned long dyn_id_expiry; | |
| struct mutex dyn_mutex; /* Protects id, intfs, & dyn* */ | |
| guid_t guid; | |
| guid_t fetch_guid; | |
| int dyn_guid_set; | |
| struct kref usecount; | |
| struct work_struct remove_work; | |
| unsigned char cc; /* completion code */ | |
| }; | |
| #define to_bmc_device(x) container_of((x), struct bmc_device, pdev.dev) | |
| static int bmc_get_device_id(struct ipmi_smi *intf, struct bmc_device *bmc, | |
| struct ipmi_device_id *id, | |
| bool *guid_set, guid_t *guid); | |
| /* | |
| * Various statistics for IPMI, these index stats[] in the ipmi_smi | |
| * structure. | |
| */ | |
| enum ipmi_stat_indexes { | |
| /* Commands we got from the user that were invalid. */ | |
| IPMI_STAT_sent_invalid_commands = 0, | |
| /* Commands we sent to the MC. */ | |
| IPMI_STAT_sent_local_commands, | |
| /* Responses from the MC that were delivered to a user. */ | |
| IPMI_STAT_handled_local_responses, | |
| /* Responses from the MC that were not delivered to a user. */ | |
| IPMI_STAT_unhandled_local_responses, | |
| /* Commands we sent out to the IPMB bus. */ | |
| IPMI_STAT_sent_ipmb_commands, | |
| /* Commands sent on the IPMB that had errors on the SEND CMD */ | |
| IPMI_STAT_sent_ipmb_command_errs, | |
| /* Each retransmit increments this count. */ | |
| IPMI_STAT_retransmitted_ipmb_commands, | |
| /* | |
| * When a message times out (runs out of retransmits) this is | |
| * incremented. | |
| */ | |
| IPMI_STAT_timed_out_ipmb_commands, | |
| /* | |
| * This is like above, but for broadcasts. Broadcasts are | |
| * *not* included in the above count (they are expected to | |
| * time out). | |
| */ | |
| IPMI_STAT_timed_out_ipmb_broadcasts, | |
| /* Responses I have sent to the IPMB bus. */ | |
| IPMI_STAT_sent_ipmb_responses, | |
| /* The response was delivered to the user. */ | |
| IPMI_STAT_handled_ipmb_responses, | |
| /* The response had invalid data in it. */ | |
| IPMI_STAT_invalid_ipmb_responses, | |
| /* The response didn't have anyone waiting for it. */ | |
| IPMI_STAT_unhandled_ipmb_responses, | |
| /* Commands we sent out to the IPMB bus. */ | |
| IPMI_STAT_sent_lan_commands, | |
| /* Commands sent on the IPMB that had errors on the SEND CMD */ | |
| IPMI_STAT_sent_lan_command_errs, | |
| /* Each retransmit increments this count. */ | |
| IPMI_STAT_retransmitted_lan_commands, | |
| /* | |
| * When a message times out (runs out of retransmits) this is | |
| * incremented. | |
| */ | |
| IPMI_STAT_timed_out_lan_commands, | |
| /* Responses I have sent to the IPMB bus. */ | |
| IPMI_STAT_sent_lan_responses, | |
| /* The response was delivered to the user. */ | |
| IPMI_STAT_handled_lan_responses, | |
| /* The response had invalid data in it. */ | |
| IPMI_STAT_invalid_lan_responses, | |
| /* The response didn't have anyone waiting for it. */ | |
| IPMI_STAT_unhandled_lan_responses, | |
| /* The command was delivered to the user. */ | |
| IPMI_STAT_handled_commands, | |
| /* The command had invalid data in it. */ | |
| IPMI_STAT_invalid_commands, | |
| /* The command didn't have anyone waiting for it. */ | |
| IPMI_STAT_unhandled_commands, | |
| /* Invalid data in an event. */ | |
| IPMI_STAT_invalid_events, | |
| /* Events that were received with the proper format. */ | |
| IPMI_STAT_events, | |
| /* Retransmissions on IPMB that failed. */ | |
| IPMI_STAT_dropped_rexmit_ipmb_commands, | |
| /* Retransmissions on LAN that failed. */ | |
| IPMI_STAT_dropped_rexmit_lan_commands, | |
| /* This *must* remain last, add new values above this. */ | |
| IPMI_NUM_STATS | |
| }; | |
| #define IPMI_IPMB_NUM_SEQ 64 | |
| struct ipmi_smi { | |
| struct module *owner; | |
| /* What interface number are we? */ | |
| int intf_num; | |
| struct kref refcount; | |
| /* Set when the interface is being unregistered. */ | |
| bool in_shutdown; | |
| /* Used for a list of interfaces. */ | |
| struct list_head link; | |
| /* | |
| * The list of upper layers that are using me. seq_lock write | |
| * protects this. Read protection is with srcu. | |
| */ | |
| struct list_head users; | |
| struct srcu_struct users_srcu; | |
| atomic_t nr_users; | |
| struct device_attribute nr_users_devattr; | |
| struct device_attribute nr_msgs_devattr; | |
| /* Used for wake ups at startup. */ | |
| wait_queue_head_t waitq; | |
| /* | |
| * Prevents the interface from being unregistered when the | |
| * interface is used by being looked up through the BMC | |
| * structure. | |
| */ | |
| struct mutex bmc_reg_mutex; | |
| struct bmc_device tmp_bmc; | |
| struct bmc_device *bmc; | |
| bool bmc_registered; | |
| struct list_head bmc_link; | |
| char *my_dev_name; | |
| bool in_bmc_register; /* Handle recursive situations. Yuck. */ | |
| struct work_struct bmc_reg_work; | |
| const struct ipmi_smi_handlers *handlers; | |
| void *send_info; | |
| /* Driver-model device for the system interface. */ | |
| struct device *si_dev; | |
| /* | |
| * A table of sequence numbers for this interface. We use the | |
| * sequence numbers for IPMB messages that go out of the | |
| * interface to match them up with their responses. A routine | |
| * is called periodically to time the items in this list. | |
| */ | |
| spinlock_t seq_lock; | |
| struct seq_table seq_table[IPMI_IPMB_NUM_SEQ]; | |
| int curr_seq; | |
| /* | |
| * Messages queued for delivery. If delivery fails (out of memory | |
| * for instance), They will stay in here to be processed later in a | |
| * periodic timer interrupt. The tasklet is for handling received | |
| * messages directly from the handler. | |
| */ | |
| spinlock_t waiting_rcv_msgs_lock; | |
| struct list_head waiting_rcv_msgs; | |
| atomic_t watchdog_pretimeouts_to_deliver; | |
| struct tasklet_struct recv_tasklet; | |
| spinlock_t xmit_msgs_lock; | |
| struct list_head xmit_msgs; | |
| struct ipmi_smi_msg *curr_msg; | |
| struct list_head hp_xmit_msgs; | |
| /* | |
| * The list of command receivers that are registered for commands | |
| * on this interface. | |
| */ | |
| struct mutex cmd_rcvrs_mutex; | |
| struct list_head cmd_rcvrs; | |
| /* | |
| * Events that were queues because no one was there to receive | |
| * them. | |
| */ | |
| spinlock_t events_lock; /* For dealing with event stuff. */ | |
| struct list_head waiting_events; | |
| unsigned int waiting_events_count; /* How many events in queue? */ | |
| char delivering_events; | |
| char event_msg_printed; | |
| /* How many users are waiting for events? */ | |
| atomic_t event_waiters; | |
| unsigned int ticks_to_req_ev; | |
| spinlock_t watch_lock; /* For dealing with watch stuff below. */ | |
| /* How many users are waiting for commands? */ | |
| unsigned int command_waiters; | |
| /* How many users are waiting for watchdogs? */ | |
| unsigned int watchdog_waiters; | |
| /* How many users are waiting for message responses? */ | |
| unsigned int response_waiters; | |
| /* | |
| * Tells what the lower layer has last been asked to watch for, | |
| * messages and/or watchdogs. Protected by watch_lock. | |
| */ | |
| unsigned int last_watch_mask; | |
| /* | |
| * The event receiver for my BMC, only really used at panic | |
| * shutdown as a place to store this. | |
| */ | |
| unsigned char event_receiver; | |
| unsigned char event_receiver_lun; | |
| unsigned char local_sel_device; | |
| unsigned char local_event_generator; | |
| /* For handling of maintenance mode. */ | |
| int maintenance_mode; | |
| bool maintenance_mode_enable; | |
| int auto_maintenance_timeout; | |
| spinlock_t maintenance_mode_lock; /* Used in a timer... */ | |
| /* | |
| * If we are doing maintenance on something on IPMB, extend | |
| * the timeout time to avoid timeouts writing firmware and | |
| * such. | |
| */ | |
| int ipmb_maintenance_mode_timeout; | |
| /* | |
| * A cheap hack, if this is non-null and a message to an | |
| * interface comes in with a NULL user, call this routine with | |
| * it. Note that the message will still be freed by the | |
| * caller. This only works on the system interface. | |
| * | |
| * Protected by bmc_reg_mutex. | |
| */ | |
| void (*null_user_handler)(struct ipmi_smi *intf, | |
| struct ipmi_recv_msg *msg); | |
| /* | |
| * When we are scanning the channels for an SMI, this will | |
| * tell which channel we are scanning. | |
| */ | |
| int curr_channel; | |
| /* Channel information */ | |
| struct ipmi_channel_set *channel_list; | |
| unsigned int curr_working_cset; /* First index into the following. */ | |
| struct ipmi_channel_set wchannels[2]; | |
| struct ipmi_my_addrinfo addrinfo[IPMI_MAX_CHANNELS]; | |
| bool channels_ready; | |
| atomic_t stats[IPMI_NUM_STATS]; | |
| /* | |
| * run_to_completion duplicate of smb_info, smi_info | |
| * and ipmi_serial_info structures. Used to decrease numbers of | |
| * parameters passed by "low" level IPMI code. | |
| */ | |
| int run_to_completion; | |
| }; | |
| #define to_si_intf_from_dev(device) container_of(device, struct ipmi_smi, dev) | |
| static void __get_guid(struct ipmi_smi *intf); | |
| static void __ipmi_bmc_unregister(struct ipmi_smi *intf); | |
| static int __ipmi_bmc_register(struct ipmi_smi *intf, | |
| struct ipmi_device_id *id, | |
| bool guid_set, guid_t *guid, int intf_num); | |
| static int __scan_channels(struct ipmi_smi *intf, struct ipmi_device_id *id); | |
| /* | |
| * The driver model view of the IPMI messaging driver. | |
| */ | |
| static struct platform_driver ipmidriver = { | |
| .driver = { | |
| .name = "ipmi", | |
| .bus = &platform_bus_type | |
| } | |
| }; | |
| /* | |
| * This mutex keeps us from adding the same BMC twice. | |
| */ | |
| static DEFINE_MUTEX(ipmidriver_mutex); | |
| static LIST_HEAD(ipmi_interfaces); | |
| static DEFINE_MUTEX(ipmi_interfaces_mutex); | |
| #define ipmi_interfaces_mutex_held() \ | |
| lockdep_is_held(&ipmi_interfaces_mutex) | |
| static struct srcu_struct ipmi_interfaces_srcu; | |
| /* | |
| * List of watchers that want to know when smi's are added and deleted. | |
| */ | |
| static LIST_HEAD(smi_watchers); | |
| static DEFINE_MUTEX(smi_watchers_mutex); | |
| #define ipmi_inc_stat(intf, stat) \ | |
| atomic_inc(&(intf)->stats[IPMI_STAT_ ## stat]) | |
| #define ipmi_get_stat(intf, stat) \ | |
| ((unsigned int) atomic_read(&(intf)->stats[IPMI_STAT_ ## stat])) | |
| static const char * const addr_src_to_str[] = { | |
| "invalid", "hotmod", "hardcoded", "SPMI", "ACPI", "SMBIOS", "PCI", | |
| "device-tree", "platform" | |
| }; | |
| const char *ipmi_addr_src_to_str(enum ipmi_addr_src src) | |
| { | |
| if (src >= SI_LAST) | |
| src = 0; /* Invalid */ | |
| return addr_src_to_str[src]; | |
| } | |
| EXPORT_SYMBOL(ipmi_addr_src_to_str); | |
| static int is_lan_addr(struct ipmi_addr *addr) | |
| { | |
| return addr->addr_type == IPMI_LAN_ADDR_TYPE; | |
| } | |
| static int is_ipmb_addr(struct ipmi_addr *addr) | |
| { | |
| return addr->addr_type == IPMI_IPMB_ADDR_TYPE; | |
| } | |
| static int is_ipmb_bcast_addr(struct ipmi_addr *addr) | |
| { | |
| return addr->addr_type == IPMI_IPMB_BROADCAST_ADDR_TYPE; | |
| } | |
| static int is_ipmb_direct_addr(struct ipmi_addr *addr) | |
| { | |
| return addr->addr_type == IPMI_IPMB_DIRECT_ADDR_TYPE; | |
| } | |
| static void free_recv_msg_list(struct list_head *q) | |
| { | |
| struct ipmi_recv_msg *msg, *msg2; | |
| list_for_each_entry_safe(msg, msg2, q, link) { | |
| list_del(&msg->link); | |
| ipmi_free_recv_msg(msg); | |
| } | |
| } | |
| static void free_smi_msg_list(struct list_head *q) | |
| { | |
| struct ipmi_smi_msg *msg, *msg2; | |
| list_for_each_entry_safe(msg, msg2, q, link) { | |
| list_del(&msg->link); | |
| ipmi_free_smi_msg(msg); | |
| } | |
| } | |
| static void clean_up_interface_data(struct ipmi_smi *intf) | |
| { | |
| int i; | |
| struct cmd_rcvr *rcvr, *rcvr2; | |
| struct list_head list; | |
| tasklet_kill(&intf->recv_tasklet); | |
| free_smi_msg_list(&intf->waiting_rcv_msgs); | |
| free_recv_msg_list(&intf->waiting_events); | |
| /* | |
| * Wholesale remove all the entries from the list in the | |
| * interface and wait for RCU to know that none are in use. | |
| */ | |
| mutex_lock(&intf->cmd_rcvrs_mutex); | |
| INIT_LIST_HEAD(&list); | |
| list_splice_init_rcu(&intf->cmd_rcvrs, &list, synchronize_rcu); | |
| mutex_unlock(&intf->cmd_rcvrs_mutex); | |
| list_for_each_entry_safe(rcvr, rcvr2, &list, link) | |
| kfree(rcvr); | |
| for (i = 0; i < IPMI_IPMB_NUM_SEQ; i++) { | |
| if ((intf->seq_table[i].inuse) | |
| && (intf->seq_table[i].recv_msg)) | |
| ipmi_free_recv_msg(intf->seq_table[i].recv_msg); | |
| } | |
| } | |
| static void intf_free(struct kref *ref) | |
| { | |
| struct ipmi_smi *intf = container_of(ref, struct ipmi_smi, refcount); | |
| clean_up_interface_data(intf); | |
| kfree(intf); | |
| } | |
| int ipmi_smi_watcher_register(struct ipmi_smi_watcher *watcher) | |
| { | |
| struct ipmi_smi *intf; | |
| int index, rv; | |
| /* | |
| * Make sure the driver is actually initialized, this handles | |
| * problems with initialization order. | |
| */ | |
| rv = ipmi_init_msghandler(); | |
| if (rv) | |
| return rv; | |
| mutex_lock(&smi_watchers_mutex); | |
| list_add(&watcher->link, &smi_watchers); | |
| index = srcu_read_lock(&ipmi_interfaces_srcu); | |
| list_for_each_entry_rcu(intf, &ipmi_interfaces, link, | |
| lockdep_is_held(&smi_watchers_mutex)) { | |
| int intf_num = READ_ONCE(intf->intf_num); | |
| if (intf_num == -1) | |
| continue; | |
| watcher->new_smi(intf_num, intf->si_dev); | |
| } | |
| srcu_read_unlock(&ipmi_interfaces_srcu, index); | |
| mutex_unlock(&smi_watchers_mutex); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL(ipmi_smi_watcher_register); | |
| int ipmi_smi_watcher_unregister(struct ipmi_smi_watcher *watcher) | |
| { | |
| mutex_lock(&smi_watchers_mutex); | |
| list_del(&watcher->link); | |
| mutex_unlock(&smi_watchers_mutex); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL(ipmi_smi_watcher_unregister); | |
| /* | |
| * Must be called with smi_watchers_mutex held. | |
| */ | |
| static void | |
| call_smi_watchers(int i, struct device *dev) | |
| { | |
| struct ipmi_smi_watcher *w; | |
| mutex_lock(&smi_watchers_mutex); | |
| list_for_each_entry(w, &smi_watchers, link) { | |
| if (try_module_get(w->owner)) { | |
| w->new_smi(i, dev); | |
| module_put(w->owner); | |
| } | |
| } | |
| mutex_unlock(&smi_watchers_mutex); | |
| } | |
| static int | |
| ipmi_addr_equal(struct ipmi_addr *addr1, struct ipmi_addr *addr2) | |
| { | |
| if (addr1->addr_type != addr2->addr_type) | |
| return 0; | |
| if (addr1->channel != addr2->channel) | |
| return 0; | |
| if (addr1->addr_type == IPMI_SYSTEM_INTERFACE_ADDR_TYPE) { | |
| struct ipmi_system_interface_addr *smi_addr1 | |
| = (struct ipmi_system_interface_addr *) addr1; | |
| struct ipmi_system_interface_addr *smi_addr2 | |
| = (struct ipmi_system_interface_addr *) addr2; | |
| return (smi_addr1->lun == smi_addr2->lun); | |
| } | |
| if (is_ipmb_addr(addr1) || is_ipmb_bcast_addr(addr1)) { | |
| struct ipmi_ipmb_addr *ipmb_addr1 | |
| = (struct ipmi_ipmb_addr *) addr1; | |
| struct ipmi_ipmb_addr *ipmb_addr2 | |
| = (struct ipmi_ipmb_addr *) addr2; | |
| return ((ipmb_addr1->slave_addr == ipmb_addr2->slave_addr) | |
| && (ipmb_addr1->lun == ipmb_addr2->lun)); | |
| } | |
| if (is_ipmb_direct_addr(addr1)) { | |
| struct ipmi_ipmb_direct_addr *daddr1 | |
| = (struct ipmi_ipmb_direct_addr *) addr1; | |
| struct ipmi_ipmb_direct_addr *daddr2 | |
| = (struct ipmi_ipmb_direct_addr *) addr2; | |
| return daddr1->slave_addr == daddr2->slave_addr && | |
| daddr1->rq_lun == daddr2->rq_lun && | |
| daddr1->rs_lun == daddr2->rs_lun; | |
| } | |
| if (is_lan_addr(addr1)) { | |
| struct ipmi_lan_addr *lan_addr1 | |
| = (struct ipmi_lan_addr *) addr1; | |
| struct ipmi_lan_addr *lan_addr2 | |
| = (struct ipmi_lan_addr *) addr2; | |
| return ((lan_addr1->remote_SWID == lan_addr2->remote_SWID) | |
| && (lan_addr1->local_SWID == lan_addr2->local_SWID) | |
| && (lan_addr1->session_handle | |
| == lan_addr2->session_handle) | |
| && (lan_addr1->lun == lan_addr2->lun)); | |
| } | |
| return 1; | |
| } | |
| int ipmi_validate_addr(struct ipmi_addr *addr, int len) | |
| { | |
| if (len < sizeof(struct ipmi_system_interface_addr)) | |
| return -EINVAL; | |
| if (addr->addr_type == IPMI_SYSTEM_INTERFACE_ADDR_TYPE) { | |
| if (addr->channel != IPMI_BMC_CHANNEL) | |
| return -EINVAL; | |
| return 0; | |
| } | |
| if ((addr->channel == IPMI_BMC_CHANNEL) | |
| || (addr->channel >= IPMI_MAX_CHANNELS) | |
| || (addr->channel < 0)) | |
| return -EINVAL; | |
| if (is_ipmb_addr(addr) || is_ipmb_bcast_addr(addr)) { | |
| if (len < sizeof(struct ipmi_ipmb_addr)) | |
| return -EINVAL; | |
| return 0; | |
| } | |
| if (is_ipmb_direct_addr(addr)) { | |
| struct ipmi_ipmb_direct_addr *daddr = (void *) addr; | |
| if (addr->channel != 0) | |
| return -EINVAL; | |
| if (len < sizeof(struct ipmi_ipmb_direct_addr)) | |
| return -EINVAL; | |
| if (daddr->slave_addr & 0x01) | |
| return -EINVAL; | |
| if (daddr->rq_lun >= 4) | |
| return -EINVAL; | |
| if (daddr->rs_lun >= 4) | |
| return -EINVAL; | |
| return 0; | |
| } | |
| if (is_lan_addr(addr)) { | |
| if (len < sizeof(struct ipmi_lan_addr)) | |
| return -EINVAL; | |
| return 0; | |
| } | |
| return -EINVAL; | |
| } | |
| EXPORT_SYMBOL(ipmi_validate_addr); | |
| unsigned int ipmi_addr_length(int addr_type) | |
| { | |
| if (addr_type == IPMI_SYSTEM_INTERFACE_ADDR_TYPE) | |
| return sizeof(struct ipmi_system_interface_addr); | |
| if ((addr_type == IPMI_IPMB_ADDR_TYPE) | |
| || (addr_type == IPMI_IPMB_BROADCAST_ADDR_TYPE)) | |
| return sizeof(struct ipmi_ipmb_addr); | |
| if (addr_type == IPMI_IPMB_DIRECT_ADDR_TYPE) | |
| return sizeof(struct ipmi_ipmb_direct_addr); | |
| if (addr_type == IPMI_LAN_ADDR_TYPE) | |
| return sizeof(struct ipmi_lan_addr); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL(ipmi_addr_length); | |
| static int deliver_response(struct ipmi_smi *intf, struct ipmi_recv_msg *msg) | |
| { | |
| int rv = 0; | |
| if (!msg->user) { | |
| /* Special handling for NULL users. */ | |
| if (intf->null_user_handler) { | |
| intf->null_user_handler(intf, msg); | |
| } else { | |
| /* No handler, so give up. */ | |
| rv = -EINVAL; | |
| } | |
| ipmi_free_recv_msg(msg); | |
| } else if (oops_in_progress) { | |
| /* | |
| * If we are running in the panic context, calling the | |
| * receive handler doesn't much meaning and has a deadlock | |
| * risk. At this moment, simply skip it in that case. | |
| */ | |
| ipmi_free_recv_msg(msg); | |
| atomic_dec(&msg->user->nr_msgs); | |
| } else { | |
| int index; | |
| struct ipmi_user *user = acquire_ipmi_user(msg->user, &index); | |
| if (user) { | |
| atomic_dec(&user->nr_msgs); | |
| user->handler->ipmi_recv_hndl(msg, user->handler_data); | |
| release_ipmi_user(user, index); | |
| } else { | |
| /* User went away, give up. */ | |
| ipmi_free_recv_msg(msg); | |
| rv = -EINVAL; | |
| } | |
| } | |
| return rv; | |
| } | |
| static void deliver_local_response(struct ipmi_smi *intf, | |
| struct ipmi_recv_msg *msg) | |
| { | |
| if (deliver_response(intf, msg)) | |
| ipmi_inc_stat(intf, unhandled_local_responses); | |
| else | |
| ipmi_inc_stat(intf, handled_local_responses); | |
| } | |
| static void deliver_err_response(struct ipmi_smi *intf, | |
| struct ipmi_recv_msg *msg, int err) | |
| { | |
| msg->recv_type = IPMI_RESPONSE_RECV_TYPE; | |
| msg->msg_data[0] = err; | |
| msg->msg.netfn |= 1; /* Convert to a response. */ | |
| msg->msg.data_len = 1; | |
| msg->msg.data = msg->msg_data; | |
| deliver_local_response(intf, msg); | |
| } | |
| static void smi_add_watch(struct ipmi_smi *intf, unsigned int flags) | |
| { | |
| unsigned long iflags; | |
| if (!intf->handlers->set_need_watch) | |
| return; | |
| spin_lock_irqsave(&intf->watch_lock, iflags); | |
| if (flags & IPMI_WATCH_MASK_CHECK_MESSAGES) | |
| intf->response_waiters++; | |
| if (flags & IPMI_WATCH_MASK_CHECK_WATCHDOG) | |
| intf->watchdog_waiters++; | |
| if (flags & IPMI_WATCH_MASK_CHECK_COMMANDS) | |
| intf->command_waiters++; | |
| if ((intf->last_watch_mask & flags) != flags) { | |
| intf->last_watch_mask |= flags; | |
| intf->handlers->set_need_watch(intf->send_info, | |
| intf->last_watch_mask); | |
| } | |
| spin_unlock_irqrestore(&intf->watch_lock, iflags); | |
| } | |
| static void smi_remove_watch(struct ipmi_smi *intf, unsigned int flags) | |
| { | |
| unsigned long iflags; | |
| if (!intf->handlers->set_need_watch) | |
| return; | |
| spin_lock_irqsave(&intf->watch_lock, iflags); | |
| if (flags & IPMI_WATCH_MASK_CHECK_MESSAGES) | |
| intf->response_waiters--; | |
| if (flags & IPMI_WATCH_MASK_CHECK_WATCHDOG) | |
| intf->watchdog_waiters--; | |
| if (flags & IPMI_WATCH_MASK_CHECK_COMMANDS) | |
| intf->command_waiters--; | |
| flags = 0; | |
| if (intf->response_waiters) | |
| flags |= IPMI_WATCH_MASK_CHECK_MESSAGES; | |
| if (intf->watchdog_waiters) | |
| flags |= IPMI_WATCH_MASK_CHECK_WATCHDOG; | |
| if (intf->command_waiters) | |
| flags |= IPMI_WATCH_MASK_CHECK_COMMANDS; | |
| if (intf->last_watch_mask != flags) { | |
| intf->last_watch_mask = flags; | |
| intf->handlers->set_need_watch(intf->send_info, | |
| intf->last_watch_mask); | |
| } | |
| spin_unlock_irqrestore(&intf->watch_lock, iflags); | |
| } | |
| /* | |
| * Find the next sequence number not being used and add the given | |
| * message with the given timeout to the sequence table. This must be | |
| * called with the interface's seq_lock held. | |
| */ | |
| static int intf_next_seq(struct ipmi_smi *intf, | |
| struct ipmi_recv_msg *recv_msg, | |
| unsigned long timeout, | |
| int retries, | |
| int broadcast, | |
| unsigned char *seq, | |
| long *seqid) | |
| { | |
| int rv = 0; | |
| unsigned int i; | |
| if (timeout == 0) | |
| timeout = default_retry_ms; | |
| if (retries < 0) | |
| retries = default_max_retries; | |
| for (i = intf->curr_seq; (i+1)%IPMI_IPMB_NUM_SEQ != intf->curr_seq; | |
| i = (i+1)%IPMI_IPMB_NUM_SEQ) { | |
| if (!intf->seq_table[i].inuse) | |
| break; | |
| } | |
| if (!intf->seq_table[i].inuse) { | |
| intf->seq_table[i].recv_msg = recv_msg; | |
| /* | |
| * Start with the maximum timeout, when the send response | |
| * comes in we will start the real timer. | |
| */ | |
| intf->seq_table[i].timeout = MAX_MSG_TIMEOUT; | |
| intf->seq_table[i].orig_timeout = timeout; | |
| intf->seq_table[i].retries_left = retries; | |
| intf->seq_table[i].broadcast = broadcast; | |
| intf->seq_table[i].inuse = 1; | |
| intf->seq_table[i].seqid = NEXT_SEQID(intf->seq_table[i].seqid); | |
| *seq = i; | |
| *seqid = intf->seq_table[i].seqid; | |
| intf->curr_seq = (i+1)%IPMI_IPMB_NUM_SEQ; | |
| smi_add_watch(intf, IPMI_WATCH_MASK_CHECK_MESSAGES); | |
| need_waiter(intf); | |
| } else { | |
| rv = -EAGAIN; | |
| } | |
| return rv; | |
| } | |
| /* | |
| * Return the receive message for the given sequence number and | |
| * release the sequence number so it can be reused. Some other data | |
| * is passed in to be sure the message matches up correctly (to help | |
| * guard against message coming in after their timeout and the | |
| * sequence number being reused). | |
| */ | |
| static int intf_find_seq(struct ipmi_smi *intf, | |
| unsigned char seq, | |
| short channel, | |
| unsigned char cmd, | |
| unsigned char netfn, | |
| struct ipmi_addr *addr, | |
| struct ipmi_recv_msg **recv_msg) | |
| { | |
| int rv = -ENODEV; | |
| unsigned long flags; | |
| if (seq >= IPMI_IPMB_NUM_SEQ) | |
| return -EINVAL; | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| if (intf->seq_table[seq].inuse) { | |
| struct ipmi_recv_msg *msg = intf->seq_table[seq].recv_msg; | |
| if ((msg->addr.channel == channel) && (msg->msg.cmd == cmd) | |
| && (msg->msg.netfn == netfn) | |
| && (ipmi_addr_equal(addr, &msg->addr))) { | |
| *recv_msg = msg; | |
| intf->seq_table[seq].inuse = 0; | |
| smi_remove_watch(intf, IPMI_WATCH_MASK_CHECK_MESSAGES); | |
| rv = 0; | |
| } | |
| } | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| return rv; | |
| } | |
| /* Start the timer for a specific sequence table entry. */ | |
| static int intf_start_seq_timer(struct ipmi_smi *intf, | |
| long msgid) | |
| { | |
| int rv = -ENODEV; | |
| unsigned long flags; | |
| unsigned char seq; | |
| unsigned long seqid; | |
| GET_SEQ_FROM_MSGID(msgid, seq, seqid); | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| /* | |
| * We do this verification because the user can be deleted | |
| * while a message is outstanding. | |
| */ | |
| if ((intf->seq_table[seq].inuse) | |
| && (intf->seq_table[seq].seqid == seqid)) { | |
| struct seq_table *ent = &intf->seq_table[seq]; | |
| ent->timeout = ent->orig_timeout; | |
| rv = 0; | |
| } | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| return rv; | |
| } | |
| /* Got an error for the send message for a specific sequence number. */ | |
| static int intf_err_seq(struct ipmi_smi *intf, | |
| long msgid, | |
| unsigned int err) | |
| { | |
| int rv = -ENODEV; | |
| unsigned long flags; | |
| unsigned char seq; | |
| unsigned long seqid; | |
| struct ipmi_recv_msg *msg = NULL; | |
| GET_SEQ_FROM_MSGID(msgid, seq, seqid); | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| /* | |
| * We do this verification because the user can be deleted | |
| * while a message is outstanding. | |
| */ | |
| if ((intf->seq_table[seq].inuse) | |
| && (intf->seq_table[seq].seqid == seqid)) { | |
| struct seq_table *ent = &intf->seq_table[seq]; | |
| ent->inuse = 0; | |
| smi_remove_watch(intf, IPMI_WATCH_MASK_CHECK_MESSAGES); | |
| msg = ent->recv_msg; | |
| rv = 0; | |
| } | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| if (msg) | |
| deliver_err_response(intf, msg, err); | |
| return rv; | |
| } | |
| static void free_user_work(struct work_struct *work) | |
| { | |
| struct ipmi_user *user = container_of(work, struct ipmi_user, | |
| remove_work); | |
| cleanup_srcu_struct(&user->release_barrier); | |
| vfree(user); | |
| } | |
| int ipmi_create_user(unsigned int if_num, | |
| const struct ipmi_user_hndl *handler, | |
| void *handler_data, | |
| struct ipmi_user **user) | |
| { | |
| unsigned long flags; | |
| struct ipmi_user *new_user; | |
| int rv, index; | |
| struct ipmi_smi *intf; | |
| /* | |
| * There is no module usecount here, because it's not | |
| * required. Since this can only be used by and called from | |
| * other modules, they will implicitly use this module, and | |
| * thus this can't be removed unless the other modules are | |
| * removed. | |
| */ | |
| if (handler == NULL) | |
| return -EINVAL; | |
| /* | |
| * Make sure the driver is actually initialized, this handles | |
| * problems with initialization order. | |
| */ | |
| rv = ipmi_init_msghandler(); | |
| if (rv) | |
| return rv; | |
| new_user = vzalloc(sizeof(*new_user)); | |
| if (!new_user) | |
| return -ENOMEM; | |
| index = srcu_read_lock(&ipmi_interfaces_srcu); | |
| list_for_each_entry_rcu(intf, &ipmi_interfaces, link) { | |
| if (intf->intf_num == if_num) | |
| goto found; | |
| } | |
| /* Not found, return an error */ | |
| rv = -EINVAL; | |
| goto out_kfree; | |
| found: | |
| if (atomic_add_return(1, &intf->nr_users) > max_users) { | |
| rv = -EBUSY; | |
| goto out_kfree; | |
| } | |
| INIT_WORK(&new_user->remove_work, free_user_work); | |
| rv = init_srcu_struct(&new_user->release_barrier); | |
| if (rv) | |
| goto out_kfree; | |
| if (!try_module_get(intf->owner)) { | |
| rv = -ENODEV; | |
| goto out_kfree; | |
| } | |
| /* Note that each existing user holds a refcount to the interface. */ | |
| kref_get(&intf->refcount); | |
| atomic_set(&new_user->nr_msgs, 0); | |
| kref_init(&new_user->refcount); | |
| new_user->handler = handler; | |
| new_user->handler_data = handler_data; | |
| new_user->intf = intf; | |
| new_user->gets_events = false; | |
| rcu_assign_pointer(new_user->self, new_user); | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| list_add_rcu(&new_user->link, &intf->users); | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| if (handler->ipmi_watchdog_pretimeout) | |
| /* User wants pretimeouts, so make sure to watch for them. */ | |
| smi_add_watch(intf, IPMI_WATCH_MASK_CHECK_WATCHDOG); | |
| srcu_read_unlock(&ipmi_interfaces_srcu, index); | |
| *user = new_user; | |
| return 0; | |
| out_kfree: | |
| atomic_dec(&intf->nr_users); | |
| srcu_read_unlock(&ipmi_interfaces_srcu, index); | |
| vfree(new_user); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_create_user); | |
| int ipmi_get_smi_info(int if_num, struct ipmi_smi_info *data) | |
| { | |
| int rv, index; | |
| struct ipmi_smi *intf; | |
| index = srcu_read_lock(&ipmi_interfaces_srcu); | |
| list_for_each_entry_rcu(intf, &ipmi_interfaces, link) { | |
| if (intf->intf_num == if_num) | |
| goto found; | |
| } | |
| srcu_read_unlock(&ipmi_interfaces_srcu, index); | |
| /* Not found, return an error */ | |
| return -EINVAL; | |
| found: | |
| if (!intf->handlers->get_smi_info) | |
| rv = -ENOTTY; | |
| else | |
| rv = intf->handlers->get_smi_info(intf->send_info, data); | |
| srcu_read_unlock(&ipmi_interfaces_srcu, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_get_smi_info); | |
| static void free_user(struct kref *ref) | |
| { | |
| struct ipmi_user *user = container_of(ref, struct ipmi_user, refcount); | |
| /* SRCU cleanup must happen in task context. */ | |
| queue_work(remove_work_wq, &user->remove_work); | |
| } | |
| static void _ipmi_destroy_user(struct ipmi_user *user) | |
| { | |
| struct ipmi_smi *intf = user->intf; | |
| int i; | |
| unsigned long flags; | |
| struct cmd_rcvr *rcvr; | |
| struct cmd_rcvr *rcvrs = NULL; | |
| struct module *owner; | |
| if (!acquire_ipmi_user(user, &i)) { | |
| /* | |
| * The user has already been cleaned up, just make sure | |
| * nothing is using it and return. | |
| */ | |
| synchronize_srcu(&user->release_barrier); | |
| return; | |
| } | |
| rcu_assign_pointer(user->self, NULL); | |
| release_ipmi_user(user, i); | |
| synchronize_srcu(&user->release_barrier); | |
| if (user->handler->shutdown) | |
| user->handler->shutdown(user->handler_data); | |
| if (user->handler->ipmi_watchdog_pretimeout) | |
| smi_remove_watch(intf, IPMI_WATCH_MASK_CHECK_WATCHDOG); | |
| if (user->gets_events) | |
| atomic_dec(&intf->event_waiters); | |
| /* Remove the user from the interface's sequence table. */ | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| list_del_rcu(&user->link); | |
| atomic_dec(&intf->nr_users); | |
| for (i = 0; i < IPMI_IPMB_NUM_SEQ; i++) { | |
| if (intf->seq_table[i].inuse | |
| && (intf->seq_table[i].recv_msg->user == user)) { | |
| intf->seq_table[i].inuse = 0; | |
| smi_remove_watch(intf, IPMI_WATCH_MASK_CHECK_MESSAGES); | |
| ipmi_free_recv_msg(intf->seq_table[i].recv_msg); | |
| } | |
| } | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| /* | |
| * Remove the user from the command receiver's table. First | |
| * we build a list of everything (not using the standard link, | |
| * since other things may be using it till we do | |
| * synchronize_srcu()) then free everything in that list. | |
| */ | |
| mutex_lock(&intf->cmd_rcvrs_mutex); | |
| list_for_each_entry_rcu(rcvr, &intf->cmd_rcvrs, link, | |
| lockdep_is_held(&intf->cmd_rcvrs_mutex)) { | |
| if (rcvr->user == user) { | |
| list_del_rcu(&rcvr->link); | |
| rcvr->next = rcvrs; | |
| rcvrs = rcvr; | |
| } | |
| } | |
| mutex_unlock(&intf->cmd_rcvrs_mutex); | |
| synchronize_rcu(); | |
| while (rcvrs) { | |
| rcvr = rcvrs; | |
| rcvrs = rcvr->next; | |
| kfree(rcvr); | |
| } | |
| owner = intf->owner; | |
| kref_put(&intf->refcount, intf_free); | |
| module_put(owner); | |
| } | |
| int ipmi_destroy_user(struct ipmi_user *user) | |
| { | |
| _ipmi_destroy_user(user); | |
| kref_put(&user->refcount, free_user); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL(ipmi_destroy_user); | |
| int ipmi_get_version(struct ipmi_user *user, | |
| unsigned char *major, | |
| unsigned char *minor) | |
| { | |
| struct ipmi_device_id id; | |
| int rv, index; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| rv = bmc_get_device_id(user->intf, NULL, &id, NULL, NULL); | |
| if (!rv) { | |
| *major = ipmi_version_major(&id); | |
| *minor = ipmi_version_minor(&id); | |
| } | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_get_version); | |
| int ipmi_set_my_address(struct ipmi_user *user, | |
| unsigned int channel, | |
| unsigned char address) | |
| { | |
| int index, rv = 0; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| if (channel >= IPMI_MAX_CHANNELS) { | |
| rv = -EINVAL; | |
| } else { | |
| channel = array_index_nospec(channel, IPMI_MAX_CHANNELS); | |
| user->intf->addrinfo[channel].address = address; | |
| } | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_set_my_address); | |
| int ipmi_get_my_address(struct ipmi_user *user, | |
| unsigned int channel, | |
| unsigned char *address) | |
| { | |
| int index, rv = 0; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| if (channel >= IPMI_MAX_CHANNELS) { | |
| rv = -EINVAL; | |
| } else { | |
| channel = array_index_nospec(channel, IPMI_MAX_CHANNELS); | |
| *address = user->intf->addrinfo[channel].address; | |
| } | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_get_my_address); | |
| int ipmi_set_my_LUN(struct ipmi_user *user, | |
| unsigned int channel, | |
| unsigned char LUN) | |
| { | |
| int index, rv = 0; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| if (channel >= IPMI_MAX_CHANNELS) { | |
| rv = -EINVAL; | |
| } else { | |
| channel = array_index_nospec(channel, IPMI_MAX_CHANNELS); | |
| user->intf->addrinfo[channel].lun = LUN & 0x3; | |
| } | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_set_my_LUN); | |
| int ipmi_get_my_LUN(struct ipmi_user *user, | |
| unsigned int channel, | |
| unsigned char *address) | |
| { | |
| int index, rv = 0; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| if (channel >= IPMI_MAX_CHANNELS) { | |
| rv = -EINVAL; | |
| } else { | |
| channel = array_index_nospec(channel, IPMI_MAX_CHANNELS); | |
| *address = user->intf->addrinfo[channel].lun; | |
| } | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_get_my_LUN); | |
| int ipmi_get_maintenance_mode(struct ipmi_user *user) | |
| { | |
| int mode, index; | |
| unsigned long flags; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| spin_lock_irqsave(&user->intf->maintenance_mode_lock, flags); | |
| mode = user->intf->maintenance_mode; | |
| spin_unlock_irqrestore(&user->intf->maintenance_mode_lock, flags); | |
| release_ipmi_user(user, index); | |
| return mode; | |
| } | |
| EXPORT_SYMBOL(ipmi_get_maintenance_mode); | |
| static void maintenance_mode_update(struct ipmi_smi *intf) | |
| { | |
| if (intf->handlers->set_maintenance_mode) | |
| intf->handlers->set_maintenance_mode( | |
| intf->send_info, intf->maintenance_mode_enable); | |
| } | |
| int ipmi_set_maintenance_mode(struct ipmi_user *user, int mode) | |
| { | |
| int rv = 0, index; | |
| unsigned long flags; | |
| struct ipmi_smi *intf = user->intf; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| spin_lock_irqsave(&intf->maintenance_mode_lock, flags); | |
| if (intf->maintenance_mode != mode) { | |
| switch (mode) { | |
| case IPMI_MAINTENANCE_MODE_AUTO: | |
| intf->maintenance_mode_enable | |
| = (intf->auto_maintenance_timeout > 0); | |
| break; | |
| case IPMI_MAINTENANCE_MODE_OFF: | |
| intf->maintenance_mode_enable = false; | |
| break; | |
| case IPMI_MAINTENANCE_MODE_ON: | |
| intf->maintenance_mode_enable = true; | |
| break; | |
| default: | |
| rv = -EINVAL; | |
| goto out_unlock; | |
| } | |
| intf->maintenance_mode = mode; | |
| maintenance_mode_update(intf); | |
| } | |
| out_unlock: | |
| spin_unlock_irqrestore(&intf->maintenance_mode_lock, flags); | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_set_maintenance_mode); | |
| int ipmi_set_gets_events(struct ipmi_user *user, bool val) | |
| { | |
| unsigned long flags; | |
| struct ipmi_smi *intf = user->intf; | |
| struct ipmi_recv_msg *msg, *msg2; | |
| struct list_head msgs; | |
| int index; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| INIT_LIST_HEAD(&msgs); | |
| spin_lock_irqsave(&intf->events_lock, flags); | |
| if (user->gets_events == val) | |
| goto out; | |
| user->gets_events = val; | |
| if (val) { | |
| if (atomic_inc_return(&intf->event_waiters) == 1) | |
| need_waiter(intf); | |
| } else { | |
| atomic_dec(&intf->event_waiters); | |
| } | |
| if (intf->delivering_events) | |
| /* | |
| * Another thread is delivering events for this, so | |
| * let it handle any new events. | |
| */ | |
| goto out; | |
| /* Deliver any queued events. */ | |
| while (user->gets_events && !list_empty(&intf->waiting_events)) { | |
| list_for_each_entry_safe(msg, msg2, &intf->waiting_events, link) | |
| list_move_tail(&msg->link, &msgs); | |
| intf->waiting_events_count = 0; | |
| if (intf->event_msg_printed) { | |
| dev_warn(intf->si_dev, "Event queue no longer full\n"); | |
| intf->event_msg_printed = 0; | |
| } | |
| intf->delivering_events = 1; | |
| spin_unlock_irqrestore(&intf->events_lock, flags); | |
| list_for_each_entry_safe(msg, msg2, &msgs, link) { | |
| msg->user = user; | |
| kref_get(&user->refcount); | |
| deliver_local_response(intf, msg); | |
| } | |
| spin_lock_irqsave(&intf->events_lock, flags); | |
| intf->delivering_events = 0; | |
| } | |
| out: | |
| spin_unlock_irqrestore(&intf->events_lock, flags); | |
| release_ipmi_user(user, index); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL(ipmi_set_gets_events); | |
| static struct cmd_rcvr *find_cmd_rcvr(struct ipmi_smi *intf, | |
| unsigned char netfn, | |
| unsigned char cmd, | |
| unsigned char chan) | |
| { | |
| struct cmd_rcvr *rcvr; | |
| list_for_each_entry_rcu(rcvr, &intf->cmd_rcvrs, link, | |
| lockdep_is_held(&intf->cmd_rcvrs_mutex)) { | |
| if ((rcvr->netfn == netfn) && (rcvr->cmd == cmd) | |
| && (rcvr->chans & (1 << chan))) | |
| return rcvr; | |
| } | |
| return NULL; | |
| } | |
| static int is_cmd_rcvr_exclusive(struct ipmi_smi *intf, | |
| unsigned char netfn, | |
| unsigned char cmd, | |
| unsigned int chans) | |
| { | |
| struct cmd_rcvr *rcvr; | |
| list_for_each_entry_rcu(rcvr, &intf->cmd_rcvrs, link, | |
| lockdep_is_held(&intf->cmd_rcvrs_mutex)) { | |
| if ((rcvr->netfn == netfn) && (rcvr->cmd == cmd) | |
| && (rcvr->chans & chans)) | |
| return 0; | |
| } | |
| return 1; | |
| } | |
| int ipmi_register_for_cmd(struct ipmi_user *user, | |
| unsigned char netfn, | |
| unsigned char cmd, | |
| unsigned int chans) | |
| { | |
| struct ipmi_smi *intf = user->intf; | |
| struct cmd_rcvr *rcvr; | |
| int rv = 0, index; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| rcvr = kmalloc(sizeof(*rcvr), GFP_KERNEL); | |
| if (!rcvr) { | |
| rv = -ENOMEM; | |
| goto out_release; | |
| } | |
| rcvr->cmd = cmd; | |
| rcvr->netfn = netfn; | |
| rcvr->chans = chans; | |
| rcvr->user = user; | |
| mutex_lock(&intf->cmd_rcvrs_mutex); | |
| /* Make sure the command/netfn is not already registered. */ | |
| if (!is_cmd_rcvr_exclusive(intf, netfn, cmd, chans)) { | |
| rv = -EBUSY; | |
| goto out_unlock; | |
| } | |
| smi_add_watch(intf, IPMI_WATCH_MASK_CHECK_COMMANDS); | |
| list_add_rcu(&rcvr->link, &intf->cmd_rcvrs); | |
| out_unlock: | |
| mutex_unlock(&intf->cmd_rcvrs_mutex); | |
| if (rv) | |
| kfree(rcvr); | |
| out_release: | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_register_for_cmd); | |
| int ipmi_unregister_for_cmd(struct ipmi_user *user, | |
| unsigned char netfn, | |
| unsigned char cmd, | |
| unsigned int chans) | |
| { | |
| struct ipmi_smi *intf = user->intf; | |
| struct cmd_rcvr *rcvr; | |
| struct cmd_rcvr *rcvrs = NULL; | |
| int i, rv = -ENOENT, index; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| mutex_lock(&intf->cmd_rcvrs_mutex); | |
| for (i = 0; i < IPMI_NUM_CHANNELS; i++) { | |
| if (((1 << i) & chans) == 0) | |
| continue; | |
| rcvr = find_cmd_rcvr(intf, netfn, cmd, i); | |
| if (rcvr == NULL) | |
| continue; | |
| if (rcvr->user == user) { | |
| rv = 0; | |
| rcvr->chans &= ~chans; | |
| if (rcvr->chans == 0) { | |
| list_del_rcu(&rcvr->link); | |
| rcvr->next = rcvrs; | |
| rcvrs = rcvr; | |
| } | |
| } | |
| } | |
| mutex_unlock(&intf->cmd_rcvrs_mutex); | |
| synchronize_rcu(); | |
| release_ipmi_user(user, index); | |
| while (rcvrs) { | |
| smi_remove_watch(intf, IPMI_WATCH_MASK_CHECK_COMMANDS); | |
| rcvr = rcvrs; | |
| rcvrs = rcvr->next; | |
| kfree(rcvr); | |
| } | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_unregister_for_cmd); | |
| unsigned char | |
| ipmb_checksum(unsigned char *data, int size) | |
| { | |
| unsigned char csum = 0; | |
| for (; size > 0; size--, data++) | |
| csum += *data; | |
| return -csum; | |
| } | |
| EXPORT_SYMBOL(ipmb_checksum); | |
| static inline void format_ipmb_msg(struct ipmi_smi_msg *smi_msg, | |
| struct kernel_ipmi_msg *msg, | |
| struct ipmi_ipmb_addr *ipmb_addr, | |
| long msgid, | |
| unsigned char ipmb_seq, | |
| int broadcast, | |
| unsigned char source_address, | |
| unsigned char source_lun) | |
| { | |
| int i = broadcast; | |
| /* Format the IPMB header data. */ | |
| smi_msg->data[0] = (IPMI_NETFN_APP_REQUEST << 2); | |
| smi_msg->data[1] = IPMI_SEND_MSG_CMD; | |
| smi_msg->data[2] = ipmb_addr->channel; | |
| if (broadcast) | |
| smi_msg->data[3] = 0; | |
| smi_msg->data[i+3] = ipmb_addr->slave_addr; | |
| smi_msg->data[i+4] = (msg->netfn << 2) | (ipmb_addr->lun & 0x3); | |
| smi_msg->data[i+5] = ipmb_checksum(&smi_msg->data[i + 3], 2); | |
| smi_msg->data[i+6] = source_address; | |
| smi_msg->data[i+7] = (ipmb_seq << 2) | source_lun; | |
| smi_msg->data[i+8] = msg->cmd; | |
| /* Now tack on the data to the message. */ | |
| if (msg->data_len > 0) | |
| memcpy(&smi_msg->data[i + 9], msg->data, msg->data_len); | |
| smi_msg->data_size = msg->data_len + 9; | |
| /* Now calculate the checksum and tack it on. */ | |
| smi_msg->data[i+smi_msg->data_size] | |
| = ipmb_checksum(&smi_msg->data[i + 6], smi_msg->data_size - 6); | |
| /* | |
| * Add on the checksum size and the offset from the | |
| * broadcast. | |
| */ | |
| smi_msg->data_size += 1 + i; | |
| smi_msg->msgid = msgid; | |
| } | |
| static inline void format_lan_msg(struct ipmi_smi_msg *smi_msg, | |
| struct kernel_ipmi_msg *msg, | |
| struct ipmi_lan_addr *lan_addr, | |
| long msgid, | |
| unsigned char ipmb_seq, | |
| unsigned char source_lun) | |
| { | |
| /* Format the IPMB header data. */ | |
| smi_msg->data[0] = (IPMI_NETFN_APP_REQUEST << 2); | |
| smi_msg->data[1] = IPMI_SEND_MSG_CMD; | |
| smi_msg->data[2] = lan_addr->channel; | |
| smi_msg->data[3] = lan_addr->session_handle; | |
| smi_msg->data[4] = lan_addr->remote_SWID; | |
| smi_msg->data[5] = (msg->netfn << 2) | (lan_addr->lun & 0x3); | |
| smi_msg->data[6] = ipmb_checksum(&smi_msg->data[4], 2); | |
| smi_msg->data[7] = lan_addr->local_SWID; | |
| smi_msg->data[8] = (ipmb_seq << 2) | source_lun; | |
| smi_msg->data[9] = msg->cmd; | |
| /* Now tack on the data to the message. */ | |
| if (msg->data_len > 0) | |
| memcpy(&smi_msg->data[10], msg->data, msg->data_len); | |
| smi_msg->data_size = msg->data_len + 10; | |
| /* Now calculate the checksum and tack it on. */ | |
| smi_msg->data[smi_msg->data_size] | |
| = ipmb_checksum(&smi_msg->data[7], smi_msg->data_size - 7); | |
| /* | |
| * Add on the checksum size and the offset from the | |
| * broadcast. | |
| */ | |
| smi_msg->data_size += 1; | |
| smi_msg->msgid = msgid; | |
| } | |
| static struct ipmi_smi_msg *smi_add_send_msg(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *smi_msg, | |
| int priority) | |
| { | |
| if (intf->curr_msg) { | |
| if (priority > 0) | |
| list_add_tail(&smi_msg->link, &intf->hp_xmit_msgs); | |
| else | |
| list_add_tail(&smi_msg->link, &intf->xmit_msgs); | |
| smi_msg = NULL; | |
| } else { | |
| intf->curr_msg = smi_msg; | |
| } | |
| return smi_msg; | |
| } | |
| static void smi_send(struct ipmi_smi *intf, | |
| const struct ipmi_smi_handlers *handlers, | |
| struct ipmi_smi_msg *smi_msg, int priority) | |
| { | |
| int run_to_completion = intf->run_to_completion; | |
| unsigned long flags = 0; | |
| if (!run_to_completion) | |
| spin_lock_irqsave(&intf->xmit_msgs_lock, flags); | |
| smi_msg = smi_add_send_msg(intf, smi_msg, priority); | |
| if (!run_to_completion) | |
| spin_unlock_irqrestore(&intf->xmit_msgs_lock, flags); | |
| if (smi_msg) | |
| handlers->sender(intf->send_info, smi_msg); | |
| } | |
| static bool is_maintenance_mode_cmd(struct kernel_ipmi_msg *msg) | |
| { | |
| return (((msg->netfn == IPMI_NETFN_APP_REQUEST) | |
| && ((msg->cmd == IPMI_COLD_RESET_CMD) | |
| || (msg->cmd == IPMI_WARM_RESET_CMD))) | |
| || (msg->netfn == IPMI_NETFN_FIRMWARE_REQUEST)); | |
| } | |
| static int i_ipmi_req_sysintf(struct ipmi_smi *intf, | |
| struct ipmi_addr *addr, | |
| long msgid, | |
| struct kernel_ipmi_msg *msg, | |
| struct ipmi_smi_msg *smi_msg, | |
| struct ipmi_recv_msg *recv_msg, | |
| int retries, | |
| unsigned int retry_time_ms) | |
| { | |
| struct ipmi_system_interface_addr *smi_addr; | |
| if (msg->netfn & 1) | |
| /* Responses are not allowed to the SMI. */ | |
| return -EINVAL; | |
| smi_addr = (struct ipmi_system_interface_addr *) addr; | |
| if (smi_addr->lun > 3) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| memcpy(&recv_msg->addr, smi_addr, sizeof(*smi_addr)); | |
| if ((msg->netfn == IPMI_NETFN_APP_REQUEST) | |
| && ((msg->cmd == IPMI_SEND_MSG_CMD) | |
| || (msg->cmd == IPMI_GET_MSG_CMD) | |
| || (msg->cmd == IPMI_READ_EVENT_MSG_BUFFER_CMD))) { | |
| /* | |
| * We don't let the user do these, since we manage | |
| * the sequence numbers. | |
| */ | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| if (is_maintenance_mode_cmd(msg)) { | |
| unsigned long flags; | |
| spin_lock_irqsave(&intf->maintenance_mode_lock, flags); | |
| intf->auto_maintenance_timeout | |
| = maintenance_mode_timeout_ms; | |
| if (!intf->maintenance_mode | |
| && !intf->maintenance_mode_enable) { | |
| intf->maintenance_mode_enable = true; | |
| maintenance_mode_update(intf); | |
| } | |
| spin_unlock_irqrestore(&intf->maintenance_mode_lock, | |
| flags); | |
| } | |
| if (msg->data_len + 2 > IPMI_MAX_MSG_LENGTH) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EMSGSIZE; | |
| } | |
| smi_msg->data[0] = (msg->netfn << 2) | (smi_addr->lun & 0x3); | |
| smi_msg->data[1] = msg->cmd; | |
| smi_msg->msgid = msgid; | |
| smi_msg->user_data = recv_msg; | |
| if (msg->data_len > 0) | |
| memcpy(&smi_msg->data[2], msg->data, msg->data_len); | |
| smi_msg->data_size = msg->data_len + 2; | |
| ipmi_inc_stat(intf, sent_local_commands); | |
| return 0; | |
| } | |
| static int i_ipmi_req_ipmb(struct ipmi_smi *intf, | |
| struct ipmi_addr *addr, | |
| long msgid, | |
| struct kernel_ipmi_msg *msg, | |
| struct ipmi_smi_msg *smi_msg, | |
| struct ipmi_recv_msg *recv_msg, | |
| unsigned char source_address, | |
| unsigned char source_lun, | |
| int retries, | |
| unsigned int retry_time_ms) | |
| { | |
| struct ipmi_ipmb_addr *ipmb_addr; | |
| unsigned char ipmb_seq; | |
| long seqid; | |
| int broadcast = 0; | |
| struct ipmi_channel *chans; | |
| int rv = 0; | |
| if (addr->channel >= IPMI_MAX_CHANNELS) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| chans = READ_ONCE(intf->channel_list)->c; | |
| if (chans[addr->channel].medium != IPMI_CHANNEL_MEDIUM_IPMB) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| if (addr->addr_type == IPMI_IPMB_BROADCAST_ADDR_TYPE) { | |
| /* | |
| * Broadcasts add a zero at the beginning of the | |
| * message, but otherwise is the same as an IPMB | |
| * address. | |
| */ | |
| addr->addr_type = IPMI_IPMB_ADDR_TYPE; | |
| broadcast = 1; | |
| retries = 0; /* Don't retry broadcasts. */ | |
| } | |
| /* | |
| * 9 for the header and 1 for the checksum, plus | |
| * possibly one for the broadcast. | |
| */ | |
| if ((msg->data_len + 10 + broadcast) > IPMI_MAX_MSG_LENGTH) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EMSGSIZE; | |
| } | |
| ipmb_addr = (struct ipmi_ipmb_addr *) addr; | |
| if (ipmb_addr->lun > 3) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| memcpy(&recv_msg->addr, ipmb_addr, sizeof(*ipmb_addr)); | |
| if (recv_msg->msg.netfn & 0x1) { | |
| /* | |
| * It's a response, so use the user's sequence | |
| * from msgid. | |
| */ | |
| ipmi_inc_stat(intf, sent_ipmb_responses); | |
| format_ipmb_msg(smi_msg, msg, ipmb_addr, msgid, | |
| msgid, broadcast, | |
| source_address, source_lun); | |
| /* | |
| * Save the receive message so we can use it | |
| * to deliver the response. | |
| */ | |
| smi_msg->user_data = recv_msg; | |
| } else { | |
| /* It's a command, so get a sequence for it. */ | |
| unsigned long flags; | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| if (is_maintenance_mode_cmd(msg)) | |
| intf->ipmb_maintenance_mode_timeout = | |
| maintenance_mode_timeout_ms; | |
| if (intf->ipmb_maintenance_mode_timeout && retry_time_ms == 0) | |
| /* Different default in maintenance mode */ | |
| retry_time_ms = default_maintenance_retry_ms; | |
| /* | |
| * Create a sequence number with a 1 second | |
| * timeout and 4 retries. | |
| */ | |
| rv = intf_next_seq(intf, | |
| recv_msg, | |
| retry_time_ms, | |
| retries, | |
| broadcast, | |
| &ipmb_seq, | |
| &seqid); | |
| if (rv) | |
| /* | |
| * We have used up all the sequence numbers, | |
| * probably, so abort. | |
| */ | |
| goto out_err; | |
| ipmi_inc_stat(intf, sent_ipmb_commands); | |
| /* | |
| * Store the sequence number in the message, | |
| * so that when the send message response | |
| * comes back we can start the timer. | |
| */ | |
| format_ipmb_msg(smi_msg, msg, ipmb_addr, | |
| STORE_SEQ_IN_MSGID(ipmb_seq, seqid), | |
| ipmb_seq, broadcast, | |
| source_address, source_lun); | |
| /* | |
| * Copy the message into the recv message data, so we | |
| * can retransmit it later if necessary. | |
| */ | |
| memcpy(recv_msg->msg_data, smi_msg->data, | |
| smi_msg->data_size); | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = smi_msg->data_size; | |
| /* | |
| * We don't unlock until here, because we need | |
| * to copy the completed message into the | |
| * recv_msg before we release the lock. | |
| * Otherwise, race conditions may bite us. I | |
| * know that's pretty paranoid, but I prefer | |
| * to be correct. | |
| */ | |
| out_err: | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| } | |
| return rv; | |
| } | |
| static int i_ipmi_req_ipmb_direct(struct ipmi_smi *intf, | |
| struct ipmi_addr *addr, | |
| long msgid, | |
| struct kernel_ipmi_msg *msg, | |
| struct ipmi_smi_msg *smi_msg, | |
| struct ipmi_recv_msg *recv_msg, | |
| unsigned char source_lun) | |
| { | |
| struct ipmi_ipmb_direct_addr *daddr; | |
| bool is_cmd = !(recv_msg->msg.netfn & 0x1); | |
| if (!(intf->handlers->flags & IPMI_SMI_CAN_HANDLE_IPMB_DIRECT)) | |
| return -EAFNOSUPPORT; | |
| /* Responses must have a completion code. */ | |
| if (!is_cmd && msg->data_len < 1) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| if ((msg->data_len + 4) > IPMI_MAX_MSG_LENGTH) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EMSGSIZE; | |
| } | |
| daddr = (struct ipmi_ipmb_direct_addr *) addr; | |
| if (daddr->rq_lun > 3 || daddr->rs_lun > 3) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| smi_msg->type = IPMI_SMI_MSG_TYPE_IPMB_DIRECT; | |
| smi_msg->msgid = msgid; | |
| if (is_cmd) { | |
| smi_msg->data[0] = msg->netfn << 2 | daddr->rs_lun; | |
| smi_msg->data[2] = recv_msg->msgid << 2 | daddr->rq_lun; | |
| } else { | |
| smi_msg->data[0] = msg->netfn << 2 | daddr->rq_lun; | |
| smi_msg->data[2] = recv_msg->msgid << 2 | daddr->rs_lun; | |
| } | |
| smi_msg->data[1] = daddr->slave_addr; | |
| smi_msg->data[3] = msg->cmd; | |
| memcpy(smi_msg->data + 4, msg->data, msg->data_len); | |
| smi_msg->data_size = msg->data_len + 4; | |
| smi_msg->user_data = recv_msg; | |
| return 0; | |
| } | |
| static int i_ipmi_req_lan(struct ipmi_smi *intf, | |
| struct ipmi_addr *addr, | |
| long msgid, | |
| struct kernel_ipmi_msg *msg, | |
| struct ipmi_smi_msg *smi_msg, | |
| struct ipmi_recv_msg *recv_msg, | |
| unsigned char source_lun, | |
| int retries, | |
| unsigned int retry_time_ms) | |
| { | |
| struct ipmi_lan_addr *lan_addr; | |
| unsigned char ipmb_seq; | |
| long seqid; | |
| struct ipmi_channel *chans; | |
| int rv = 0; | |
| if (addr->channel >= IPMI_MAX_CHANNELS) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| chans = READ_ONCE(intf->channel_list)->c; | |
| if ((chans[addr->channel].medium | |
| != IPMI_CHANNEL_MEDIUM_8023LAN) | |
| && (chans[addr->channel].medium | |
| != IPMI_CHANNEL_MEDIUM_ASYNC)) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| /* 11 for the header and 1 for the checksum. */ | |
| if ((msg->data_len + 12) > IPMI_MAX_MSG_LENGTH) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EMSGSIZE; | |
| } | |
| lan_addr = (struct ipmi_lan_addr *) addr; | |
| if (lan_addr->lun > 3) { | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| return -EINVAL; | |
| } | |
| memcpy(&recv_msg->addr, lan_addr, sizeof(*lan_addr)); | |
| if (recv_msg->msg.netfn & 0x1) { | |
| /* | |
| * It's a response, so use the user's sequence | |
| * from msgid. | |
| */ | |
| ipmi_inc_stat(intf, sent_lan_responses); | |
| format_lan_msg(smi_msg, msg, lan_addr, msgid, | |
| msgid, source_lun); | |
| /* | |
| * Save the receive message so we can use it | |
| * to deliver the response. | |
| */ | |
| smi_msg->user_data = recv_msg; | |
| } else { | |
| /* It's a command, so get a sequence for it. */ | |
| unsigned long flags; | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| /* | |
| * Create a sequence number with a 1 second | |
| * timeout and 4 retries. | |
| */ | |
| rv = intf_next_seq(intf, | |
| recv_msg, | |
| retry_time_ms, | |
| retries, | |
| 0, | |
| &ipmb_seq, | |
| &seqid); | |
| if (rv) | |
| /* | |
| * We have used up all the sequence numbers, | |
| * probably, so abort. | |
| */ | |
| goto out_err; | |
| ipmi_inc_stat(intf, sent_lan_commands); | |
| /* | |
| * Store the sequence number in the message, | |
| * so that when the send message response | |
| * comes back we can start the timer. | |
| */ | |
| format_lan_msg(smi_msg, msg, lan_addr, | |
| STORE_SEQ_IN_MSGID(ipmb_seq, seqid), | |
| ipmb_seq, source_lun); | |
| /* | |
| * Copy the message into the recv message data, so we | |
| * can retransmit it later if necessary. | |
| */ | |
| memcpy(recv_msg->msg_data, smi_msg->data, | |
| smi_msg->data_size); | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = smi_msg->data_size; | |
| /* | |
| * We don't unlock until here, because we need | |
| * to copy the completed message into the | |
| * recv_msg before we release the lock. | |
| * Otherwise, race conditions may bite us. I | |
| * know that's pretty paranoid, but I prefer | |
| * to be correct. | |
| */ | |
| out_err: | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| } | |
| return rv; | |
| } | |
| /* | |
| * Separate from ipmi_request so that the user does not have to be | |
| * supplied in certain circumstances (mainly at panic time). If | |
| * messages are supplied, they will be freed, even if an error | |
| * occurs. | |
| */ | |
| static int i_ipmi_request(struct ipmi_user *user, | |
| struct ipmi_smi *intf, | |
| struct ipmi_addr *addr, | |
| long msgid, | |
| struct kernel_ipmi_msg *msg, | |
| void *user_msg_data, | |
| void *supplied_smi, | |
| struct ipmi_recv_msg *supplied_recv, | |
| int priority, | |
| unsigned char source_address, | |
| unsigned char source_lun, | |
| int retries, | |
| unsigned int retry_time_ms) | |
| { | |
| struct ipmi_smi_msg *smi_msg; | |
| struct ipmi_recv_msg *recv_msg; | |
| int rv = 0; | |
| if (user) { | |
| if (atomic_add_return(1, &user->nr_msgs) > max_msgs_per_user) { | |
| /* Decrement will happen at the end of the routine. */ | |
| rv = -EBUSY; | |
| goto out; | |
| } | |
| } | |
| if (supplied_recv) | |
| recv_msg = supplied_recv; | |
| else { | |
| recv_msg = ipmi_alloc_recv_msg(); | |
| if (recv_msg == NULL) { | |
| rv = -ENOMEM; | |
| goto out; | |
| } | |
| } | |
| recv_msg->user_msg_data = user_msg_data; | |
| if (supplied_smi) | |
| smi_msg = supplied_smi; | |
| else { | |
| smi_msg = ipmi_alloc_smi_msg(); | |
| if (smi_msg == NULL) { | |
| if (!supplied_recv) | |
| ipmi_free_recv_msg(recv_msg); | |
| rv = -ENOMEM; | |
| goto out; | |
| } | |
| } | |
| rcu_read_lock(); | |
| if (intf->in_shutdown) { | |
| rv = -ENODEV; | |
| goto out_err; | |
| } | |
| recv_msg->user = user; | |
| if (user) | |
| /* The put happens when the message is freed. */ | |
| kref_get(&user->refcount); | |
| recv_msg->msgid = msgid; | |
| /* | |
| * Store the message to send in the receive message so timeout | |
| * responses can get the proper response data. | |
| */ | |
| recv_msg->msg = *msg; | |
| if (addr->addr_type == IPMI_SYSTEM_INTERFACE_ADDR_TYPE) { | |
| rv = i_ipmi_req_sysintf(intf, addr, msgid, msg, smi_msg, | |
| recv_msg, retries, retry_time_ms); | |
| } else if (is_ipmb_addr(addr) || is_ipmb_bcast_addr(addr)) { | |
| rv = i_ipmi_req_ipmb(intf, addr, msgid, msg, smi_msg, recv_msg, | |
| source_address, source_lun, | |
| retries, retry_time_ms); | |
| } else if (is_ipmb_direct_addr(addr)) { | |
| rv = i_ipmi_req_ipmb_direct(intf, addr, msgid, msg, smi_msg, | |
| recv_msg, source_lun); | |
| } else if (is_lan_addr(addr)) { | |
| rv = i_ipmi_req_lan(intf, addr, msgid, msg, smi_msg, recv_msg, | |
| source_lun, retries, retry_time_ms); | |
| } else { | |
| /* Unknown address type. */ | |
| ipmi_inc_stat(intf, sent_invalid_commands); | |
| rv = -EINVAL; | |
| } | |
| if (rv) { | |
| out_err: | |
| ipmi_free_smi_msg(smi_msg); | |
| ipmi_free_recv_msg(recv_msg); | |
| } else { | |
| dev_dbg(intf->si_dev, "Send: %*ph\n", | |
| smi_msg->data_size, smi_msg->data); | |
| smi_send(intf, intf->handlers, smi_msg, priority); | |
| } | |
| rcu_read_unlock(); | |
| out: | |
| if (rv && user) | |
| atomic_dec(&user->nr_msgs); | |
| return rv; | |
| } | |
| static int check_addr(struct ipmi_smi *intf, | |
| struct ipmi_addr *addr, | |
| unsigned char *saddr, | |
| unsigned char *lun) | |
| { | |
| if (addr->channel >= IPMI_MAX_CHANNELS) | |
| return -EINVAL; | |
| addr->channel = array_index_nospec(addr->channel, IPMI_MAX_CHANNELS); | |
| *lun = intf->addrinfo[addr->channel].lun; | |
| *saddr = intf->addrinfo[addr->channel].address; | |
| return 0; | |
| } | |
| int ipmi_request_settime(struct ipmi_user *user, | |
| struct ipmi_addr *addr, | |
| long msgid, | |
| struct kernel_ipmi_msg *msg, | |
| void *user_msg_data, | |
| int priority, | |
| int retries, | |
| unsigned int retry_time_ms) | |
| { | |
| unsigned char saddr = 0, lun = 0; | |
| int rv, index; | |
| if (!user) | |
| return -EINVAL; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| rv = check_addr(user->intf, addr, &saddr, &lun); | |
| if (!rv) | |
| rv = i_ipmi_request(user, | |
| user->intf, | |
| addr, | |
| msgid, | |
| msg, | |
| user_msg_data, | |
| NULL, NULL, | |
| priority, | |
| saddr, | |
| lun, | |
| retries, | |
| retry_time_ms); | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_request_settime); | |
| int ipmi_request_supply_msgs(struct ipmi_user *user, | |
| struct ipmi_addr *addr, | |
| long msgid, | |
| struct kernel_ipmi_msg *msg, | |
| void *user_msg_data, | |
| void *supplied_smi, | |
| struct ipmi_recv_msg *supplied_recv, | |
| int priority) | |
| { | |
| unsigned char saddr = 0, lun = 0; | |
| int rv, index; | |
| if (!user) | |
| return -EINVAL; | |
| user = acquire_ipmi_user(user, &index); | |
| if (!user) | |
| return -ENODEV; | |
| rv = check_addr(user->intf, addr, &saddr, &lun); | |
| if (!rv) | |
| rv = i_ipmi_request(user, | |
| user->intf, | |
| addr, | |
| msgid, | |
| msg, | |
| user_msg_data, | |
| supplied_smi, | |
| supplied_recv, | |
| priority, | |
| saddr, | |
| lun, | |
| -1, 0); | |
| release_ipmi_user(user, index); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_request_supply_msgs); | |
| static void bmc_device_id_handler(struct ipmi_smi *intf, | |
| struct ipmi_recv_msg *msg) | |
| { | |
| int rv; | |
| if ((msg->addr.addr_type != IPMI_SYSTEM_INTERFACE_ADDR_TYPE) | |
| || (msg->msg.netfn != IPMI_NETFN_APP_RESPONSE) | |
| || (msg->msg.cmd != IPMI_GET_DEVICE_ID_CMD)) { | |
| dev_warn(intf->si_dev, | |
| "invalid device_id msg: addr_type=%d netfn=%x cmd=%x\n", | |
| msg->addr.addr_type, msg->msg.netfn, msg->msg.cmd); | |
| return; | |
| } | |
| if (msg->msg.data[0]) { | |
| dev_warn(intf->si_dev, "device id fetch failed: 0x%2.2x\n", | |
| msg->msg.data[0]); | |
| intf->bmc->dyn_id_set = 0; | |
| goto out; | |
| } | |
| rv = ipmi_demangle_device_id(msg->msg.netfn, msg->msg.cmd, | |
| msg->msg.data, msg->msg.data_len, &intf->bmc->fetch_id); | |
| if (rv) { | |
| dev_warn(intf->si_dev, "device id demangle failed: %d\n", rv); | |
| /* record completion code when error */ | |
| intf->bmc->cc = msg->msg.data[0]; | |
| intf->bmc->dyn_id_set = 0; | |
| } else { | |
| /* | |
| * Make sure the id data is available before setting | |
| * dyn_id_set. | |
| */ | |
| smp_wmb(); | |
| intf->bmc->dyn_id_set = 1; | |
| } | |
| out: | |
| wake_up(&intf->waitq); | |
| } | |
| static int | |
| send_get_device_id_cmd(struct ipmi_smi *intf) | |
| { | |
| struct ipmi_system_interface_addr si; | |
| struct kernel_ipmi_msg msg; | |
| si.addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| si.channel = IPMI_BMC_CHANNEL; | |
| si.lun = 0; | |
| msg.netfn = IPMI_NETFN_APP_REQUEST; | |
| msg.cmd = IPMI_GET_DEVICE_ID_CMD; | |
| msg.data = NULL; | |
| msg.data_len = 0; | |
| return i_ipmi_request(NULL, | |
| intf, | |
| (struct ipmi_addr *) &si, | |
| 0, | |
| &msg, | |
| intf, | |
| NULL, | |
| NULL, | |
| 0, | |
| intf->addrinfo[0].address, | |
| intf->addrinfo[0].lun, | |
| -1, 0); | |
| } | |
| static int __get_device_id(struct ipmi_smi *intf, struct bmc_device *bmc) | |
| { | |
| int rv; | |
| unsigned int retry_count = 0; | |
| intf->null_user_handler = bmc_device_id_handler; | |
| retry: | |
| bmc->cc = 0; | |
| bmc->dyn_id_set = 2; | |
| rv = send_get_device_id_cmd(intf); | |
| if (rv) | |
| goto out_reset_handler; | |
| wait_event(intf->waitq, bmc->dyn_id_set != 2); | |
| if (!bmc->dyn_id_set) { | |
| if (bmc->cc != IPMI_CC_NO_ERROR && | |
| ++retry_count <= GET_DEVICE_ID_MAX_RETRY) { | |
| msleep(500); | |
| dev_warn(intf->si_dev, | |
| "BMC returned 0x%2.2x, retry get bmc device id\n", | |
| bmc->cc); | |
| goto retry; | |
| } | |
| rv = -EIO; /* Something went wrong in the fetch. */ | |
| } | |
| /* dyn_id_set makes the id data available. */ | |
| smp_rmb(); | |
| out_reset_handler: | |
| intf->null_user_handler = NULL; | |
| return rv; | |
| } | |
| /* | |
| * Fetch the device id for the bmc/interface. You must pass in either | |
| * bmc or intf, this code will get the other one. If the data has | |
| * been recently fetched, this will just use the cached data. Otherwise | |
| * it will run a new fetch. | |
| * | |
| * Except for the first time this is called (in ipmi_add_smi()), | |
| * this will always return good data; | |
| */ | |
| static int __bmc_get_device_id(struct ipmi_smi *intf, struct bmc_device *bmc, | |
| struct ipmi_device_id *id, | |
| bool *guid_set, guid_t *guid, int intf_num) | |
| { | |
| int rv = 0; | |
| int prev_dyn_id_set, prev_guid_set; | |
| bool intf_set = intf != NULL; | |
| if (!intf) { | |
| mutex_lock(&bmc->dyn_mutex); | |
| retry_bmc_lock: | |
| if (list_empty(&bmc->intfs)) { | |
| mutex_unlock(&bmc->dyn_mutex); | |
| return -ENOENT; | |
| } | |
| intf = list_first_entry(&bmc->intfs, struct ipmi_smi, | |
| bmc_link); | |
| kref_get(&intf->refcount); | |
| mutex_unlock(&bmc->dyn_mutex); | |
| mutex_lock(&intf->bmc_reg_mutex); | |
| mutex_lock(&bmc->dyn_mutex); | |
| if (intf != list_first_entry(&bmc->intfs, struct ipmi_smi, | |
| bmc_link)) { | |
| mutex_unlock(&intf->bmc_reg_mutex); | |
| kref_put(&intf->refcount, intf_free); | |
| goto retry_bmc_lock; | |
| } | |
| } else { | |
| mutex_lock(&intf->bmc_reg_mutex); | |
| bmc = intf->bmc; | |
| mutex_lock(&bmc->dyn_mutex); | |
| kref_get(&intf->refcount); | |
| } | |
| /* If we have a valid and current ID, just return that. */ | |
| if (intf->in_bmc_register || | |
| (bmc->dyn_id_set && time_is_after_jiffies(bmc->dyn_id_expiry))) | |
| goto out_noprocessing; | |
| prev_guid_set = bmc->dyn_guid_set; | |
| __get_guid(intf); | |
| prev_dyn_id_set = bmc->dyn_id_set; | |
| rv = __get_device_id(intf, bmc); | |
| if (rv) | |
| goto out; | |
| /* | |
| * The guid, device id, manufacturer id, and product id should | |
| * not change on a BMC. If it does we have to do some dancing. | |
| */ | |
| if (!intf->bmc_registered | |
| || (!prev_guid_set && bmc->dyn_guid_set) | |
| || (!prev_dyn_id_set && bmc->dyn_id_set) | |
| || (prev_guid_set && bmc->dyn_guid_set | |
| && !guid_equal(&bmc->guid, &bmc->fetch_guid)) | |
| || bmc->id.device_id != bmc->fetch_id.device_id | |
| || bmc->id.manufacturer_id != bmc->fetch_id.manufacturer_id | |
| || bmc->id.product_id != bmc->fetch_id.product_id) { | |
| struct ipmi_device_id id = bmc->fetch_id; | |
| int guid_set = bmc->dyn_guid_set; | |
| guid_t guid; | |
| guid = bmc->fetch_guid; | |
| mutex_unlock(&bmc->dyn_mutex); | |
| __ipmi_bmc_unregister(intf); | |
| /* Fill in the temporary BMC for good measure. */ | |
| intf->bmc->id = id; | |
| intf->bmc->dyn_guid_set = guid_set; | |
| intf->bmc->guid = guid; | |
| if (__ipmi_bmc_register(intf, &id, guid_set, &guid, intf_num)) | |
| need_waiter(intf); /* Retry later on an error. */ | |
| else | |
| __scan_channels(intf, &id); | |
| if (!intf_set) { | |
| /* | |
| * We weren't given the interface on the | |
| * command line, so restart the operation on | |
| * the next interface for the BMC. | |
| */ | |
| mutex_unlock(&intf->bmc_reg_mutex); | |
| mutex_lock(&bmc->dyn_mutex); | |
| goto retry_bmc_lock; | |
| } | |
| /* We have a new BMC, set it up. */ | |
| bmc = intf->bmc; | |
| mutex_lock(&bmc->dyn_mutex); | |
| goto out_noprocessing; | |
| } else if (memcmp(&bmc->fetch_id, &bmc->id, sizeof(bmc->id))) | |
| /* Version info changes, scan the channels again. */ | |
| __scan_channels(intf, &bmc->fetch_id); | |
| bmc->dyn_id_expiry = jiffies + IPMI_DYN_DEV_ID_EXPIRY; | |
| out: | |
| if (rv && prev_dyn_id_set) { | |
| rv = 0; /* Ignore failures if we have previous data. */ | |
| bmc->dyn_id_set = prev_dyn_id_set; | |
| } | |
| if (!rv) { | |
| bmc->id = bmc->fetch_id; | |
| if (bmc->dyn_guid_set) | |
| bmc->guid = bmc->fetch_guid; | |
| else if (prev_guid_set) | |
| /* | |
| * The guid used to be valid and it failed to fetch, | |
| * just use the cached value. | |
| */ | |
| bmc->dyn_guid_set = prev_guid_set; | |
| } | |
| out_noprocessing: | |
| if (!rv) { | |
| if (id) | |
| *id = bmc->id; | |
| if (guid_set) | |
| *guid_set = bmc->dyn_guid_set; | |
| if (guid && bmc->dyn_guid_set) | |
| *guid = bmc->guid; | |
| } | |
| mutex_unlock(&bmc->dyn_mutex); | |
| mutex_unlock(&intf->bmc_reg_mutex); | |
| kref_put(&intf->refcount, intf_free); | |
| return rv; | |
| } | |
| static int bmc_get_device_id(struct ipmi_smi *intf, struct bmc_device *bmc, | |
| struct ipmi_device_id *id, | |
| bool *guid_set, guid_t *guid) | |
| { | |
| return __bmc_get_device_id(intf, bmc, id, guid_set, guid, -1); | |
| } | |
| static ssize_t device_id_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "%u\n", id.device_id); | |
| } | |
| static DEVICE_ATTR_RO(device_id); | |
| static ssize_t provides_device_sdrs_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "%u\n", (id.device_revision & 0x80) >> 7); | |
| } | |
| static DEVICE_ATTR_RO(provides_device_sdrs); | |
| static ssize_t revision_show(struct device *dev, struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "%u\n", id.device_revision & 0x0F); | |
| } | |
| static DEVICE_ATTR_RO(revision); | |
| static ssize_t firmware_revision_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "%u.%x\n", id.firmware_revision_1, | |
| id.firmware_revision_2); | |
| } | |
| static DEVICE_ATTR_RO(firmware_revision); | |
| static ssize_t ipmi_version_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "%u.%u\n", | |
| ipmi_version_major(&id), | |
| ipmi_version_minor(&id)); | |
| } | |
| static DEVICE_ATTR_RO(ipmi_version); | |
| static ssize_t add_dev_support_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "0x%02x\n", id.additional_device_support); | |
| } | |
| static DEVICE_ATTR(additional_device_support, S_IRUGO, add_dev_support_show, | |
| NULL); | |
| static ssize_t manufacturer_id_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "0x%6.6x\n", id.manufacturer_id); | |
| } | |
| static DEVICE_ATTR_RO(manufacturer_id); | |
| static ssize_t product_id_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "0x%4.4x\n", id.product_id); | |
| } | |
| static DEVICE_ATTR_RO(product_id); | |
| static ssize_t aux_firmware_rev_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| struct ipmi_device_id id; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| if (rv) | |
| return rv; | |
| return sysfs_emit(buf, "0x%02x 0x%02x 0x%02x 0x%02x\n", | |
| id.aux_firmware_revision[3], | |
| id.aux_firmware_revision[2], | |
| id.aux_firmware_revision[1], | |
| id.aux_firmware_revision[0]); | |
| } | |
| static DEVICE_ATTR(aux_firmware_revision, S_IRUGO, aux_firmware_rev_show, NULL); | |
| static ssize_t guid_show(struct device *dev, struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| bool guid_set; | |
| guid_t guid; | |
| int rv; | |
| rv = bmc_get_device_id(NULL, bmc, NULL, &guid_set, &guid); | |
| if (rv) | |
| return rv; | |
| if (!guid_set) | |
| return -ENOENT; | |
| return sysfs_emit(buf, "%pUl\n", &guid); | |
| } | |
| static DEVICE_ATTR_RO(guid); | |
| static struct attribute *bmc_dev_attrs[] = { | |
| &dev_attr_device_id.attr, | |
| &dev_attr_provides_device_sdrs.attr, | |
| &dev_attr_revision.attr, | |
| &dev_attr_firmware_revision.attr, | |
| &dev_attr_ipmi_version.attr, | |
| &dev_attr_additional_device_support.attr, | |
| &dev_attr_manufacturer_id.attr, | |
| &dev_attr_product_id.attr, | |
| &dev_attr_aux_firmware_revision.attr, | |
| &dev_attr_guid.attr, | |
| NULL | |
| }; | |
| static umode_t bmc_dev_attr_is_visible(struct kobject *kobj, | |
| struct attribute *attr, int idx) | |
| { | |
| struct device *dev = kobj_to_dev(kobj); | |
| struct bmc_device *bmc = to_bmc_device(dev); | |
| umode_t mode = attr->mode; | |
| int rv; | |
| if (attr == &dev_attr_aux_firmware_revision.attr) { | |
| struct ipmi_device_id id; | |
| rv = bmc_get_device_id(NULL, bmc, &id, NULL, NULL); | |
| return (!rv && id.aux_firmware_revision_set) ? mode : 0; | |
| } | |
| if (attr == &dev_attr_guid.attr) { | |
| bool guid_set; | |
| rv = bmc_get_device_id(NULL, bmc, NULL, &guid_set, NULL); | |
| return (!rv && guid_set) ? mode : 0; | |
| } | |
| return mode; | |
| } | |
| static const struct attribute_group bmc_dev_attr_group = { | |
| .attrs = bmc_dev_attrs, | |
| .is_visible = bmc_dev_attr_is_visible, | |
| }; | |
| static const struct attribute_group *bmc_dev_attr_groups[] = { | |
| &bmc_dev_attr_group, | |
| NULL | |
| }; | |
| static const struct device_type bmc_device_type = { | |
| .groups = bmc_dev_attr_groups, | |
| }; | |
| static int __find_bmc_guid(struct device *dev, const void *data) | |
| { | |
| const guid_t *guid = data; | |
| struct bmc_device *bmc; | |
| int rv; | |
| if (dev->type != &bmc_device_type) | |
| return 0; | |
| bmc = to_bmc_device(dev); | |
| rv = bmc->dyn_guid_set && guid_equal(&bmc->guid, guid); | |
| if (rv) | |
| rv = kref_get_unless_zero(&bmc->usecount); | |
| return rv; | |
| } | |
| /* | |
| * Returns with the bmc's usecount incremented, if it is non-NULL. | |
| */ | |
| static struct bmc_device *ipmi_find_bmc_guid(struct device_driver *drv, | |
| guid_t *guid) | |
| { | |
| struct device *dev; | |
| struct bmc_device *bmc = NULL; | |
| dev = driver_find_device(drv, NULL, guid, __find_bmc_guid); | |
| if (dev) { | |
| bmc = to_bmc_device(dev); | |
| put_device(dev); | |
| } | |
| return bmc; | |
| } | |
| struct prod_dev_id { | |
| unsigned int product_id; | |
| unsigned char device_id; | |
| }; | |
| static int __find_bmc_prod_dev_id(struct device *dev, const void *data) | |
| { | |
| const struct prod_dev_id *cid = data; | |
| struct bmc_device *bmc; | |
| int rv; | |
| if (dev->type != &bmc_device_type) | |
| return 0; | |
| bmc = to_bmc_device(dev); | |
| rv = (bmc->id.product_id == cid->product_id | |
| && bmc->id.device_id == cid->device_id); | |
| if (rv) | |
| rv = kref_get_unless_zero(&bmc->usecount); | |
| return rv; | |
| } | |
| /* | |
| * Returns with the bmc's usecount incremented, if it is non-NULL. | |
| */ | |
| static struct bmc_device *ipmi_find_bmc_prod_dev_id( | |
| struct device_driver *drv, | |
| unsigned int product_id, unsigned char device_id) | |
| { | |
| struct prod_dev_id id = { | |
| .product_id = product_id, | |
| .device_id = device_id, | |
| }; | |
| struct device *dev; | |
| struct bmc_device *bmc = NULL; | |
| dev = driver_find_device(drv, NULL, &id, __find_bmc_prod_dev_id); | |
| if (dev) { | |
| bmc = to_bmc_device(dev); | |
| put_device(dev); | |
| } | |
| return bmc; | |
| } | |
| static DEFINE_IDA(ipmi_bmc_ida); | |
| static void | |
| release_bmc_device(struct device *dev) | |
| { | |
| kfree(to_bmc_device(dev)); | |
| } | |
| static void cleanup_bmc_work(struct work_struct *work) | |
| { | |
| struct bmc_device *bmc = container_of(work, struct bmc_device, | |
| remove_work); | |
| int id = bmc->pdev.id; /* Unregister overwrites id */ | |
| platform_device_unregister(&bmc->pdev); | |
| ida_free(&ipmi_bmc_ida, id); | |
| } | |
| static void | |
| cleanup_bmc_device(struct kref *ref) | |
| { | |
| struct bmc_device *bmc = container_of(ref, struct bmc_device, usecount); | |
| /* | |
| * Remove the platform device in a work queue to avoid issues | |
| * with removing the device attributes while reading a device | |
| * attribute. | |
| */ | |
| queue_work(remove_work_wq, &bmc->remove_work); | |
| } | |
| /* | |
| * Must be called with intf->bmc_reg_mutex held. | |
| */ | |
| static void __ipmi_bmc_unregister(struct ipmi_smi *intf) | |
| { | |
| struct bmc_device *bmc = intf->bmc; | |
| if (!intf->bmc_registered) | |
| return; | |
| sysfs_remove_link(&intf->si_dev->kobj, "bmc"); | |
| sysfs_remove_link(&bmc->pdev.dev.kobj, intf->my_dev_name); | |
| kfree(intf->my_dev_name); | |
| intf->my_dev_name = NULL; | |
| mutex_lock(&bmc->dyn_mutex); | |
| list_del(&intf->bmc_link); | |
| mutex_unlock(&bmc->dyn_mutex); | |
| intf->bmc = &intf->tmp_bmc; | |
| kref_put(&bmc->usecount, cleanup_bmc_device); | |
| intf->bmc_registered = false; | |
| } | |
| static void ipmi_bmc_unregister(struct ipmi_smi *intf) | |
| { | |
| mutex_lock(&intf->bmc_reg_mutex); | |
| __ipmi_bmc_unregister(intf); | |
| mutex_unlock(&intf->bmc_reg_mutex); | |
| } | |
| /* | |
| * Must be called with intf->bmc_reg_mutex held. | |
| */ | |
| static int __ipmi_bmc_register(struct ipmi_smi *intf, | |
| struct ipmi_device_id *id, | |
| bool guid_set, guid_t *guid, int intf_num) | |
| { | |
| int rv; | |
| struct bmc_device *bmc; | |
| struct bmc_device *old_bmc; | |
| /* | |
| * platform_device_register() can cause bmc_reg_mutex to | |
| * be claimed because of the is_visible functions of | |
| * the attributes. Eliminate possible recursion and | |
| * release the lock. | |
| */ | |
| intf->in_bmc_register = true; | |
| mutex_unlock(&intf->bmc_reg_mutex); | |
| /* | |
| * Try to find if there is an bmc_device struct | |
| * representing the interfaced BMC already | |
| */ | |
| mutex_lock(&ipmidriver_mutex); | |
| if (guid_set) | |
| old_bmc = ipmi_find_bmc_guid(&ipmidriver.driver, guid); | |
| else | |
| old_bmc = ipmi_find_bmc_prod_dev_id(&ipmidriver.driver, | |
| id->product_id, | |
| id->device_id); | |
| /* | |
| * If there is already an bmc_device, free the new one, | |
| * otherwise register the new BMC device | |
| */ | |
| if (old_bmc) { | |
| bmc = old_bmc; | |
| /* | |
| * Note: old_bmc already has usecount incremented by | |
| * the BMC find functions. | |
| */ | |
| intf->bmc = old_bmc; | |
| mutex_lock(&bmc->dyn_mutex); | |
| list_add_tail(&intf->bmc_link, &bmc->intfs); | |
| mutex_unlock(&bmc->dyn_mutex); | |
| dev_info(intf->si_dev, | |
| "interfacing existing BMC (man_id: 0x%6.6x, prod_id: 0x%4.4x, dev_id: 0x%2.2x)\n", | |
| bmc->id.manufacturer_id, | |
| bmc->id.product_id, | |
| bmc->id.device_id); | |
| } else { | |
| bmc = kzalloc(sizeof(*bmc), GFP_KERNEL); | |
| if (!bmc) { | |
| rv = -ENOMEM; | |
| goto out; | |
| } | |
| INIT_LIST_HEAD(&bmc->intfs); | |
| mutex_init(&bmc->dyn_mutex); | |
| INIT_WORK(&bmc->remove_work, cleanup_bmc_work); | |
| bmc->id = *id; | |
| bmc->dyn_id_set = 1; | |
| bmc->dyn_guid_set = guid_set; | |
| bmc->guid = *guid; | |
| bmc->dyn_id_expiry = jiffies + IPMI_DYN_DEV_ID_EXPIRY; | |
| bmc->pdev.name = "ipmi_bmc"; | |
| rv = ida_alloc(&ipmi_bmc_ida, GFP_KERNEL); | |
| if (rv < 0) { | |
| kfree(bmc); | |
| goto out; | |
| } | |
| bmc->pdev.dev.driver = &ipmidriver.driver; | |
| bmc->pdev.id = rv; | |
| bmc->pdev.dev.release = release_bmc_device; | |
| bmc->pdev.dev.type = &bmc_device_type; | |
| kref_init(&bmc->usecount); | |
| intf->bmc = bmc; | |
| mutex_lock(&bmc->dyn_mutex); | |
| list_add_tail(&intf->bmc_link, &bmc->intfs); | |
| mutex_unlock(&bmc->dyn_mutex); | |
| rv = platform_device_register(&bmc->pdev); | |
| if (rv) { | |
| dev_err(intf->si_dev, | |
| "Unable to register bmc device: %d\n", | |
| rv); | |
| goto out_list_del; | |
| } | |
| dev_info(intf->si_dev, | |
| "Found new BMC (man_id: 0x%6.6x, prod_id: 0x%4.4x, dev_id: 0x%2.2x)\n", | |
| bmc->id.manufacturer_id, | |
| bmc->id.product_id, | |
| bmc->id.device_id); | |
| } | |
| /* | |
| * create symlink from system interface device to bmc device | |
| * and back. | |
| */ | |
| rv = sysfs_create_link(&intf->si_dev->kobj, &bmc->pdev.dev.kobj, "bmc"); | |
| if (rv) { | |
| dev_err(intf->si_dev, "Unable to create bmc symlink: %d\n", rv); | |
| goto out_put_bmc; | |
| } | |
| if (intf_num == -1) | |
| intf_num = intf->intf_num; | |
| intf->my_dev_name = kasprintf(GFP_KERNEL, "ipmi%d", intf_num); | |
| if (!intf->my_dev_name) { | |
| rv = -ENOMEM; | |
| dev_err(intf->si_dev, "Unable to allocate link from BMC: %d\n", | |
| rv); | |
| goto out_unlink1; | |
| } | |
| rv = sysfs_create_link(&bmc->pdev.dev.kobj, &intf->si_dev->kobj, | |
| intf->my_dev_name); | |
| if (rv) { | |
| dev_err(intf->si_dev, "Unable to create symlink to bmc: %d\n", | |
| rv); | |
| goto out_free_my_dev_name; | |
| } | |
| intf->bmc_registered = true; | |
| out: | |
| mutex_unlock(&ipmidriver_mutex); | |
| mutex_lock(&intf->bmc_reg_mutex); | |
| intf->in_bmc_register = false; | |
| return rv; | |
| out_free_my_dev_name: | |
| kfree(intf->my_dev_name); | |
| intf->my_dev_name = NULL; | |
| out_unlink1: | |
| sysfs_remove_link(&intf->si_dev->kobj, "bmc"); | |
| out_put_bmc: | |
| mutex_lock(&bmc->dyn_mutex); | |
| list_del(&intf->bmc_link); | |
| mutex_unlock(&bmc->dyn_mutex); | |
| intf->bmc = &intf->tmp_bmc; | |
| kref_put(&bmc->usecount, cleanup_bmc_device); | |
| goto out; | |
| out_list_del: | |
| mutex_lock(&bmc->dyn_mutex); | |
| list_del(&intf->bmc_link); | |
| mutex_unlock(&bmc->dyn_mutex); | |
| intf->bmc = &intf->tmp_bmc; | |
| put_device(&bmc->pdev.dev); | |
| goto out; | |
| } | |
| static int | |
| send_guid_cmd(struct ipmi_smi *intf, int chan) | |
| { | |
| struct kernel_ipmi_msg msg; | |
| struct ipmi_system_interface_addr si; | |
| si.addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| si.channel = IPMI_BMC_CHANNEL; | |
| si.lun = 0; | |
| msg.netfn = IPMI_NETFN_APP_REQUEST; | |
| msg.cmd = IPMI_GET_DEVICE_GUID_CMD; | |
| msg.data = NULL; | |
| msg.data_len = 0; | |
| return i_ipmi_request(NULL, | |
| intf, | |
| (struct ipmi_addr *) &si, | |
| 0, | |
| &msg, | |
| intf, | |
| NULL, | |
| NULL, | |
| 0, | |
| intf->addrinfo[0].address, | |
| intf->addrinfo[0].lun, | |
| -1, 0); | |
| } | |
| static void guid_handler(struct ipmi_smi *intf, struct ipmi_recv_msg *msg) | |
| { | |
| struct bmc_device *bmc = intf->bmc; | |
| if ((msg->addr.addr_type != IPMI_SYSTEM_INTERFACE_ADDR_TYPE) | |
| || (msg->msg.netfn != IPMI_NETFN_APP_RESPONSE) | |
| || (msg->msg.cmd != IPMI_GET_DEVICE_GUID_CMD)) | |
| /* Not for me */ | |
| return; | |
| if (msg->msg.data[0] != 0) { | |
| /* Error from getting the GUID, the BMC doesn't have one. */ | |
| bmc->dyn_guid_set = 0; | |
| goto out; | |
| } | |
| if (msg->msg.data_len < UUID_SIZE + 1) { | |
| bmc->dyn_guid_set = 0; | |
| dev_warn(intf->si_dev, | |
| "The GUID response from the BMC was too short, it was %d but should have been %d. Assuming GUID is not available.\n", | |
| msg->msg.data_len, UUID_SIZE + 1); | |
| goto out; | |
| } | |
| import_guid(&bmc->fetch_guid, msg->msg.data + 1); | |
| /* | |
| * Make sure the guid data is available before setting | |
| * dyn_guid_set. | |
| */ | |
| smp_wmb(); | |
| bmc->dyn_guid_set = 1; | |
| out: | |
| wake_up(&intf->waitq); | |
| } | |
| static void __get_guid(struct ipmi_smi *intf) | |
| { | |
| int rv; | |
| struct bmc_device *bmc = intf->bmc; | |
| bmc->dyn_guid_set = 2; | |
| intf->null_user_handler = guid_handler; | |
| rv = send_guid_cmd(intf, 0); | |
| if (rv) | |
| /* Send failed, no GUID available. */ | |
| bmc->dyn_guid_set = 0; | |
| else | |
| wait_event(intf->waitq, bmc->dyn_guid_set != 2); | |
| /* dyn_guid_set makes the guid data available. */ | |
| smp_rmb(); | |
| intf->null_user_handler = NULL; | |
| } | |
| static int | |
| send_channel_info_cmd(struct ipmi_smi *intf, int chan) | |
| { | |
| struct kernel_ipmi_msg msg; | |
| unsigned char data[1]; | |
| struct ipmi_system_interface_addr si; | |
| si.addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| si.channel = IPMI_BMC_CHANNEL; | |
| si.lun = 0; | |
| msg.netfn = IPMI_NETFN_APP_REQUEST; | |
| msg.cmd = IPMI_GET_CHANNEL_INFO_CMD; | |
| msg.data = data; | |
| msg.data_len = 1; | |
| data[0] = chan; | |
| return i_ipmi_request(NULL, | |
| intf, | |
| (struct ipmi_addr *) &si, | |
| 0, | |
| &msg, | |
| intf, | |
| NULL, | |
| NULL, | |
| 0, | |
| intf->addrinfo[0].address, | |
| intf->addrinfo[0].lun, | |
| -1, 0); | |
| } | |
| static void | |
| channel_handler(struct ipmi_smi *intf, struct ipmi_recv_msg *msg) | |
| { | |
| int rv = 0; | |
| int ch; | |
| unsigned int set = intf->curr_working_cset; | |
| struct ipmi_channel *chans; | |
| if ((msg->addr.addr_type == IPMI_SYSTEM_INTERFACE_ADDR_TYPE) | |
| && (msg->msg.netfn == IPMI_NETFN_APP_RESPONSE) | |
| && (msg->msg.cmd == IPMI_GET_CHANNEL_INFO_CMD)) { | |
| /* It's the one we want */ | |
| if (msg->msg.data[0] != 0) { | |
| /* Got an error from the channel, just go on. */ | |
| if (msg->msg.data[0] == IPMI_INVALID_COMMAND_ERR) { | |
| /* | |
| * If the MC does not support this | |
| * command, that is legal. We just | |
| * assume it has one IPMB at channel | |
| * zero. | |
| */ | |
| intf->wchannels[set].c[0].medium | |
| = IPMI_CHANNEL_MEDIUM_IPMB; | |
| intf->wchannels[set].c[0].protocol | |
| = IPMI_CHANNEL_PROTOCOL_IPMB; | |
| intf->channel_list = intf->wchannels + set; | |
| intf->channels_ready = true; | |
| wake_up(&intf->waitq); | |
| goto out; | |
| } | |
| goto next_channel; | |
| } | |
| if (msg->msg.data_len < 4) { | |
| /* Message not big enough, just go on. */ | |
| goto next_channel; | |
| } | |
| ch = intf->curr_channel; | |
| chans = intf->wchannels[set].c; | |
| chans[ch].medium = msg->msg.data[2] & 0x7f; | |
| chans[ch].protocol = msg->msg.data[3] & 0x1f; | |
| next_channel: | |
| intf->curr_channel++; | |
| if (intf->curr_channel >= IPMI_MAX_CHANNELS) { | |
| intf->channel_list = intf->wchannels + set; | |
| intf->channels_ready = true; | |
| wake_up(&intf->waitq); | |
| } else { | |
| intf->channel_list = intf->wchannels + set; | |
| intf->channels_ready = true; | |
| rv = send_channel_info_cmd(intf, intf->curr_channel); | |
| } | |
| if (rv) { | |
| /* Got an error somehow, just give up. */ | |
| dev_warn(intf->si_dev, | |
| "Error sending channel information for channel %d: %d\n", | |
| intf->curr_channel, rv); | |
| intf->channel_list = intf->wchannels + set; | |
| intf->channels_ready = true; | |
| wake_up(&intf->waitq); | |
| } | |
| } | |
| out: | |
| return; | |
| } | |
| /* | |
| * Must be holding intf->bmc_reg_mutex to call this. | |
| */ | |
| static int __scan_channels(struct ipmi_smi *intf, struct ipmi_device_id *id) | |
| { | |
| int rv; | |
| if (ipmi_version_major(id) > 1 | |
| || (ipmi_version_major(id) == 1 | |
| && ipmi_version_minor(id) >= 5)) { | |
| unsigned int set; | |
| /* | |
| * Start scanning the channels to see what is | |
| * available. | |
| */ | |
| set = !intf->curr_working_cset; | |
| intf->curr_working_cset = set; | |
| memset(&intf->wchannels[set], 0, | |
| sizeof(struct ipmi_channel_set)); | |
| intf->null_user_handler = channel_handler; | |
| intf->curr_channel = 0; | |
| rv = send_channel_info_cmd(intf, 0); | |
| if (rv) { | |
| dev_warn(intf->si_dev, | |
| "Error sending channel information for channel 0, %d\n", | |
| rv); | |
| intf->null_user_handler = NULL; | |
| return -EIO; | |
| } | |
| /* Wait for the channel info to be read. */ | |
| wait_event(intf->waitq, intf->channels_ready); | |
| intf->null_user_handler = NULL; | |
| } else { | |
| unsigned int set = intf->curr_working_cset; | |
| /* Assume a single IPMB channel at zero. */ | |
| intf->wchannels[set].c[0].medium = IPMI_CHANNEL_MEDIUM_IPMB; | |
| intf->wchannels[set].c[0].protocol = IPMI_CHANNEL_PROTOCOL_IPMB; | |
| intf->channel_list = intf->wchannels + set; | |
| intf->channels_ready = true; | |
| } | |
| return 0; | |
| } | |
| static void ipmi_poll(struct ipmi_smi *intf) | |
| { | |
| if (intf->handlers->poll) | |
| intf->handlers->poll(intf->send_info); | |
| /* In case something came in */ | |
| handle_new_recv_msgs(intf); | |
| } | |
| void ipmi_poll_interface(struct ipmi_user *user) | |
| { | |
| ipmi_poll(user->intf); | |
| } | |
| EXPORT_SYMBOL(ipmi_poll_interface); | |
| static ssize_t nr_users_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct ipmi_smi *intf = container_of(attr, | |
| struct ipmi_smi, nr_users_devattr); | |
| return sysfs_emit(buf, "%d\n", atomic_read(&intf->nr_users)); | |
| } | |
| static DEVICE_ATTR_RO(nr_users); | |
| static ssize_t nr_msgs_show(struct device *dev, | |
| struct device_attribute *attr, | |
| char *buf) | |
| { | |
| struct ipmi_smi *intf = container_of(attr, | |
| struct ipmi_smi, nr_msgs_devattr); | |
| struct ipmi_user *user; | |
| int index; | |
| unsigned int count = 0; | |
| index = srcu_read_lock(&intf->users_srcu); | |
| list_for_each_entry_rcu(user, &intf->users, link) | |
| count += atomic_read(&user->nr_msgs); | |
| srcu_read_unlock(&intf->users_srcu, index); | |
| return sysfs_emit(buf, "%u\n", count); | |
| } | |
| static DEVICE_ATTR_RO(nr_msgs); | |
| static void redo_bmc_reg(struct work_struct *work) | |
| { | |
| struct ipmi_smi *intf = container_of(work, struct ipmi_smi, | |
| bmc_reg_work); | |
| if (!intf->in_shutdown) | |
| bmc_get_device_id(intf, NULL, NULL, NULL, NULL); | |
| kref_put(&intf->refcount, intf_free); | |
| } | |
| int ipmi_add_smi(struct module *owner, | |
| const struct ipmi_smi_handlers *handlers, | |
| void *send_info, | |
| struct device *si_dev, | |
| unsigned char slave_addr) | |
| { | |
| int i, j; | |
| int rv; | |
| struct ipmi_smi *intf, *tintf; | |
| struct list_head *link; | |
| struct ipmi_device_id id; | |
| /* | |
| * Make sure the driver is actually initialized, this handles | |
| * problems with initialization order. | |
| */ | |
| rv = ipmi_init_msghandler(); | |
| if (rv) | |
| return rv; | |
| intf = kzalloc(sizeof(*intf), GFP_KERNEL); | |
| if (!intf) | |
| return -ENOMEM; | |
| rv = init_srcu_struct(&intf->users_srcu); | |
| if (rv) { | |
| kfree(intf); | |
| return rv; | |
| } | |
| intf->owner = owner; | |
| intf->bmc = &intf->tmp_bmc; | |
| INIT_LIST_HEAD(&intf->bmc->intfs); | |
| mutex_init(&intf->bmc->dyn_mutex); | |
| INIT_LIST_HEAD(&intf->bmc_link); | |
| mutex_init(&intf->bmc_reg_mutex); | |
| intf->intf_num = -1; /* Mark it invalid for now. */ | |
| kref_init(&intf->refcount); | |
| INIT_WORK(&intf->bmc_reg_work, redo_bmc_reg); | |
| intf->si_dev = si_dev; | |
| for (j = 0; j < IPMI_MAX_CHANNELS; j++) { | |
| intf->addrinfo[j].address = IPMI_BMC_SLAVE_ADDR; | |
| intf->addrinfo[j].lun = 2; | |
| } | |
| if (slave_addr != 0) | |
| intf->addrinfo[0].address = slave_addr; | |
| INIT_LIST_HEAD(&intf->users); | |
| atomic_set(&intf->nr_users, 0); | |
| intf->handlers = handlers; | |
| intf->send_info = send_info; | |
| spin_lock_init(&intf->seq_lock); | |
| for (j = 0; j < IPMI_IPMB_NUM_SEQ; j++) { | |
| intf->seq_table[j].inuse = 0; | |
| intf->seq_table[j].seqid = 0; | |
| } | |
| intf->curr_seq = 0; | |
| spin_lock_init(&intf->waiting_rcv_msgs_lock); | |
| INIT_LIST_HEAD(&intf->waiting_rcv_msgs); | |
| tasklet_setup(&intf->recv_tasklet, | |
| smi_recv_tasklet); | |
| atomic_set(&intf->watchdog_pretimeouts_to_deliver, 0); | |
| spin_lock_init(&intf->xmit_msgs_lock); | |
| INIT_LIST_HEAD(&intf->xmit_msgs); | |
| INIT_LIST_HEAD(&intf->hp_xmit_msgs); | |
| spin_lock_init(&intf->events_lock); | |
| spin_lock_init(&intf->watch_lock); | |
| atomic_set(&intf->event_waiters, 0); | |
| intf->ticks_to_req_ev = IPMI_REQUEST_EV_TIME; | |
| INIT_LIST_HEAD(&intf->waiting_events); | |
| intf->waiting_events_count = 0; | |
| mutex_init(&intf->cmd_rcvrs_mutex); | |
| spin_lock_init(&intf->maintenance_mode_lock); | |
| INIT_LIST_HEAD(&intf->cmd_rcvrs); | |
| init_waitqueue_head(&intf->waitq); | |
| for (i = 0; i < IPMI_NUM_STATS; i++) | |
| atomic_set(&intf->stats[i], 0); | |
| mutex_lock(&ipmi_interfaces_mutex); | |
| /* Look for a hole in the numbers. */ | |
| i = 0; | |
| link = &ipmi_interfaces; | |
| list_for_each_entry_rcu(tintf, &ipmi_interfaces, link, | |
| ipmi_interfaces_mutex_held()) { | |
| if (tintf->intf_num != i) { | |
| link = &tintf->link; | |
| break; | |
| } | |
| i++; | |
| } | |
| /* Add the new interface in numeric order. */ | |
| if (i == 0) | |
| list_add_rcu(&intf->link, &ipmi_interfaces); | |
| else | |
| list_add_tail_rcu(&intf->link, link); | |
| rv = handlers->start_processing(send_info, intf); | |
| if (rv) | |
| goto out_err; | |
| rv = __bmc_get_device_id(intf, NULL, &id, NULL, NULL, i); | |
| if (rv) { | |
| dev_err(si_dev, "Unable to get the device id: %d\n", rv); | |
| goto out_err_started; | |
| } | |
| mutex_lock(&intf->bmc_reg_mutex); | |
| rv = __scan_channels(intf, &id); | |
| mutex_unlock(&intf->bmc_reg_mutex); | |
| if (rv) | |
| goto out_err_bmc_reg; | |
| intf->nr_users_devattr = dev_attr_nr_users; | |
| sysfs_attr_init(&intf->nr_users_devattr.attr); | |
| rv = device_create_file(intf->si_dev, &intf->nr_users_devattr); | |
| if (rv) | |
| goto out_err_bmc_reg; | |
| intf->nr_msgs_devattr = dev_attr_nr_msgs; | |
| sysfs_attr_init(&intf->nr_msgs_devattr.attr); | |
| rv = device_create_file(intf->si_dev, &intf->nr_msgs_devattr); | |
| if (rv) { | |
| device_remove_file(intf->si_dev, &intf->nr_users_devattr); | |
| goto out_err_bmc_reg; | |
| } | |
| /* | |
| * Keep memory order straight for RCU readers. Make | |
| * sure everything else is committed to memory before | |
| * setting intf_num to mark the interface valid. | |
| */ | |
| smp_wmb(); | |
| intf->intf_num = i; | |
| mutex_unlock(&ipmi_interfaces_mutex); | |
| /* After this point the interface is legal to use. */ | |
| call_smi_watchers(i, intf->si_dev); | |
| return 0; | |
| out_err_bmc_reg: | |
| ipmi_bmc_unregister(intf); | |
| out_err_started: | |
| if (intf->handlers->shutdown) | |
| intf->handlers->shutdown(intf->send_info); | |
| out_err: | |
| list_del_rcu(&intf->link); | |
| mutex_unlock(&ipmi_interfaces_mutex); | |
| synchronize_srcu(&ipmi_interfaces_srcu); | |
| cleanup_srcu_struct(&intf->users_srcu); | |
| kref_put(&intf->refcount, intf_free); | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_add_smi); | |
| static void deliver_smi_err_response(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg, | |
| unsigned char err) | |
| { | |
| int rv; | |
| msg->rsp[0] = msg->data[0] | 4; | |
| msg->rsp[1] = msg->data[1]; | |
| msg->rsp[2] = err; | |
| msg->rsp_size = 3; | |
| /* This will never requeue, but it may ask us to free the message. */ | |
| rv = handle_one_recv_msg(intf, msg); | |
| if (rv == 0) | |
| ipmi_free_smi_msg(msg); | |
| } | |
| static void cleanup_smi_msgs(struct ipmi_smi *intf) | |
| { | |
| int i; | |
| struct seq_table *ent; | |
| struct ipmi_smi_msg *msg; | |
| struct list_head *entry; | |
| struct list_head tmplist; | |
| /* Clear out our transmit queues and hold the messages. */ | |
| INIT_LIST_HEAD(&tmplist); | |
| list_splice_tail(&intf->hp_xmit_msgs, &tmplist); | |
| list_splice_tail(&intf->xmit_msgs, &tmplist); | |
| /* Current message first, to preserve order */ | |
| while (intf->curr_msg && !list_empty(&intf->waiting_rcv_msgs)) { | |
| /* Wait for the message to clear out. */ | |
| schedule_timeout(1); | |
| } | |
| /* No need for locks, the interface is down. */ | |
| /* | |
| * Return errors for all pending messages in queue and in the | |
| * tables waiting for remote responses. | |
| */ | |
| while (!list_empty(&tmplist)) { | |
| entry = tmplist.next; | |
| list_del(entry); | |
| msg = list_entry(entry, struct ipmi_smi_msg, link); | |
| deliver_smi_err_response(intf, msg, IPMI_ERR_UNSPECIFIED); | |
| } | |
| for (i = 0; i < IPMI_IPMB_NUM_SEQ; i++) { | |
| ent = &intf->seq_table[i]; | |
| if (!ent->inuse) | |
| continue; | |
| deliver_err_response(intf, ent->recv_msg, IPMI_ERR_UNSPECIFIED); | |
| } | |
| } | |
| void ipmi_unregister_smi(struct ipmi_smi *intf) | |
| { | |
| struct ipmi_smi_watcher *w; | |
| int intf_num, index; | |
| if (!intf) | |
| return; | |
| intf_num = intf->intf_num; | |
| mutex_lock(&ipmi_interfaces_mutex); | |
| intf->intf_num = -1; | |
| intf->in_shutdown = true; | |
| list_del_rcu(&intf->link); | |
| mutex_unlock(&ipmi_interfaces_mutex); | |
| synchronize_srcu(&ipmi_interfaces_srcu); | |
| /* At this point no users can be added to the interface. */ | |
| device_remove_file(intf->si_dev, &intf->nr_msgs_devattr); | |
| device_remove_file(intf->si_dev, &intf->nr_users_devattr); | |
| /* | |
| * Call all the watcher interfaces to tell them that | |
| * an interface is going away. | |
| */ | |
| mutex_lock(&smi_watchers_mutex); | |
| list_for_each_entry(w, &smi_watchers, link) | |
| w->smi_gone(intf_num); | |
| mutex_unlock(&smi_watchers_mutex); | |
| index = srcu_read_lock(&intf->users_srcu); | |
| while (!list_empty(&intf->users)) { | |
| struct ipmi_user *user = | |
| container_of(list_next_rcu(&intf->users), | |
| struct ipmi_user, link); | |
| _ipmi_destroy_user(user); | |
| } | |
| srcu_read_unlock(&intf->users_srcu, index); | |
| if (intf->handlers->shutdown) | |
| intf->handlers->shutdown(intf->send_info); | |
| cleanup_smi_msgs(intf); | |
| ipmi_bmc_unregister(intf); | |
| cleanup_srcu_struct(&intf->users_srcu); | |
| kref_put(&intf->refcount, intf_free); | |
| } | |
| EXPORT_SYMBOL(ipmi_unregister_smi); | |
| static int handle_ipmb_get_msg_rsp(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct ipmi_ipmb_addr ipmb_addr; | |
| struct ipmi_recv_msg *recv_msg; | |
| /* | |
| * This is 11, not 10, because the response must contain a | |
| * completion code. | |
| */ | |
| if (msg->rsp_size < 11) { | |
| /* Message not big enough, just ignore it. */ | |
| ipmi_inc_stat(intf, invalid_ipmb_responses); | |
| return 0; | |
| } | |
| if (msg->rsp[2] != 0) { | |
| /* An error getting the response, just ignore it. */ | |
| return 0; | |
| } | |
| ipmb_addr.addr_type = IPMI_IPMB_ADDR_TYPE; | |
| ipmb_addr.slave_addr = msg->rsp[6]; | |
| ipmb_addr.channel = msg->rsp[3] & 0x0f; | |
| ipmb_addr.lun = msg->rsp[7] & 3; | |
| /* | |
| * It's a response from a remote entity. Look up the sequence | |
| * number and handle the response. | |
| */ | |
| if (intf_find_seq(intf, | |
| msg->rsp[7] >> 2, | |
| msg->rsp[3] & 0x0f, | |
| msg->rsp[8], | |
| (msg->rsp[4] >> 2) & (~1), | |
| (struct ipmi_addr *) &ipmb_addr, | |
| &recv_msg)) { | |
| /* | |
| * We were unable to find the sequence number, | |
| * so just nuke the message. | |
| */ | |
| ipmi_inc_stat(intf, unhandled_ipmb_responses); | |
| return 0; | |
| } | |
| memcpy(recv_msg->msg_data, &msg->rsp[9], msg->rsp_size - 9); | |
| /* | |
| * The other fields matched, so no need to set them, except | |
| * for netfn, which needs to be the response that was | |
| * returned, not the request value. | |
| */ | |
| recv_msg->msg.netfn = msg->rsp[4] >> 2; | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = msg->rsp_size - 10; | |
| recv_msg->recv_type = IPMI_RESPONSE_RECV_TYPE; | |
| if (deliver_response(intf, recv_msg)) | |
| ipmi_inc_stat(intf, unhandled_ipmb_responses); | |
| else | |
| ipmi_inc_stat(intf, handled_ipmb_responses); | |
| return 0; | |
| } | |
| static int handle_ipmb_get_msg_cmd(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct cmd_rcvr *rcvr; | |
| int rv = 0; | |
| unsigned char netfn; | |
| unsigned char cmd; | |
| unsigned char chan; | |
| struct ipmi_user *user = NULL; | |
| struct ipmi_ipmb_addr *ipmb_addr; | |
| struct ipmi_recv_msg *recv_msg; | |
| if (msg->rsp_size < 10) { | |
| /* Message not big enough, just ignore it. */ | |
| ipmi_inc_stat(intf, invalid_commands); | |
| return 0; | |
| } | |
| if (msg->rsp[2] != 0) { | |
| /* An error getting the response, just ignore it. */ | |
| return 0; | |
| } | |
| netfn = msg->rsp[4] >> 2; | |
| cmd = msg->rsp[8]; | |
| chan = msg->rsp[3] & 0xf; | |
| rcu_read_lock(); | |
| rcvr = find_cmd_rcvr(intf, netfn, cmd, chan); | |
| if (rcvr) { | |
| user = rcvr->user; | |
| kref_get(&user->refcount); | |
| } else | |
| user = NULL; | |
| rcu_read_unlock(); | |
| if (user == NULL) { | |
| /* We didn't find a user, deliver an error response. */ | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| msg->data[0] = (IPMI_NETFN_APP_REQUEST << 2); | |
| msg->data[1] = IPMI_SEND_MSG_CMD; | |
| msg->data[2] = msg->rsp[3]; | |
| msg->data[3] = msg->rsp[6]; | |
| msg->data[4] = ((netfn + 1) << 2) | (msg->rsp[7] & 0x3); | |
| msg->data[5] = ipmb_checksum(&msg->data[3], 2); | |
| msg->data[6] = intf->addrinfo[msg->rsp[3] & 0xf].address; | |
| /* rqseq/lun */ | |
| msg->data[7] = (msg->rsp[7] & 0xfc) | (msg->rsp[4] & 0x3); | |
| msg->data[8] = msg->rsp[8]; /* cmd */ | |
| msg->data[9] = IPMI_INVALID_CMD_COMPLETION_CODE; | |
| msg->data[10] = ipmb_checksum(&msg->data[6], 4); | |
| msg->data_size = 11; | |
| dev_dbg(intf->si_dev, "Invalid command: %*ph\n", | |
| msg->data_size, msg->data); | |
| rcu_read_lock(); | |
| if (!intf->in_shutdown) { | |
| smi_send(intf, intf->handlers, msg, 0); | |
| /* | |
| * We used the message, so return the value | |
| * that causes it to not be freed or | |
| * queued. | |
| */ | |
| rv = -1; | |
| } | |
| rcu_read_unlock(); | |
| } else { | |
| recv_msg = ipmi_alloc_recv_msg(); | |
| if (!recv_msg) { | |
| /* | |
| * We couldn't allocate memory for the | |
| * message, so requeue it for handling | |
| * later. | |
| */ | |
| rv = 1; | |
| kref_put(&user->refcount, free_user); | |
| } else { | |
| /* Extract the source address from the data. */ | |
| ipmb_addr = (struct ipmi_ipmb_addr *) &recv_msg->addr; | |
| ipmb_addr->addr_type = IPMI_IPMB_ADDR_TYPE; | |
| ipmb_addr->slave_addr = msg->rsp[6]; | |
| ipmb_addr->lun = msg->rsp[7] & 3; | |
| ipmb_addr->channel = msg->rsp[3] & 0xf; | |
| /* | |
| * Extract the rest of the message information | |
| * from the IPMB header. | |
| */ | |
| recv_msg->user = user; | |
| recv_msg->recv_type = IPMI_CMD_RECV_TYPE; | |
| recv_msg->msgid = msg->rsp[7] >> 2; | |
| recv_msg->msg.netfn = msg->rsp[4] >> 2; | |
| recv_msg->msg.cmd = msg->rsp[8]; | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| /* | |
| * We chop off 10, not 9 bytes because the checksum | |
| * at the end also needs to be removed. | |
| */ | |
| recv_msg->msg.data_len = msg->rsp_size - 10; | |
| memcpy(recv_msg->msg_data, &msg->rsp[9], | |
| msg->rsp_size - 10); | |
| if (deliver_response(intf, recv_msg)) | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| else | |
| ipmi_inc_stat(intf, handled_commands); | |
| } | |
| } | |
| return rv; | |
| } | |
| static int handle_ipmb_direct_rcv_cmd(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct cmd_rcvr *rcvr; | |
| int rv = 0; | |
| struct ipmi_user *user = NULL; | |
| struct ipmi_ipmb_direct_addr *daddr; | |
| struct ipmi_recv_msg *recv_msg; | |
| unsigned char netfn = msg->rsp[0] >> 2; | |
| unsigned char cmd = msg->rsp[3]; | |
| rcu_read_lock(); | |
| /* We always use channel 0 for direct messages. */ | |
| rcvr = find_cmd_rcvr(intf, netfn, cmd, 0); | |
| if (rcvr) { | |
| user = rcvr->user; | |
| kref_get(&user->refcount); | |
| } else | |
| user = NULL; | |
| rcu_read_unlock(); | |
| if (user == NULL) { | |
| /* We didn't find a user, deliver an error response. */ | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| msg->data[0] = (netfn + 1) << 2; | |
| msg->data[0] |= msg->rsp[2] & 0x3; /* rqLUN */ | |
| msg->data[1] = msg->rsp[1]; /* Addr */ | |
| msg->data[2] = msg->rsp[2] & ~0x3; /* rqSeq */ | |
| msg->data[2] |= msg->rsp[0] & 0x3; /* rsLUN */ | |
| msg->data[3] = cmd; | |
| msg->data[4] = IPMI_INVALID_CMD_COMPLETION_CODE; | |
| msg->data_size = 5; | |
| rcu_read_lock(); | |
| if (!intf->in_shutdown) { | |
| smi_send(intf, intf->handlers, msg, 0); | |
| /* | |
| * We used the message, so return the value | |
| * that causes it to not be freed or | |
| * queued. | |
| */ | |
| rv = -1; | |
| } | |
| rcu_read_unlock(); | |
| } else { | |
| recv_msg = ipmi_alloc_recv_msg(); | |
| if (!recv_msg) { | |
| /* | |
| * We couldn't allocate memory for the | |
| * message, so requeue it for handling | |
| * later. | |
| */ | |
| rv = 1; | |
| kref_put(&user->refcount, free_user); | |
| } else { | |
| /* Extract the source address from the data. */ | |
| daddr = (struct ipmi_ipmb_direct_addr *)&recv_msg->addr; | |
| daddr->addr_type = IPMI_IPMB_DIRECT_ADDR_TYPE; | |
| daddr->channel = 0; | |
| daddr->slave_addr = msg->rsp[1]; | |
| daddr->rs_lun = msg->rsp[0] & 3; | |
| daddr->rq_lun = msg->rsp[2] & 3; | |
| /* | |
| * Extract the rest of the message information | |
| * from the IPMB header. | |
| */ | |
| recv_msg->user = user; | |
| recv_msg->recv_type = IPMI_CMD_RECV_TYPE; | |
| recv_msg->msgid = (msg->rsp[2] >> 2); | |
| recv_msg->msg.netfn = msg->rsp[0] >> 2; | |
| recv_msg->msg.cmd = msg->rsp[3]; | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = msg->rsp_size - 4; | |
| memcpy(recv_msg->msg_data, msg->rsp + 4, | |
| msg->rsp_size - 4); | |
| if (deliver_response(intf, recv_msg)) | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| else | |
| ipmi_inc_stat(intf, handled_commands); | |
| } | |
| } | |
| return rv; | |
| } | |
| static int handle_ipmb_direct_rcv_rsp(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct ipmi_recv_msg *recv_msg; | |
| struct ipmi_ipmb_direct_addr *daddr; | |
| recv_msg = msg->user_data; | |
| if (recv_msg == NULL) { | |
| dev_warn(intf->si_dev, | |
| "IPMI direct message received with no owner. This could be because of a malformed message, or because of a hardware error. Contact your hardware vendor for assistance.\n"); | |
| return 0; | |
| } | |
| recv_msg->recv_type = IPMI_RESPONSE_RECV_TYPE; | |
| recv_msg->msgid = msg->msgid; | |
| daddr = (struct ipmi_ipmb_direct_addr *) &recv_msg->addr; | |
| daddr->addr_type = IPMI_IPMB_DIRECT_ADDR_TYPE; | |
| daddr->channel = 0; | |
| daddr->slave_addr = msg->rsp[1]; | |
| daddr->rq_lun = msg->rsp[0] & 3; | |
| daddr->rs_lun = msg->rsp[2] & 3; | |
| recv_msg->msg.netfn = msg->rsp[0] >> 2; | |
| recv_msg->msg.cmd = msg->rsp[3]; | |
| memcpy(recv_msg->msg_data, &msg->rsp[4], msg->rsp_size - 4); | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = msg->rsp_size - 4; | |
| deliver_local_response(intf, recv_msg); | |
| return 0; | |
| } | |
| static int handle_lan_get_msg_rsp(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct ipmi_lan_addr lan_addr; | |
| struct ipmi_recv_msg *recv_msg; | |
| /* | |
| * This is 13, not 12, because the response must contain a | |
| * completion code. | |
| */ | |
| if (msg->rsp_size < 13) { | |
| /* Message not big enough, just ignore it. */ | |
| ipmi_inc_stat(intf, invalid_lan_responses); | |
| return 0; | |
| } | |
| if (msg->rsp[2] != 0) { | |
| /* An error getting the response, just ignore it. */ | |
| return 0; | |
| } | |
| lan_addr.addr_type = IPMI_LAN_ADDR_TYPE; | |
| lan_addr.session_handle = msg->rsp[4]; | |
| lan_addr.remote_SWID = msg->rsp[8]; | |
| lan_addr.local_SWID = msg->rsp[5]; | |
| lan_addr.channel = msg->rsp[3] & 0x0f; | |
| lan_addr.privilege = msg->rsp[3] >> 4; | |
| lan_addr.lun = msg->rsp[9] & 3; | |
| /* | |
| * It's a response from a remote entity. Look up the sequence | |
| * number and handle the response. | |
| */ | |
| if (intf_find_seq(intf, | |
| msg->rsp[9] >> 2, | |
| msg->rsp[3] & 0x0f, | |
| msg->rsp[10], | |
| (msg->rsp[6] >> 2) & (~1), | |
| (struct ipmi_addr *) &lan_addr, | |
| &recv_msg)) { | |
| /* | |
| * We were unable to find the sequence number, | |
| * so just nuke the message. | |
| */ | |
| ipmi_inc_stat(intf, unhandled_lan_responses); | |
| return 0; | |
| } | |
| memcpy(recv_msg->msg_data, &msg->rsp[11], msg->rsp_size - 11); | |
| /* | |
| * The other fields matched, so no need to set them, except | |
| * for netfn, which needs to be the response that was | |
| * returned, not the request value. | |
| */ | |
| recv_msg->msg.netfn = msg->rsp[6] >> 2; | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = msg->rsp_size - 12; | |
| recv_msg->recv_type = IPMI_RESPONSE_RECV_TYPE; | |
| if (deliver_response(intf, recv_msg)) | |
| ipmi_inc_stat(intf, unhandled_lan_responses); | |
| else | |
| ipmi_inc_stat(intf, handled_lan_responses); | |
| return 0; | |
| } | |
| static int handle_lan_get_msg_cmd(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct cmd_rcvr *rcvr; | |
| int rv = 0; | |
| unsigned char netfn; | |
| unsigned char cmd; | |
| unsigned char chan; | |
| struct ipmi_user *user = NULL; | |
| struct ipmi_lan_addr *lan_addr; | |
| struct ipmi_recv_msg *recv_msg; | |
| if (msg->rsp_size < 12) { | |
| /* Message not big enough, just ignore it. */ | |
| ipmi_inc_stat(intf, invalid_commands); | |
| return 0; | |
| } | |
| if (msg->rsp[2] != 0) { | |
| /* An error getting the response, just ignore it. */ | |
| return 0; | |
| } | |
| netfn = msg->rsp[6] >> 2; | |
| cmd = msg->rsp[10]; | |
| chan = msg->rsp[3] & 0xf; | |
| rcu_read_lock(); | |
| rcvr = find_cmd_rcvr(intf, netfn, cmd, chan); | |
| if (rcvr) { | |
| user = rcvr->user; | |
| kref_get(&user->refcount); | |
| } else | |
| user = NULL; | |
| rcu_read_unlock(); | |
| if (user == NULL) { | |
| /* We didn't find a user, just give up. */ | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| /* | |
| * Don't do anything with these messages, just allow | |
| * them to be freed. | |
| */ | |
| rv = 0; | |
| } else { | |
| recv_msg = ipmi_alloc_recv_msg(); | |
| if (!recv_msg) { | |
| /* | |
| * We couldn't allocate memory for the | |
| * message, so requeue it for handling later. | |
| */ | |
| rv = 1; | |
| kref_put(&user->refcount, free_user); | |
| } else { | |
| /* Extract the source address from the data. */ | |
| lan_addr = (struct ipmi_lan_addr *) &recv_msg->addr; | |
| lan_addr->addr_type = IPMI_LAN_ADDR_TYPE; | |
| lan_addr->session_handle = msg->rsp[4]; | |
| lan_addr->remote_SWID = msg->rsp[8]; | |
| lan_addr->local_SWID = msg->rsp[5]; | |
| lan_addr->lun = msg->rsp[9] & 3; | |
| lan_addr->channel = msg->rsp[3] & 0xf; | |
| lan_addr->privilege = msg->rsp[3] >> 4; | |
| /* | |
| * Extract the rest of the message information | |
| * from the IPMB header. | |
| */ | |
| recv_msg->user = user; | |
| recv_msg->recv_type = IPMI_CMD_RECV_TYPE; | |
| recv_msg->msgid = msg->rsp[9] >> 2; | |
| recv_msg->msg.netfn = msg->rsp[6] >> 2; | |
| recv_msg->msg.cmd = msg->rsp[10]; | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| /* | |
| * We chop off 12, not 11 bytes because the checksum | |
| * at the end also needs to be removed. | |
| */ | |
| recv_msg->msg.data_len = msg->rsp_size - 12; | |
| memcpy(recv_msg->msg_data, &msg->rsp[11], | |
| msg->rsp_size - 12); | |
| if (deliver_response(intf, recv_msg)) | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| else | |
| ipmi_inc_stat(intf, handled_commands); | |
| } | |
| } | |
| return rv; | |
| } | |
| /* | |
| * This routine will handle "Get Message" command responses with | |
| * channels that use an OEM Medium. The message format belongs to | |
| * the OEM. See IPMI 2.0 specification, Chapter 6 and | |
| * Chapter 22, sections 22.6 and 22.24 for more details. | |
| */ | |
| static int handle_oem_get_msg_cmd(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct cmd_rcvr *rcvr; | |
| int rv = 0; | |
| unsigned char netfn; | |
| unsigned char cmd; | |
| unsigned char chan; | |
| struct ipmi_user *user = NULL; | |
| struct ipmi_system_interface_addr *smi_addr; | |
| struct ipmi_recv_msg *recv_msg; | |
| /* | |
| * We expect the OEM SW to perform error checking | |
| * so we just do some basic sanity checks | |
| */ | |
| if (msg->rsp_size < 4) { | |
| /* Message not big enough, just ignore it. */ | |
| ipmi_inc_stat(intf, invalid_commands); | |
| return 0; | |
| } | |
| if (msg->rsp[2] != 0) { | |
| /* An error getting the response, just ignore it. */ | |
| return 0; | |
| } | |
| /* | |
| * This is an OEM Message so the OEM needs to know how | |
| * handle the message. We do no interpretation. | |
| */ | |
| netfn = msg->rsp[0] >> 2; | |
| cmd = msg->rsp[1]; | |
| chan = msg->rsp[3] & 0xf; | |
| rcu_read_lock(); | |
| rcvr = find_cmd_rcvr(intf, netfn, cmd, chan); | |
| if (rcvr) { | |
| user = rcvr->user; | |
| kref_get(&user->refcount); | |
| } else | |
| user = NULL; | |
| rcu_read_unlock(); | |
| if (user == NULL) { | |
| /* We didn't find a user, just give up. */ | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| /* | |
| * Don't do anything with these messages, just allow | |
| * them to be freed. | |
| */ | |
| rv = 0; | |
| } else { | |
| recv_msg = ipmi_alloc_recv_msg(); | |
| if (!recv_msg) { | |
| /* | |
| * We couldn't allocate memory for the | |
| * message, so requeue it for handling | |
| * later. | |
| */ | |
| rv = 1; | |
| kref_put(&user->refcount, free_user); | |
| } else { | |
| /* | |
| * OEM Messages are expected to be delivered via | |
| * the system interface to SMS software. We might | |
| * need to visit this again depending on OEM | |
| * requirements | |
| */ | |
| smi_addr = ((struct ipmi_system_interface_addr *) | |
| &recv_msg->addr); | |
| smi_addr->addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| smi_addr->channel = IPMI_BMC_CHANNEL; | |
| smi_addr->lun = msg->rsp[0] & 3; | |
| recv_msg->user = user; | |
| recv_msg->user_msg_data = NULL; | |
| recv_msg->recv_type = IPMI_OEM_RECV_TYPE; | |
| recv_msg->msg.netfn = msg->rsp[0] >> 2; | |
| recv_msg->msg.cmd = msg->rsp[1]; | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| /* | |
| * The message starts at byte 4 which follows the | |
| * Channel Byte in the "GET MESSAGE" command | |
| */ | |
| recv_msg->msg.data_len = msg->rsp_size - 4; | |
| memcpy(recv_msg->msg_data, &msg->rsp[4], | |
| msg->rsp_size - 4); | |
| if (deliver_response(intf, recv_msg)) | |
| ipmi_inc_stat(intf, unhandled_commands); | |
| else | |
| ipmi_inc_stat(intf, handled_commands); | |
| } | |
| } | |
| return rv; | |
| } | |
| static void copy_event_into_recv_msg(struct ipmi_recv_msg *recv_msg, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct ipmi_system_interface_addr *smi_addr; | |
| recv_msg->msgid = 0; | |
| smi_addr = (struct ipmi_system_interface_addr *) &recv_msg->addr; | |
| smi_addr->addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| smi_addr->channel = IPMI_BMC_CHANNEL; | |
| smi_addr->lun = msg->rsp[0] & 3; | |
| recv_msg->recv_type = IPMI_ASYNC_EVENT_RECV_TYPE; | |
| recv_msg->msg.netfn = msg->rsp[0] >> 2; | |
| recv_msg->msg.cmd = msg->rsp[1]; | |
| memcpy(recv_msg->msg_data, &msg->rsp[3], msg->rsp_size - 3); | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = msg->rsp_size - 3; | |
| } | |
| static int handle_read_event_rsp(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct ipmi_recv_msg *recv_msg, *recv_msg2; | |
| struct list_head msgs; | |
| struct ipmi_user *user; | |
| int rv = 0, deliver_count = 0, index; | |
| unsigned long flags; | |
| if (msg->rsp_size < 19) { | |
| /* Message is too small to be an IPMB event. */ | |
| ipmi_inc_stat(intf, invalid_events); | |
| return 0; | |
| } | |
| if (msg->rsp[2] != 0) { | |
| /* An error getting the event, just ignore it. */ | |
| return 0; | |
| } | |
| INIT_LIST_HEAD(&msgs); | |
| spin_lock_irqsave(&intf->events_lock, flags); | |
| ipmi_inc_stat(intf, events); | |
| /* | |
| * Allocate and fill in one message for every user that is | |
| * getting events. | |
| */ | |
| index = srcu_read_lock(&intf->users_srcu); | |
| list_for_each_entry_rcu(user, &intf->users, link) { | |
| if (!user->gets_events) | |
| continue; | |
| recv_msg = ipmi_alloc_recv_msg(); | |
| if (!recv_msg) { | |
| rcu_read_unlock(); | |
| list_for_each_entry_safe(recv_msg, recv_msg2, &msgs, | |
| link) { | |
| list_del(&recv_msg->link); | |
| ipmi_free_recv_msg(recv_msg); | |
| } | |
| /* | |
| * We couldn't allocate memory for the | |
| * message, so requeue it for handling | |
| * later. | |
| */ | |
| rv = 1; | |
| goto out; | |
| } | |
| deliver_count++; | |
| copy_event_into_recv_msg(recv_msg, msg); | |
| recv_msg->user = user; | |
| kref_get(&user->refcount); | |
| list_add_tail(&recv_msg->link, &msgs); | |
| } | |
| srcu_read_unlock(&intf->users_srcu, index); | |
| if (deliver_count) { | |
| /* Now deliver all the messages. */ | |
| list_for_each_entry_safe(recv_msg, recv_msg2, &msgs, link) { | |
| list_del(&recv_msg->link); | |
| deliver_local_response(intf, recv_msg); | |
| } | |
| } else if (intf->waiting_events_count < MAX_EVENTS_IN_QUEUE) { | |
| /* | |
| * No one to receive the message, put it in queue if there's | |
| * not already too many things in the queue. | |
| */ | |
| recv_msg = ipmi_alloc_recv_msg(); | |
| if (!recv_msg) { | |
| /* | |
| * We couldn't allocate memory for the | |
| * message, so requeue it for handling | |
| * later. | |
| */ | |
| rv = 1; | |
| goto out; | |
| } | |
| copy_event_into_recv_msg(recv_msg, msg); | |
| list_add_tail(&recv_msg->link, &intf->waiting_events); | |
| intf->waiting_events_count++; | |
| } else if (!intf->event_msg_printed) { | |
| /* | |
| * There's too many things in the queue, discard this | |
| * message. | |
| */ | |
| dev_warn(intf->si_dev, | |
| "Event queue full, discarding incoming events\n"); | |
| intf->event_msg_printed = 1; | |
| } | |
| out: | |
| spin_unlock_irqrestore(&intf->events_lock, flags); | |
| return rv; | |
| } | |
| static int handle_bmc_rsp(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| struct ipmi_recv_msg *recv_msg; | |
| struct ipmi_system_interface_addr *smi_addr; | |
| recv_msg = msg->user_data; | |
| if (recv_msg == NULL) { | |
| dev_warn(intf->si_dev, | |
| "IPMI SMI message received with no owner. This could be because of a malformed message, or because of a hardware error. Contact your hardware vendor for assistance.\n"); | |
| return 0; | |
| } | |
| recv_msg->recv_type = IPMI_RESPONSE_RECV_TYPE; | |
| recv_msg->msgid = msg->msgid; | |
| smi_addr = ((struct ipmi_system_interface_addr *) | |
| &recv_msg->addr); | |
| smi_addr->addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| smi_addr->channel = IPMI_BMC_CHANNEL; | |
| smi_addr->lun = msg->rsp[0] & 3; | |
| recv_msg->msg.netfn = msg->rsp[0] >> 2; | |
| recv_msg->msg.cmd = msg->rsp[1]; | |
| memcpy(recv_msg->msg_data, &msg->rsp[2], msg->rsp_size - 2); | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg.data_len = msg->rsp_size - 2; | |
| deliver_local_response(intf, recv_msg); | |
| return 0; | |
| } | |
| /* | |
| * Handle a received message. Return 1 if the message should be requeued, | |
| * 0 if the message should be freed, or -1 if the message should not | |
| * be freed or requeued. | |
| */ | |
| static int handle_one_recv_msg(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| int requeue = 0; | |
| int chan; | |
| unsigned char cc; | |
| bool is_cmd = !((msg->rsp[0] >> 2) & 1); | |
| dev_dbg(intf->si_dev, "Recv: %*ph\n", msg->rsp_size, msg->rsp); | |
| if (msg->rsp_size < 2) { | |
| /* Message is too small to be correct. */ | |
| dev_warn(intf->si_dev, | |
| "BMC returned too small a message for netfn %x cmd %x, got %d bytes\n", | |
| (msg->data[0] >> 2) | 1, msg->data[1], msg->rsp_size); | |
| return_unspecified: | |
| /* Generate an error response for the message. */ | |
| msg->rsp[0] = msg->data[0] | (1 << 2); | |
| msg->rsp[1] = msg->data[1]; | |
| msg->rsp[2] = IPMI_ERR_UNSPECIFIED; | |
| msg->rsp_size = 3; | |
| } else if (msg->type == IPMI_SMI_MSG_TYPE_IPMB_DIRECT) { | |
| /* commands must have at least 4 bytes, responses 5. */ | |
| if (is_cmd && (msg->rsp_size < 4)) { | |
| ipmi_inc_stat(intf, invalid_commands); | |
| goto out; | |
| } | |
| if (!is_cmd && (msg->rsp_size < 5)) { | |
| ipmi_inc_stat(intf, invalid_ipmb_responses); | |
| /* Construct a valid error response. */ | |
| msg->rsp[0] = msg->data[0] & 0xfc; /* NetFN */ | |
| msg->rsp[0] |= (1 << 2); /* Make it a response */ | |
| msg->rsp[0] |= msg->data[2] & 3; /* rqLUN */ | |
| msg->rsp[1] = msg->data[1]; /* Addr */ | |
| msg->rsp[2] = msg->data[2] & 0xfc; /* rqSeq */ | |
| msg->rsp[2] |= msg->data[0] & 0x3; /* rsLUN */ | |
| msg->rsp[3] = msg->data[3]; /* Cmd */ | |
| msg->rsp[4] = IPMI_ERR_UNSPECIFIED; | |
| msg->rsp_size = 5; | |
| } | |
| } else if ((msg->data_size >= 2) | |
| && (msg->data[0] == (IPMI_NETFN_APP_REQUEST << 2)) | |
| && (msg->data[1] == IPMI_SEND_MSG_CMD) | |
| && (msg->user_data == NULL)) { | |
| if (intf->in_shutdown) | |
| goto out; | |
| /* | |
| * This is the local response to a command send, start | |
| * the timer for these. The user_data will not be | |
| * NULL if this is a response send, and we will let | |
| * response sends just go through. | |
| */ | |
| /* | |
| * Check for errors, if we get certain errors (ones | |
| * that mean basically we can try again later), we | |
| * ignore them and start the timer. Otherwise we | |
| * report the error immediately. | |
| */ | |
| if ((msg->rsp_size >= 3) && (msg->rsp[2] != 0) | |
| && (msg->rsp[2] != IPMI_NODE_BUSY_ERR) | |
| && (msg->rsp[2] != IPMI_LOST_ARBITRATION_ERR) | |
| && (msg->rsp[2] != IPMI_BUS_ERR) | |
| && (msg->rsp[2] != IPMI_NAK_ON_WRITE_ERR)) { | |
| int ch = msg->rsp[3] & 0xf; | |
| struct ipmi_channel *chans; | |
| /* Got an error sending the message, handle it. */ | |
| chans = READ_ONCE(intf->channel_list)->c; | |
| if ((chans[ch].medium == IPMI_CHANNEL_MEDIUM_8023LAN) | |
| || (chans[ch].medium == IPMI_CHANNEL_MEDIUM_ASYNC)) | |
| ipmi_inc_stat(intf, sent_lan_command_errs); | |
| else | |
| ipmi_inc_stat(intf, sent_ipmb_command_errs); | |
| intf_err_seq(intf, msg->msgid, msg->rsp[2]); | |
| } else | |
| /* The message was sent, start the timer. */ | |
| intf_start_seq_timer(intf, msg->msgid); | |
| requeue = 0; | |
| goto out; | |
| } else if (((msg->rsp[0] >> 2) != ((msg->data[0] >> 2) | 1)) | |
| || (msg->rsp[1] != msg->data[1])) { | |
| /* | |
| * The NetFN and Command in the response is not even | |
| * marginally correct. | |
| */ | |
| dev_warn(intf->si_dev, | |
| "BMC returned incorrect response, expected netfn %x cmd %x, got netfn %x cmd %x\n", | |
| (msg->data[0] >> 2) | 1, msg->data[1], | |
| msg->rsp[0] >> 2, msg->rsp[1]); | |
| goto return_unspecified; | |
| } | |
| if (msg->type == IPMI_SMI_MSG_TYPE_IPMB_DIRECT) { | |
| if ((msg->data[0] >> 2) & 1) { | |
| /* It's a response to a sent response. */ | |
| chan = 0; | |
| cc = msg->rsp[4]; | |
| goto process_response_response; | |
| } | |
| if (is_cmd) | |
| requeue = handle_ipmb_direct_rcv_cmd(intf, msg); | |
| else | |
| requeue = handle_ipmb_direct_rcv_rsp(intf, msg); | |
| } else if ((msg->rsp[0] == ((IPMI_NETFN_APP_REQUEST|1) << 2)) | |
| && (msg->rsp[1] == IPMI_SEND_MSG_CMD) | |
| && (msg->user_data != NULL)) { | |
| /* | |
| * It's a response to a response we sent. For this we | |
| * deliver a send message response to the user. | |
| */ | |
| struct ipmi_recv_msg *recv_msg; | |
| chan = msg->data[2] & 0x0f; | |
| if (chan >= IPMI_MAX_CHANNELS) | |
| /* Invalid channel number */ | |
| goto out; | |
| cc = msg->rsp[2]; | |
| process_response_response: | |
| recv_msg = msg->user_data; | |
| requeue = 0; | |
| if (!recv_msg) | |
| goto out; | |
| recv_msg->recv_type = IPMI_RESPONSE_RESPONSE_TYPE; | |
| recv_msg->msg.data = recv_msg->msg_data; | |
| recv_msg->msg_data[0] = cc; | |
| recv_msg->msg.data_len = 1; | |
| deliver_local_response(intf, recv_msg); | |
| } else if ((msg->rsp[0] == ((IPMI_NETFN_APP_REQUEST|1) << 2)) | |
| && (msg->rsp[1] == IPMI_GET_MSG_CMD)) { | |
| struct ipmi_channel *chans; | |
| /* It's from the receive queue. */ | |
| chan = msg->rsp[3] & 0xf; | |
| if (chan >= IPMI_MAX_CHANNELS) { | |
| /* Invalid channel number */ | |
| requeue = 0; | |
| goto out; | |
| } | |
| /* | |
| * We need to make sure the channels have been initialized. | |
| * The channel_handler routine will set the "curr_channel" | |
| * equal to or greater than IPMI_MAX_CHANNELS when all the | |
| * channels for this interface have been initialized. | |
| */ | |
| if (!intf->channels_ready) { | |
| requeue = 0; /* Throw the message away */ | |
| goto out; | |
| } | |
| chans = READ_ONCE(intf->channel_list)->c; | |
| switch (chans[chan].medium) { | |
| case IPMI_CHANNEL_MEDIUM_IPMB: | |
| if (msg->rsp[4] & 0x04) { | |
| /* | |
| * It's a response, so find the | |
| * requesting message and send it up. | |
| */ | |
| requeue = handle_ipmb_get_msg_rsp(intf, msg); | |
| } else { | |
| /* | |
| * It's a command to the SMS from some other | |
| * entity. Handle that. | |
| */ | |
| requeue = handle_ipmb_get_msg_cmd(intf, msg); | |
| } | |
| break; | |
| case IPMI_CHANNEL_MEDIUM_8023LAN: | |
| case IPMI_CHANNEL_MEDIUM_ASYNC: | |
| if (msg->rsp[6] & 0x04) { | |
| /* | |
| * It's a response, so find the | |
| * requesting message and send it up. | |
| */ | |
| requeue = handle_lan_get_msg_rsp(intf, msg); | |
| } else { | |
| /* | |
| * It's a command to the SMS from some other | |
| * entity. Handle that. | |
| */ | |
| requeue = handle_lan_get_msg_cmd(intf, msg); | |
| } | |
| break; | |
| default: | |
| /* Check for OEM Channels. Clients had better | |
| register for these commands. */ | |
| if ((chans[chan].medium >= IPMI_CHANNEL_MEDIUM_OEM_MIN) | |
| && (chans[chan].medium | |
| <= IPMI_CHANNEL_MEDIUM_OEM_MAX)) { | |
| requeue = handle_oem_get_msg_cmd(intf, msg); | |
| } else { | |
| /* | |
| * We don't handle the channel type, so just | |
| * free the message. | |
| */ | |
| requeue = 0; | |
| } | |
| } | |
| } else if ((msg->rsp[0] == ((IPMI_NETFN_APP_REQUEST|1) << 2)) | |
| && (msg->rsp[1] == IPMI_READ_EVENT_MSG_BUFFER_CMD)) { | |
| /* It's an asynchronous event. */ | |
| requeue = handle_read_event_rsp(intf, msg); | |
| } else { | |
| /* It's a response from the local BMC. */ | |
| requeue = handle_bmc_rsp(intf, msg); | |
| } | |
| out: | |
| return requeue; | |
| } | |
| /* | |
| * If there are messages in the queue or pretimeouts, handle them. | |
| */ | |
| static void handle_new_recv_msgs(struct ipmi_smi *intf) | |
| { | |
| struct ipmi_smi_msg *smi_msg; | |
| unsigned long flags = 0; | |
| int rv; | |
| int run_to_completion = intf->run_to_completion; | |
| /* See if any waiting messages need to be processed. */ | |
| if (!run_to_completion) | |
| spin_lock_irqsave(&intf->waiting_rcv_msgs_lock, flags); | |
| while (!list_empty(&intf->waiting_rcv_msgs)) { | |
| smi_msg = list_entry(intf->waiting_rcv_msgs.next, | |
| struct ipmi_smi_msg, link); | |
| list_del(&smi_msg->link); | |
| if (!run_to_completion) | |
| spin_unlock_irqrestore(&intf->waiting_rcv_msgs_lock, | |
| flags); | |
| rv = handle_one_recv_msg(intf, smi_msg); | |
| if (!run_to_completion) | |
| spin_lock_irqsave(&intf->waiting_rcv_msgs_lock, flags); | |
| if (rv > 0) { | |
| /* | |
| * To preserve message order, quit if we | |
| * can't handle a message. Add the message | |
| * back at the head, this is safe because this | |
| * tasklet is the only thing that pulls the | |
| * messages. | |
| */ | |
| list_add(&smi_msg->link, &intf->waiting_rcv_msgs); | |
| break; | |
| } else { | |
| if (rv == 0) | |
| /* Message handled */ | |
| ipmi_free_smi_msg(smi_msg); | |
| /* If rv < 0, fatal error, del but don't free. */ | |
| } | |
| } | |
| if (!run_to_completion) | |
| spin_unlock_irqrestore(&intf->waiting_rcv_msgs_lock, flags); | |
| /* | |
| * If the pretimout count is non-zero, decrement one from it and | |
| * deliver pretimeouts to all the users. | |
| */ | |
| if (atomic_add_unless(&intf->watchdog_pretimeouts_to_deliver, -1, 0)) { | |
| struct ipmi_user *user; | |
| int index; | |
| index = srcu_read_lock(&intf->users_srcu); | |
| list_for_each_entry_rcu(user, &intf->users, link) { | |
| if (user->handler->ipmi_watchdog_pretimeout) | |
| user->handler->ipmi_watchdog_pretimeout( | |
| user->handler_data); | |
| } | |
| srcu_read_unlock(&intf->users_srcu, index); | |
| } | |
| } | |
| static void smi_recv_tasklet(struct tasklet_struct *t) | |
| { | |
| unsigned long flags = 0; /* keep us warning-free. */ | |
| struct ipmi_smi *intf = from_tasklet(intf, t, recv_tasklet); | |
| int run_to_completion = intf->run_to_completion; | |
| struct ipmi_smi_msg *newmsg = NULL; | |
| /* | |
| * Start the next message if available. | |
| * | |
| * Do this here, not in the actual receiver, because we may deadlock | |
| * because the lower layer is allowed to hold locks while calling | |
| * message delivery. | |
| */ | |
| rcu_read_lock(); | |
| if (!run_to_completion) | |
| spin_lock_irqsave(&intf->xmit_msgs_lock, flags); | |
| if (intf->curr_msg == NULL && !intf->in_shutdown) { | |
| struct list_head *entry = NULL; | |
| /* Pick the high priority queue first. */ | |
| if (!list_empty(&intf->hp_xmit_msgs)) | |
| entry = intf->hp_xmit_msgs.next; | |
| else if (!list_empty(&intf->xmit_msgs)) | |
| entry = intf->xmit_msgs.next; | |
| if (entry) { | |
| list_del(entry); | |
| newmsg = list_entry(entry, struct ipmi_smi_msg, link); | |
| intf->curr_msg = newmsg; | |
| } | |
| } | |
| if (!run_to_completion) | |
| spin_unlock_irqrestore(&intf->xmit_msgs_lock, flags); | |
| if (newmsg) | |
| intf->handlers->sender(intf->send_info, newmsg); | |
| rcu_read_unlock(); | |
| handle_new_recv_msgs(intf); | |
| } | |
| /* Handle a new message from the lower layer. */ | |
| void ipmi_smi_msg_received(struct ipmi_smi *intf, | |
| struct ipmi_smi_msg *msg) | |
| { | |
| unsigned long flags = 0; /* keep us warning-free. */ | |
| int run_to_completion = intf->run_to_completion; | |
| /* | |
| * To preserve message order, we keep a queue and deliver from | |
| * a tasklet. | |
| */ | |
| if (!run_to_completion) | |
| spin_lock_irqsave(&intf->waiting_rcv_msgs_lock, flags); | |
| list_add_tail(&msg->link, &intf->waiting_rcv_msgs); | |
| if (!run_to_completion) | |
| spin_unlock_irqrestore(&intf->waiting_rcv_msgs_lock, | |
| flags); | |
| if (!run_to_completion) | |
| spin_lock_irqsave(&intf->xmit_msgs_lock, flags); | |
| /* | |
| * We can get an asynchronous event or receive message in addition | |
| * to commands we send. | |
| */ | |
| if (msg == intf->curr_msg) | |
| intf->curr_msg = NULL; | |
| if (!run_to_completion) | |
| spin_unlock_irqrestore(&intf->xmit_msgs_lock, flags); | |
| if (run_to_completion) | |
| smi_recv_tasklet(&intf->recv_tasklet); | |
| else | |
| tasklet_schedule(&intf->recv_tasklet); | |
| } | |
| EXPORT_SYMBOL(ipmi_smi_msg_received); | |
| void ipmi_smi_watchdog_pretimeout(struct ipmi_smi *intf) | |
| { | |
| if (intf->in_shutdown) | |
| return; | |
| atomic_set(&intf->watchdog_pretimeouts_to_deliver, 1); | |
| tasklet_schedule(&intf->recv_tasklet); | |
| } | |
| EXPORT_SYMBOL(ipmi_smi_watchdog_pretimeout); | |
| static struct ipmi_smi_msg * | |
| smi_from_recv_msg(struct ipmi_smi *intf, struct ipmi_recv_msg *recv_msg, | |
| unsigned char seq, long seqid) | |
| { | |
| struct ipmi_smi_msg *smi_msg = ipmi_alloc_smi_msg(); | |
| if (!smi_msg) | |
| /* | |
| * If we can't allocate the message, then just return, we | |
| * get 4 retries, so this should be ok. | |
| */ | |
| return NULL; | |
| memcpy(smi_msg->data, recv_msg->msg.data, recv_msg->msg.data_len); | |
| smi_msg->data_size = recv_msg->msg.data_len; | |
| smi_msg->msgid = STORE_SEQ_IN_MSGID(seq, seqid); | |
| dev_dbg(intf->si_dev, "Resend: %*ph\n", | |
| smi_msg->data_size, smi_msg->data); | |
| return smi_msg; | |
| } | |
| static void check_msg_timeout(struct ipmi_smi *intf, struct seq_table *ent, | |
| struct list_head *timeouts, | |
| unsigned long timeout_period, | |
| int slot, unsigned long *flags, | |
| bool *need_timer) | |
| { | |
| struct ipmi_recv_msg *msg; | |
| if (intf->in_shutdown) | |
| return; | |
| if (!ent->inuse) | |
| return; | |
| if (timeout_period < ent->timeout) { | |
| ent->timeout -= timeout_period; | |
| *need_timer = true; | |
| return; | |
| } | |
| if (ent->retries_left == 0) { | |
| /* The message has used all its retries. */ | |
| ent->inuse = 0; | |
| smi_remove_watch(intf, IPMI_WATCH_MASK_CHECK_MESSAGES); | |
| msg = ent->recv_msg; | |
| list_add_tail(&msg->link, timeouts); | |
| if (ent->broadcast) | |
| ipmi_inc_stat(intf, timed_out_ipmb_broadcasts); | |
| else if (is_lan_addr(&ent->recv_msg->addr)) | |
| ipmi_inc_stat(intf, timed_out_lan_commands); | |
| else | |
| ipmi_inc_stat(intf, timed_out_ipmb_commands); | |
| } else { | |
| struct ipmi_smi_msg *smi_msg; | |
| /* More retries, send again. */ | |
| *need_timer = true; | |
| /* | |
| * Start with the max timer, set to normal timer after | |
| * the message is sent. | |
| */ | |
| ent->timeout = MAX_MSG_TIMEOUT; | |
| ent->retries_left--; | |
| smi_msg = smi_from_recv_msg(intf, ent->recv_msg, slot, | |
| ent->seqid); | |
| if (!smi_msg) { | |
| if (is_lan_addr(&ent->recv_msg->addr)) | |
| ipmi_inc_stat(intf, | |
| dropped_rexmit_lan_commands); | |
| else | |
| ipmi_inc_stat(intf, | |
| dropped_rexmit_ipmb_commands); | |
| return; | |
| } | |
| spin_unlock_irqrestore(&intf->seq_lock, *flags); | |
| /* | |
| * Send the new message. We send with a zero | |
| * priority. It timed out, I doubt time is that | |
| * critical now, and high priority messages are really | |
| * only for messages to the local MC, which don't get | |
| * resent. | |
| */ | |
| if (intf->handlers) { | |
| if (is_lan_addr(&ent->recv_msg->addr)) | |
| ipmi_inc_stat(intf, | |
| retransmitted_lan_commands); | |
| else | |
| ipmi_inc_stat(intf, | |
| retransmitted_ipmb_commands); | |
| smi_send(intf, intf->handlers, smi_msg, 0); | |
| } else | |
| ipmi_free_smi_msg(smi_msg); | |
| spin_lock_irqsave(&intf->seq_lock, *flags); | |
| } | |
| } | |
| static bool ipmi_timeout_handler(struct ipmi_smi *intf, | |
| unsigned long timeout_period) | |
| { | |
| struct list_head timeouts; | |
| struct ipmi_recv_msg *msg, *msg2; | |
| unsigned long flags; | |
| int i; | |
| bool need_timer = false; | |
| if (!intf->bmc_registered) { | |
| kref_get(&intf->refcount); | |
| if (!schedule_work(&intf->bmc_reg_work)) { | |
| kref_put(&intf->refcount, intf_free); | |
| need_timer = true; | |
| } | |
| } | |
| /* | |
| * Go through the seq table and find any messages that | |
| * have timed out, putting them in the timeouts | |
| * list. | |
| */ | |
| INIT_LIST_HEAD(&timeouts); | |
| spin_lock_irqsave(&intf->seq_lock, flags); | |
| if (intf->ipmb_maintenance_mode_timeout) { | |
| if (intf->ipmb_maintenance_mode_timeout <= timeout_period) | |
| intf->ipmb_maintenance_mode_timeout = 0; | |
| else | |
| intf->ipmb_maintenance_mode_timeout -= timeout_period; | |
| } | |
| for (i = 0; i < IPMI_IPMB_NUM_SEQ; i++) | |
| check_msg_timeout(intf, &intf->seq_table[i], | |
| &timeouts, timeout_period, i, | |
| &flags, &need_timer); | |
| spin_unlock_irqrestore(&intf->seq_lock, flags); | |
| list_for_each_entry_safe(msg, msg2, &timeouts, link) | |
| deliver_err_response(intf, msg, IPMI_TIMEOUT_COMPLETION_CODE); | |
| /* | |
| * Maintenance mode handling. Check the timeout | |
| * optimistically before we claim the lock. It may | |
| * mean a timeout gets missed occasionally, but that | |
| * only means the timeout gets extended by one period | |
| * in that case. No big deal, and it avoids the lock | |
| * most of the time. | |
| */ | |
| if (intf->auto_maintenance_timeout > 0) { | |
| spin_lock_irqsave(&intf->maintenance_mode_lock, flags); | |
| if (intf->auto_maintenance_timeout > 0) { | |
| intf->auto_maintenance_timeout | |
| -= timeout_period; | |
| if (!intf->maintenance_mode | |
| && (intf->auto_maintenance_timeout <= 0)) { | |
| intf->maintenance_mode_enable = false; | |
| maintenance_mode_update(intf); | |
| } | |
| } | |
| spin_unlock_irqrestore(&intf->maintenance_mode_lock, | |
| flags); | |
| } | |
| tasklet_schedule(&intf->recv_tasklet); | |
| return need_timer; | |
| } | |
| static void ipmi_request_event(struct ipmi_smi *intf) | |
| { | |
| /* No event requests when in maintenance mode. */ | |
| if (intf->maintenance_mode_enable) | |
| return; | |
| if (!intf->in_shutdown) | |
| intf->handlers->request_events(intf->send_info); | |
| } | |
| static struct timer_list ipmi_timer; | |
| static atomic_t stop_operation; | |
| static void ipmi_timeout(struct timer_list *unused) | |
| { | |
| struct ipmi_smi *intf; | |
| bool need_timer = false; | |
| int index; | |
| if (atomic_read(&stop_operation)) | |
| return; | |
| index = srcu_read_lock(&ipmi_interfaces_srcu); | |
| list_for_each_entry_rcu(intf, &ipmi_interfaces, link) { | |
| if (atomic_read(&intf->event_waiters)) { | |
| intf->ticks_to_req_ev--; | |
| if (intf->ticks_to_req_ev == 0) { | |
| ipmi_request_event(intf); | |
| intf->ticks_to_req_ev = IPMI_REQUEST_EV_TIME; | |
| } | |
| need_timer = true; | |
| } | |
| need_timer |= ipmi_timeout_handler(intf, IPMI_TIMEOUT_TIME); | |
| } | |
| srcu_read_unlock(&ipmi_interfaces_srcu, index); | |
| if (need_timer) | |
| mod_timer(&ipmi_timer, jiffies + IPMI_TIMEOUT_JIFFIES); | |
| } | |
| static void need_waiter(struct ipmi_smi *intf) | |
| { | |
| /* Racy, but worst case we start the timer twice. */ | |
| if (!timer_pending(&ipmi_timer)) | |
| mod_timer(&ipmi_timer, jiffies + IPMI_TIMEOUT_JIFFIES); | |
| } | |
| static atomic_t smi_msg_inuse_count = ATOMIC_INIT(0); | |
| static atomic_t recv_msg_inuse_count = ATOMIC_INIT(0); | |
| static void free_smi_msg(struct ipmi_smi_msg *msg) | |
| { | |
| atomic_dec(&smi_msg_inuse_count); | |
| /* Try to keep as much stuff out of the panic path as possible. */ | |
| if (!oops_in_progress) | |
| kfree(msg); | |
| } | |
| struct ipmi_smi_msg *ipmi_alloc_smi_msg(void) | |
| { | |
| struct ipmi_smi_msg *rv; | |
| rv = kmalloc(sizeof(struct ipmi_smi_msg), GFP_ATOMIC); | |
| if (rv) { | |
| rv->done = free_smi_msg; | |
| rv->user_data = NULL; | |
| rv->type = IPMI_SMI_MSG_TYPE_NORMAL; | |
| atomic_inc(&smi_msg_inuse_count); | |
| } | |
| return rv; | |
| } | |
| EXPORT_SYMBOL(ipmi_alloc_smi_msg); | |
| static void free_recv_msg(struct ipmi_recv_msg *msg) | |
| { | |
| atomic_dec(&recv_msg_inuse_count); | |
| /* Try to keep as much stuff out of the panic path as possible. */ | |
| if (!oops_in_progress) | |
| kfree(msg); | |
| } | |
| static struct ipmi_recv_msg *ipmi_alloc_recv_msg(void) | |
| { | |
| struct ipmi_recv_msg *rv; | |
| rv = kmalloc(sizeof(struct ipmi_recv_msg), GFP_ATOMIC); | |
| if (rv) { | |
| rv->user = NULL; | |
| rv->done = free_recv_msg; | |
| atomic_inc(&recv_msg_inuse_count); | |
| } | |
| return rv; | |
| } | |
| void ipmi_free_recv_msg(struct ipmi_recv_msg *msg) | |
| { | |
| if (msg->user && !oops_in_progress) | |
| kref_put(&msg->user->refcount, free_user); | |
| msg->done(msg); | |
| } | |
| EXPORT_SYMBOL(ipmi_free_recv_msg); | |
| static atomic_t panic_done_count = ATOMIC_INIT(0); | |
| static void dummy_smi_done_handler(struct ipmi_smi_msg *msg) | |
| { | |
| atomic_dec(&panic_done_count); | |
| } | |
| static void dummy_recv_done_handler(struct ipmi_recv_msg *msg) | |
| { | |
| atomic_dec(&panic_done_count); | |
| } | |
| /* | |
| * Inside a panic, send a message and wait for a response. | |
| */ | |
| static void ipmi_panic_request_and_wait(struct ipmi_smi *intf, | |
| struct ipmi_addr *addr, | |
| struct kernel_ipmi_msg *msg) | |
| { | |
| struct ipmi_smi_msg smi_msg; | |
| struct ipmi_recv_msg recv_msg; | |
| int rv; | |
| smi_msg.done = dummy_smi_done_handler; | |
| recv_msg.done = dummy_recv_done_handler; | |
| atomic_add(2, &panic_done_count); | |
| rv = i_ipmi_request(NULL, | |
| intf, | |
| addr, | |
| 0, | |
| msg, | |
| intf, | |
| &smi_msg, | |
| &recv_msg, | |
| 0, | |
| intf->addrinfo[0].address, | |
| intf->addrinfo[0].lun, | |
| 0, 1); /* Don't retry, and don't wait. */ | |
| if (rv) | |
| atomic_sub(2, &panic_done_count); | |
| else if (intf->handlers->flush_messages) | |
| intf->handlers->flush_messages(intf->send_info); | |
| while (atomic_read(&panic_done_count) != 0) | |
| ipmi_poll(intf); | |
| } | |
| static void event_receiver_fetcher(struct ipmi_smi *intf, | |
| struct ipmi_recv_msg *msg) | |
| { | |
| if ((msg->addr.addr_type == IPMI_SYSTEM_INTERFACE_ADDR_TYPE) | |
| && (msg->msg.netfn == IPMI_NETFN_SENSOR_EVENT_RESPONSE) | |
| && (msg->msg.cmd == IPMI_GET_EVENT_RECEIVER_CMD) | |
| && (msg->msg.data[0] == IPMI_CC_NO_ERROR)) { | |
| /* A get event receiver command, save it. */ | |
| intf->event_receiver = msg->msg.data[1]; | |
| intf->event_receiver_lun = msg->msg.data[2] & 0x3; | |
| } | |
| } | |
| static void device_id_fetcher(struct ipmi_smi *intf, struct ipmi_recv_msg *msg) | |
| { | |
| if ((msg->addr.addr_type == IPMI_SYSTEM_INTERFACE_ADDR_TYPE) | |
| && (msg->msg.netfn == IPMI_NETFN_APP_RESPONSE) | |
| && (msg->msg.cmd == IPMI_GET_DEVICE_ID_CMD) | |
| && (msg->msg.data[0] == IPMI_CC_NO_ERROR)) { | |
| /* | |
| * A get device id command, save if we are an event | |
| * receiver or generator. | |
| */ | |
| intf->local_sel_device = (msg->msg.data[6] >> 2) & 1; | |
| intf->local_event_generator = (msg->msg.data[6] >> 5) & 1; | |
| } | |
| } | |
| static void send_panic_events(struct ipmi_smi *intf, char *str) | |
| { | |
| struct kernel_ipmi_msg msg; | |
| unsigned char data[16]; | |
| struct ipmi_system_interface_addr *si; | |
| struct ipmi_addr addr; | |
| char *p = str; | |
| struct ipmi_ipmb_addr *ipmb; | |
| int j; | |
| if (ipmi_send_panic_event == IPMI_SEND_PANIC_EVENT_NONE) | |
| return; | |
| si = (struct ipmi_system_interface_addr *) &addr; | |
| si->addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| si->channel = IPMI_BMC_CHANNEL; | |
| si->lun = 0; | |
| /* Fill in an event telling that we have failed. */ | |
| msg.netfn = 0x04; /* Sensor or Event. */ | |
| msg.cmd = 2; /* Platform event command. */ | |
| msg.data = data; | |
| msg.data_len = 8; | |
| data[0] = 0x41; /* Kernel generator ID, IPMI table 5-4 */ | |
| data[1] = 0x03; /* This is for IPMI 1.0. */ | |
| data[2] = 0x20; /* OS Critical Stop, IPMI table 36-3 */ | |
| data[4] = 0x6f; /* Sensor specific, IPMI table 36-1 */ | |
| data[5] = 0xa1; /* Runtime stop OEM bytes 2 & 3. */ | |
| /* | |
| * Put a few breadcrumbs in. Hopefully later we can add more things | |
| * to make the panic events more useful. | |
| */ | |
| if (str) { | |
| data[3] = str[0]; | |
| data[6] = str[1]; | |
| data[7] = str[2]; | |
| } | |
| /* Send the event announcing the panic. */ | |
| ipmi_panic_request_and_wait(intf, &addr, &msg); | |
| /* | |
| * On every interface, dump a bunch of OEM event holding the | |
| * string. | |
| */ | |
| if (ipmi_send_panic_event != IPMI_SEND_PANIC_EVENT_STRING || !str) | |
| return; | |
| /* | |
| * intf_num is used as an marker to tell if the | |
| * interface is valid. Thus we need a read barrier to | |
| * make sure data fetched before checking intf_num | |
| * won't be used. | |
| */ | |
| smp_rmb(); | |
| /* | |
| * First job here is to figure out where to send the | |
| * OEM events. There's no way in IPMI to send OEM | |
| * events using an event send command, so we have to | |
| * find the SEL to put them in and stick them in | |
| * there. | |
| */ | |
| /* Get capabilities from the get device id. */ | |
| intf->local_sel_device = 0; | |
| intf->local_event_generator = 0; | |
| intf->event_receiver = 0; | |
| /* Request the device info from the local MC. */ | |
| msg.netfn = IPMI_NETFN_APP_REQUEST; | |
| msg.cmd = IPMI_GET_DEVICE_ID_CMD; | |
| msg.data = NULL; | |
| msg.data_len = 0; | |
| intf->null_user_handler = device_id_fetcher; | |
| ipmi_panic_request_and_wait(intf, &addr, &msg); | |
| if (intf->local_event_generator) { | |
| /* Request the event receiver from the local MC. */ | |
| msg.netfn = IPMI_NETFN_SENSOR_EVENT_REQUEST; | |
| msg.cmd = IPMI_GET_EVENT_RECEIVER_CMD; | |
| msg.data = NULL; | |
| msg.data_len = 0; | |
| intf->null_user_handler = event_receiver_fetcher; | |
| ipmi_panic_request_and_wait(intf, &addr, &msg); | |
| } | |
| intf->null_user_handler = NULL; | |
| /* | |
| * Validate the event receiver. The low bit must not | |
| * be 1 (it must be a valid IPMB address), it cannot | |
| * be zero, and it must not be my address. | |
| */ | |
| if (((intf->event_receiver & 1) == 0) | |
| && (intf->event_receiver != 0) | |
| && (intf->event_receiver != intf->addrinfo[0].address)) { | |
| /* | |
| * The event receiver is valid, send an IPMB | |
| * message. | |
| */ | |
| ipmb = (struct ipmi_ipmb_addr *) &addr; | |
| ipmb->addr_type = IPMI_IPMB_ADDR_TYPE; | |
| ipmb->channel = 0; /* FIXME - is this right? */ | |
| ipmb->lun = intf->event_receiver_lun; | |
| ipmb->slave_addr = intf->event_receiver; | |
| } else if (intf->local_sel_device) { | |
| /* | |
| * The event receiver was not valid (or was | |
| * me), but I am an SEL device, just dump it | |
| * in my SEL. | |
| */ | |
| si = (struct ipmi_system_interface_addr *) &addr; | |
| si->addr_type = IPMI_SYSTEM_INTERFACE_ADDR_TYPE; | |
| si->channel = IPMI_BMC_CHANNEL; | |
| si->lun = 0; | |
| } else | |
| return; /* No where to send the event. */ | |
| msg.netfn = IPMI_NETFN_STORAGE_REQUEST; /* Storage. */ | |
| msg.cmd = IPMI_ADD_SEL_ENTRY_CMD; | |
| msg.data = data; | |
| msg.data_len = 16; | |
| j = 0; | |
| while (*p) { | |
| int size = strnlen(p, 11); | |
| data[0] = 0; | |
| data[1] = 0; | |
| data[2] = 0xf0; /* OEM event without timestamp. */ | |
| data[3] = intf->addrinfo[0].address; | |
| data[4] = j++; /* sequence # */ | |
| memcpy_and_pad(data+5, 11, p, size, '\0'); | |
| p += size; | |
| ipmi_panic_request_and_wait(intf, &addr, &msg); | |
| } | |
| } | |
| static int has_panicked; | |
| static int panic_event(struct notifier_block *this, | |
| unsigned long event, | |
| void *ptr) | |
| { | |
| struct ipmi_smi *intf; | |
| struct ipmi_user *user; | |
| if (has_panicked) | |
| return NOTIFY_DONE; | |
| has_panicked = 1; | |
| /* For every registered interface, set it to run to completion. */ | |
| list_for_each_entry_rcu(intf, &ipmi_interfaces, link) { | |
| if (!intf->handlers || intf->intf_num == -1) | |
| /* Interface is not ready. */ | |
| continue; | |
| if (!intf->handlers->poll) | |
| continue; | |
| /* | |
| * If we were interrupted while locking xmit_msgs_lock or | |
| * waiting_rcv_msgs_lock, the corresponding list may be | |
| * corrupted. In this case, drop items on the list for | |
| * the safety. | |
| */ | |
| if (!spin_trylock(&intf->xmit_msgs_lock)) { | |
| INIT_LIST_HEAD(&intf->xmit_msgs); | |
| INIT_LIST_HEAD(&intf->hp_xmit_msgs); | |
| } else | |
| spin_unlock(&intf->xmit_msgs_lock); | |
| if (!spin_trylock(&intf->waiting_rcv_msgs_lock)) | |
| INIT_LIST_HEAD(&intf->waiting_rcv_msgs); | |
| else | |
| spin_unlock(&intf->waiting_rcv_msgs_lock); | |
| intf->run_to_completion = 1; | |
| if (intf->handlers->set_run_to_completion) | |
| intf->handlers->set_run_to_completion(intf->send_info, | |
| 1); | |
| list_for_each_entry_rcu(user, &intf->users, link) { | |
| if (user->handler->ipmi_panic_handler) | |
| user->handler->ipmi_panic_handler( | |
| user->handler_data); | |
| } | |
| send_panic_events(intf, ptr); | |
| } | |
| return NOTIFY_DONE; | |
| } | |
| /* Must be called with ipmi_interfaces_mutex held. */ | |
| static int ipmi_register_driver(void) | |
| { | |
| int rv; | |
| if (drvregistered) | |
| return 0; | |
| rv = driver_register(&ipmidriver.driver); | |
| if (rv) | |
| pr_err("Could not register IPMI driver\n"); | |
| else | |
| drvregistered = true; | |
| return rv; | |
| } | |
| static struct notifier_block panic_block = { | |
| .notifier_call = panic_event, | |
| .next = NULL, | |
| .priority = 200 /* priority: INT_MAX >= x >= 0 */ | |
| }; | |
| static int ipmi_init_msghandler(void) | |
| { | |
| int rv; | |
| mutex_lock(&ipmi_interfaces_mutex); | |
| rv = ipmi_register_driver(); | |
| if (rv) | |
| goto out; | |
| if (initialized) | |
| goto out; | |
| rv = init_srcu_struct(&ipmi_interfaces_srcu); | |
| if (rv) | |
| goto out; | |
| remove_work_wq = create_singlethread_workqueue("ipmi-msghandler-remove-wq"); | |
| if (!remove_work_wq) { | |
| pr_err("unable to create ipmi-msghandler-remove-wq workqueue"); | |
| rv = -ENOMEM; | |
| goto out_wq; | |
| } | |
| timer_setup(&ipmi_timer, ipmi_timeout, 0); | |
| mod_timer(&ipmi_timer, jiffies + IPMI_TIMEOUT_JIFFIES); | |
| atomic_notifier_chain_register(&panic_notifier_list, &panic_block); | |
| initialized = true; | |
| out_wq: | |
| if (rv) | |
| cleanup_srcu_struct(&ipmi_interfaces_srcu); | |
| out: | |
| mutex_unlock(&ipmi_interfaces_mutex); | |
| return rv; | |
| } | |
| static int __init ipmi_init_msghandler_mod(void) | |
| { | |
| int rv; | |
| pr_info("version " IPMI_DRIVER_VERSION "\n"); | |
| mutex_lock(&ipmi_interfaces_mutex); | |
| rv = ipmi_register_driver(); | |
| mutex_unlock(&ipmi_interfaces_mutex); | |
| return rv; | |
| } | |
| static void __exit cleanup_ipmi(void) | |
| { | |
| int count; | |
| if (initialized) { | |
| destroy_workqueue(remove_work_wq); | |
| atomic_notifier_chain_unregister(&panic_notifier_list, | |
| &panic_block); | |
| /* | |
| * This can't be called if any interfaces exist, so no worry | |
| * about shutting down the interfaces. | |
| */ | |
| /* | |
| * Tell the timer to stop, then wait for it to stop. This | |
| * avoids problems with race conditions removing the timer | |
| * here. | |
| */ | |
| atomic_set(&stop_operation, 1); | |
| del_timer_sync(&ipmi_timer); | |
| initialized = false; | |
| /* Check for buffer leaks. */ | |
| count = atomic_read(&smi_msg_inuse_count); | |
| if (count != 0) | |
| pr_warn("SMI message count %d at exit\n", count); | |
| count = atomic_read(&recv_msg_inuse_count); | |
| if (count != 0) | |
| pr_warn("recv message count %d at exit\n", count); | |
| cleanup_srcu_struct(&ipmi_interfaces_srcu); | |
| } | |
| if (drvregistered) | |
| driver_unregister(&ipmidriver.driver); | |
| } | |
| module_exit(cleanup_ipmi); | |
| module_init(ipmi_init_msghandler_mod); | |
| MODULE_LICENSE("GPL"); | |
| MODULE_AUTHOR("Corey Minyard <minyard@mvista.com>"); | |
| MODULE_DESCRIPTION("Incoming and outgoing message routing for an IPMI interface."); | |
| MODULE_VERSION(IPMI_DRIVER_VERSION); | |
| MODULE_SOFTDEP("post: ipmi_devintf"); |