i2o_core.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:85k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * Core I2O structure management 
  3.  * 
  4.  * (C) Copyright 1999   Red Hat Software 
  5.  *
  6.  * Written by Alan Cox, Building Number Three Ltd 
  7.  * 
  8.  * This program is free software; you can redistribute it and/or 
  9.  * modify it under the terms of the GNU General Public License 
  10.  * as published by the Free Software Foundation; either version 
  11.  * 2 of the License, or (at your option) any later version.  
  12.  * 
  13.  * A lot of the I2O message side code from this is taken from the 
  14.  * Red Creek RCPCI45 adapter driver by Red Creek Communications 
  15.  * 
  16.  * Fixes by: 
  17.  * Philipp Rumpf 
  18.  * Juha Siev鋘en <Juha.Sievanen@cs.Helsinki.FI> 
  19.  * Auvo H鋕kinen <Auvo.Hakkinen@cs.Helsinki.FI> 
  20.  * Deepak Saxena <deepak@plexity.net> 
  21.  * Boji T Kannanthanam <boji.t.kannanthanam@intel.com>
  22.  * 
  23.  */
  24. #include <linux/config.h>
  25. #include <linux/module.h>
  26. #include <linux/kernel.h>
  27. #include <linux/pci.h>
  28. #include <linux/i2o.h>
  29. #include <linux/errno.h>
  30. #include <linux/init.h>
  31. #include <linux/slab.h>
  32. #include <linux/spinlock.h>
  33. #include <linux/smp_lock.h>
  34. #include <linux/bitops.h>
  35. #include <linux/wait.h>
  36. #include <linux/delay.h>
  37. #include <linux/timer.h>
  38. #include <linux/tqueue.h>
  39. #include <linux/interrupt.h>
  40. #include <linux/sched.h>
  41. #include <asm/semaphore.h>
  42. #include <linux/completion.h>
  43. #include <asm/io.h>
  44. #include <linux/reboot.h>
  45. #include "i2o_lan.h"
  46. //#define DRIVERDEBUG
  47. #ifdef DRIVERDEBUG
  48. #define dprintk(s, args...) printk(s, ## args)
  49. #else
  50. #define dprintk(s, args...)
  51. #endif
  52. /* OSM table */
  53. static struct i2o_handler *i2o_handlers[MAX_I2O_MODULES];
  54. /* Controller list */
  55. static struct i2o_controller *i2o_controllers[MAX_I2O_CONTROLLERS];
  56. struct i2o_controller *i2o_controller_chain;
  57. int i2o_num_controllers;
  58. /* Initiator Context for Core message */
  59. static int core_context;
  60. /* Initialization && shutdown functions */
  61. static void i2o_sys_init(void);
  62. static void i2o_sys_shutdown(void);
  63. static int i2o_reset_controller(struct i2o_controller *);
  64. static int i2o_reboot_event(struct notifier_block *, unsigned long , void *);
  65. static int i2o_online_controller(struct i2o_controller *);
  66. static int i2o_init_outbound_q(struct i2o_controller *);
  67. static int i2o_post_outbound_messages(struct i2o_controller *);
  68. /* Reply handler */
  69. static void i2o_core_reply(struct i2o_handler *, struct i2o_controller *,
  70.    struct i2o_message *);
  71. /* Various helper functions */
  72. static int i2o_lct_get(struct i2o_controller *);
  73. static int i2o_lct_notify(struct i2o_controller *);
  74. static int i2o_hrt_get(struct i2o_controller *);
  75. static int i2o_build_sys_table(void);
  76. static int i2o_systab_send(struct i2o_controller *c);
  77. /* I2O core event handler */
  78. static int i2o_core_evt(void *);
  79. static int evt_pid;
  80. static int evt_running;
  81. /* Dynamic LCT update handler */
  82. static int i2o_dyn_lct(void *);
  83. void i2o_report_controller_unit(struct i2o_controller *, struct i2o_device *);
  84. /*
  85.  * I2O System Table.  Contains information about
  86.  * all the IOPs in the system.  Used to inform IOPs
  87.  * about each other's existence.
  88.  *
  89.  * sys_tbl_ver is the CurrentChangeIndicator that is
  90.  * used by IOPs to track changes.
  91.  */
  92. static struct i2o_sys_tbl *sys_tbl;
  93. static int sys_tbl_ind;
  94. static int sys_tbl_len;
  95. /*
  96.  * This spin lock is used to keep a device from being
  97.  * added and deleted concurrently across CPUs or interrupts.
  98.  * This can occur when a user creates a device and immediatelly
  99.  * deletes it before the new_dev_notify() handler is called.
  100.  */
  101. static spinlock_t i2o_dev_lock = SPIN_LOCK_UNLOCKED;
  102. #ifdef MODULE
  103. /* 
  104.  * Function table to send to bus specific layers
  105.  * See <include/linux/i2o.h> for explanation of this
  106.  */
  107. static struct i2o_core_func_table i2o_core_functions =
  108. {
  109. i2o_install_controller,
  110. i2o_activate_controller,
  111. i2o_find_controller,
  112. i2o_unlock_controller,
  113. i2o_run_queue,
  114. i2o_delete_controller
  115. };
  116. #ifdef CONFIG_I2O_PCI_MODULE
  117. extern int i2o_pci_core_attach(struct i2o_core_func_table *);
  118. extern void i2o_pci_core_detach(void);
  119. #endif /* CONFIG_I2O_PCI_MODULE */
  120. #endif /* MODULE */
  121. /*
  122.  * Structures and definitions for synchronous message posting.
  123.  * See i2o_post_wait() for description.
  124.  */ 
  125. struct i2o_post_wait_data
  126. {
  127. int *status; /* Pointer to status block on caller stack */
  128. int *complete; /* Pointer to completion flag on caller stack */
  129. u32 id; /* Unique identifier */
  130. wait_queue_head_t *wq; /* Wake up for caller (NULL for dead) */
  131. struct i2o_post_wait_data *next; /* Chain */
  132. void *mem[2]; /* Memory blocks to recover on failure path */
  133. };
  134. static struct i2o_post_wait_data *post_wait_queue;
  135. static u32 post_wait_id; // Unique ID for each post_wait
  136. static spinlock_t post_wait_lock = SPIN_LOCK_UNLOCKED;
  137. static void i2o_post_wait_complete(u32, int);
  138. /* OSM descriptor handler */ 
  139. static struct i2o_handler i2o_core_handler =
  140. {
  141. (void *)i2o_core_reply,
  142. NULL,
  143. NULL,
  144. NULL,
  145. "I2O core layer",
  146. 0,
  147. I2O_CLASS_EXECUTIVE
  148. };
  149. /*
  150.  * Used when queueing a reply to be handled later
  151.  */
  152.  
  153. struct reply_info
  154. {
  155. struct i2o_controller *iop;
  156. u32 msg[MSG_FRAME_SIZE];
  157. };
  158. static struct reply_info evt_reply;
  159. static struct reply_info events[I2O_EVT_Q_LEN];
  160. static int evt_in;
  161. static int evt_out;
  162. static int evt_q_len;
  163. #define MODINC(x,y) ((x) = ((x) + 1) % (y))
  164. /*
  165.  * I2O configuration spinlock. This isnt a big deal for contention
  166.  * so we have one only
  167.  */
  168. static DECLARE_MUTEX(i2o_configuration_lock);
  169. /* 
  170.  * Event spinlock.  Used to keep event queue sane and from
  171.  * handling multiple events simultaneously.
  172.  */
  173. static spinlock_t i2o_evt_lock = SPIN_LOCK_UNLOCKED;
  174. /*
  175.  * Semaphore used to synchronize event handling thread with 
  176.  * interrupt handler.
  177.  */
  178.  
  179. static DECLARE_MUTEX(evt_sem);
  180. static DECLARE_COMPLETION(evt_dead);
  181. static DECLARE_WAIT_QUEUE_HEAD(evt_wait);
  182. static struct notifier_block i2o_reboot_notifier =
  183. {
  184.         i2o_reboot_event,
  185.         NULL,
  186.         0
  187. };
  188. /*
  189.  * Config options
  190.  */
  191. static int verbose;
  192. MODULE_PARM(verbose, "i");
  193. /*
  194.  * I2O Core reply handler
  195.  */
  196. static void i2o_core_reply(struct i2o_handler *h, struct i2o_controller *c,
  197.     struct i2o_message *m)
  198. {
  199. u32 *msg=(u32 *)m;
  200. u32 status;
  201. u32 context = msg[2];
  202. if (msg[0] & MSG_FAIL) // Fail bit is set
  203. {
  204. u32 *preserved_msg = (u32*)(c->mem_offset + msg[7]);
  205. i2o_report_status(KERN_INFO, "i2o_core", msg);
  206. i2o_dump_message(preserved_msg);
  207. /* If the failed request needs special treatment,
  208.  * it should be done here. */
  209.                 /* Release the preserved msg by resubmitting it as a NOP */
  210. preserved_msg[0] = cpu_to_le32(THREE_WORD_MSG_SIZE | SGL_OFFSET_0);
  211. preserved_msg[1] = cpu_to_le32(I2O_CMD_UTIL_NOP << 24 | HOST_TID << 12 | 0);
  212. preserved_msg[2] = 0;
  213. i2o_post_message(c, msg[7]);
  214. /* If reply to i2o_post_wait failed, return causes a timeout */
  215. return;
  216. }       
  217. #ifdef DRIVERDEBUG
  218. i2o_report_status(KERN_INFO, "i2o_core", msg);
  219. #endif
  220. if(msg[2]&0x80000000) // Post wait message
  221. {
  222. if (msg[4] >> 24)
  223. status = (msg[4] & 0xFFFF);
  224. else
  225. status = I2O_POST_WAIT_OK;
  226. i2o_post_wait_complete(context, status);
  227. return;
  228. }
  229. if(m->function == I2O_CMD_UTIL_EVT_REGISTER)
  230. {
  231. memcpy(events[evt_in].msg, msg, (msg[0]>>16)<<2);
  232. events[evt_in].iop = c;
  233. spin_lock(&i2o_evt_lock);
  234. MODINC(evt_in, I2O_EVT_Q_LEN);
  235. if(evt_q_len == I2O_EVT_Q_LEN)
  236. MODINC(evt_out, I2O_EVT_Q_LEN);
  237. else
  238. evt_q_len++;
  239. spin_unlock(&i2o_evt_lock);
  240. up(&evt_sem);
  241. wake_up_interruptible(&evt_wait);
  242. return;
  243. }
  244. if(m->function == I2O_CMD_LCT_NOTIFY)
  245. {
  246. up(&c->lct_sem);
  247. return;
  248. }
  249. /*
  250.  * If this happens, we want to dump the message to the syslog so
  251.  * it can be sent back to the card manufacturer by the end user
  252.  * to aid in debugging.
  253.  * 
  254.  */
  255. printk(KERN_WARNING "%s: Unsolicited message reply sent to core!"
  256. "Message dumped to syslogn", 
  257. c->name);
  258. i2o_dump_message(msg);
  259. return;
  260. }
  261. /**
  262.  * i2o_install_handler - install a message handler
  263.  * @h: Handler structure
  264.  *
  265.  * Install an I2O handler - these handle the asynchronous messaging
  266.  * from the card once it has initialised. If the table of handlers is
  267.  * full then -ENOSPC is returned. On a success 0 is returned and the
  268.  * context field is set by the function. The structure is part of the
  269.  * system from this time onwards. It must not be freed until it has
  270.  * been uninstalled
  271.  */
  272.  
  273. int i2o_install_handler(struct i2o_handler *h)
  274. {
  275. int i;
  276. down(&i2o_configuration_lock);
  277. for(i=0;i<MAX_I2O_MODULES;i++)
  278. {
  279. if(i2o_handlers[i]==NULL)
  280. {
  281. h->context = i;
  282. i2o_handlers[i]=h;
  283. up(&i2o_configuration_lock);
  284. return 0;
  285. }
  286. }
  287. up(&i2o_configuration_lock);
  288. return -ENOSPC;
  289. }
  290. /**
  291.  * i2o_remove_handler - remove an i2o message handler
  292.  * @h: handler
  293.  *
  294.  * Remove a message handler previously installed with i2o_install_handler.
  295.  * After this function returns the handler object can be freed or re-used
  296.  */
  297.  
  298. int i2o_remove_handler(struct i2o_handler *h)
  299. {
  300. i2o_handlers[h->context]=NULL;
  301. return 0;
  302. }
  303. /*
  304.  * Each I2O controller has a chain of devices on it.
  305.  * Each device has a pointer to it's LCT entry to be used
  306.  * for fun purposes.
  307.  */
  308. /**
  309.  * i2o_install_device - attach a device to a controller
  310.  * @c: controller
  311.  * @d: device
  312.  * 
  313.  * Add a new device to an i2o controller. This can be called from
  314.  * non interrupt contexts only. It adds the device and marks it as
  315.  * unclaimed. The device memory becomes part of the kernel and must
  316.  * be uninstalled before being freed or reused. Zero is returned
  317.  * on success.
  318.  */
  319.  
  320. int i2o_install_device(struct i2o_controller *c, struct i2o_device *d)
  321. {
  322. int i;
  323. down(&i2o_configuration_lock);
  324. d->controller=c;
  325. d->owner=NULL;
  326. d->next=c->devices;
  327. d->prev=NULL;
  328. if (c->devices != NULL)
  329. c->devices->prev=d;
  330. c->devices=d;
  331. *d->dev_name = 0;
  332. for(i = 0; i < I2O_MAX_MANAGERS; i++)
  333. d->managers[i] = NULL;
  334. up(&i2o_configuration_lock);
  335. return 0;
  336. }
  337. /* we need this version to call out of i2o_delete_controller */
  338. int __i2o_delete_device(struct i2o_device *d)
  339. {
  340. struct i2o_device **p;
  341. int i;
  342. p=&(d->controller->devices);
  343. /*
  344.  * Hey we have a driver!
  345.  * Check to see if the driver wants us to notify it of 
  346.  * device deletion. If it doesn't we assume that it
  347.  * is unsafe to delete a device with an owner and 
  348.  * fail.
  349.  */
  350. if(d->owner)
  351. {
  352. if(d->owner->dev_del_notify)
  353. {
  354. dprintk(KERN_INFO "Device has owner, notifyingn");
  355. d->owner->dev_del_notify(d->controller, d);
  356. if(d->owner)
  357. {
  358. printk(KERN_WARNING 
  359. "Driver "%s" did not release device!n", d->owner->name);
  360. return -EBUSY;
  361. }
  362. }
  363. else
  364. return -EBUSY;
  365. }
  366. /*
  367.  * Tell any other users who are talking to this device
  368.  * that it's going away.  We assume that everything works.
  369.  */
  370. for(i=0; i < I2O_MAX_MANAGERS; i++)
  371. {
  372. if(d->managers[i] && d->managers[i]->dev_del_notify)
  373. d->managers[i]->dev_del_notify(d->controller, d);
  374. }
  375.  
  376. while(*p!=NULL)
  377. {
  378. if(*p==d)
  379. {
  380. /*
  381.  * Destroy
  382.  */
  383. *p=d->next;
  384. kfree(d);
  385. return 0;
  386. }
  387. p=&((*p)->next);
  388. }
  389. printk(KERN_ERR "i2o_delete_device: passed invalid device.n");
  390. return -EINVAL;
  391. }
  392. /**
  393.  * i2o_delete_device - remove an i2o device
  394.  * @d: device to remove
  395.  *
  396.  * This function unhooks a device from a controller. The device
  397.  * will not be unhooked if it has an owner who does not wish to free
  398.  * it, or if the owner lacks a dev_del_notify function. In that case
  399.  * -EBUSY is returned. On success 0 is returned. Other errors cause
  400.  * negative errno values to be returned
  401.  */
  402.  
  403. int i2o_delete_device(struct i2o_device *d)
  404. {
  405. int ret;
  406. down(&i2o_configuration_lock);
  407. /*
  408.  * Seek, locate
  409.  */
  410. ret = __i2o_delete_device(d);
  411. up(&i2o_configuration_lock);
  412. return ret;
  413. }
  414. /**
  415.  * i2o_install_controller - attach a controller
  416.  * @c: controller
  417.  * 
  418.  * Add a new controller to the i2o layer. This can be called from
  419.  * non interrupt contexts only. It adds the controller and marks it as
  420.  * unused with no devices. If the tables are full or memory allocations
  421.  * fail then a negative errno code is returned. On success zero is
  422.  * returned and the controller is bound to the system. The structure
  423.  * must not be freed or reused until being uninstalled.
  424.  */
  425.  
  426. int i2o_install_controller(struct i2o_controller *c)
  427. {
  428. int i;
  429. down(&i2o_configuration_lock);
  430. for(i=0;i<MAX_I2O_CONTROLLERS;i++)
  431. {
  432. if(i2o_controllers[i]==NULL)
  433. {
  434. c->dlct = (i2o_lct*)kmalloc(8192, GFP_KERNEL);
  435. if(c->dlct==NULL)
  436. {
  437. up(&i2o_configuration_lock);
  438. return -ENOMEM;
  439. }
  440. i2o_controllers[i]=c;
  441. c->devices = NULL;
  442. c->next=i2o_controller_chain;
  443. i2o_controller_chain=c;
  444. c->unit = i;
  445. c->page_frame = NULL;
  446. c->hrt = NULL;
  447. c->lct = NULL;
  448. c->status_block = NULL;
  449. sprintf(c->name, "i2o/iop%d", i);
  450. i2o_num_controllers++;
  451. init_MUTEX_LOCKED(&c->lct_sem);
  452. up(&i2o_configuration_lock);
  453. return 0;
  454. }
  455. }
  456. printk(KERN_ERR "No free i2o controller slots.n");
  457. up(&i2o_configuration_lock);
  458. return -EBUSY;
  459. }
  460. /**
  461.  * i2o_delete_controller - delete a controller
  462.  * @c: controller
  463.  *
  464.  * Remove an i2o controller from the system. If the controller or its
  465.  * devices are busy then -EBUSY is returned. On a failure a negative
  466.  * errno code is returned. On success zero is returned.
  467.  */
  468.   
  469. int i2o_delete_controller(struct i2o_controller *c)
  470. {
  471. struct i2o_controller **p;
  472. int users;
  473. char name[16];
  474. int stat;
  475. dprintk(KERN_INFO "Deleting controller %sn", c->name);
  476. /*
  477.  * Clear event registration as this can cause weird behavior
  478.  */
  479. if(c->status_block->iop_state == ADAPTER_STATE_OPERATIONAL)
  480. i2o_event_register(c, core_context, 0, 0, 0);
  481. down(&i2o_configuration_lock);
  482. if((users=atomic_read(&c->users)))
  483. {
  484. dprintk(KERN_INFO "I2O: %d users for controller %sn", users,
  485. c->name);
  486. up(&i2o_configuration_lock);
  487. return -EBUSY;
  488. }
  489. while(c->devices)
  490. {
  491. if(__i2o_delete_device(c->devices)<0)
  492. {
  493. /* Shouldnt happen */
  494. c->bus_disable(c);
  495. up(&i2o_configuration_lock);
  496. return -EBUSY;
  497. }
  498. }
  499. /*
  500.  * If this is shutdown time, the thread's already been killed
  501.  */
  502. if(c->lct_running) {
  503. stat = kill_proc(c->lct_pid, SIGTERM, 1);
  504. if(!stat) {
  505. int count = 10 * 100;
  506. while(c->lct_running && --count) {
  507. current->state = TASK_INTERRUPTIBLE;
  508. schedule_timeout(1);
  509. }
  510. if(!count)
  511. printk(KERN_ERR 
  512. "%s: LCT thread still running!n", 
  513. c->name);
  514. }
  515. }
  516. p=&i2o_controller_chain;
  517. while(*p)
  518. {
  519. if(*p==c)
  520. {
  521.   /* Ask the IOP to switch to RESET state */
  522. i2o_reset_controller(c);
  523. /* Release IRQ */
  524. c->destructor(c);
  525. *p=c->next;
  526. up(&i2o_configuration_lock);
  527. if(c->page_frame)
  528. {
  529. pci_unmap_single(c->pdev, c->page_frame_map, MSG_POOL_SIZE, PCI_DMA_FROMDEVICE);
  530. kfree(c->page_frame);
  531. }
  532. if(c->hrt)
  533. kfree(c->hrt);
  534. if(c->lct)
  535. kfree(c->lct);
  536. if(c->status_block)
  537. kfree(c->status_block);
  538. if(c->dlct)
  539. kfree(c->dlct);
  540. i2o_controllers[c->unit]=NULL;
  541. memcpy(name, c->name, strlen(c->name)+1);
  542. kfree(c);
  543. dprintk(KERN_INFO "%s: Deleted from controller chain.n", name);
  544. i2o_num_controllers--;
  545. return 0;
  546. }
  547. p=&((*p)->next);
  548. }
  549. up(&i2o_configuration_lock);
  550. printk(KERN_ERR "i2o_delete_controller: bad pointer!n");
  551. return -ENOENT;
  552. }
  553. /**
  554.  * i2o_unlock_controller - unlock a controller
  555.  * @c: controller to unlock
  556.  *
  557.  * Take a lock on an i2o controller. This prevents it being deleted.
  558.  * i2o controllers are not refcounted so a deletion of an in use device
  559.  * will fail, not take affect on the last dereference.
  560.  */
  561.  
  562. void i2o_unlock_controller(struct i2o_controller *c)
  563. {
  564. atomic_dec(&c->users);
  565. }
  566. /**
  567.  * i2o_find_controller - return a locked controller
  568.  * @n: controller number
  569.  *
  570.  * Returns a pointer to the controller object. The controller is locked
  571.  * on return. NULL is returned if the controller is not found.
  572.  */
  573.  
  574. struct i2o_controller *i2o_find_controller(int n)
  575. {
  576. struct i2o_controller *c;
  577. if(n<0 || n>=MAX_I2O_CONTROLLERS)
  578. return NULL;
  579. down(&i2o_configuration_lock);
  580. c=i2o_controllers[n];
  581. if(c!=NULL)
  582. atomic_inc(&c->users);
  583. up(&i2o_configuration_lock);
  584. return c;
  585. }
  586. /**
  587.  * i2o_issue_claim - claim or release a device
  588.  * @cmd: command
  589.  * @c: controller to claim for
  590.  * @tid: i2o task id
  591.  * @type: type of claim
  592.  *
  593.  * Issue I2O UTIL_CLAIM and UTIL_RELEASE messages. The message to be sent
  594.  * is set by cmd. The tid is the task id of the object to claim and the
  595.  * type is the claim type (see the i2o standard)
  596.  *
  597.  * Zero is returned on success.
  598.  */
  599.  
  600. static int i2o_issue_claim(u32 cmd, struct i2o_controller *c, int tid, u32 type)
  601. {
  602. u32 msg[5];
  603. msg[0] = FIVE_WORD_MSG_SIZE | SGL_OFFSET_0;
  604. msg[1] = cmd << 24 | HOST_TID<<12 | tid;
  605. msg[3] = 0;
  606. msg[4] = type;
  607. return i2o_post_wait(c, msg, sizeof(msg), 60);
  608. }
  609. /*
  610.  *  i2o_claim_device - claim a device for use by an OSM
  611.  * @d: device to claim
  612.  * @h: handler for this device
  613.  *
  614.  * Do the leg work to assign a device to a given OSM on Linux. The
  615.  * kernel updates the internal handler data for the device and then
  616.  * performs an I2O claim for the device, attempting to claim the
  617.  * device as primary. If the attempt fails a negative errno code
  618.  * is returned. On success zero is returned.
  619.  */
  620.  
  621. int i2o_claim_device(struct i2o_device *d, struct i2o_handler *h)
  622. {
  623. down(&i2o_configuration_lock);
  624. if (d->owner) {
  625. printk(KERN_INFO "Device claim called, but dev already owned by %s!",
  626.        h->name);
  627. up(&i2o_configuration_lock);
  628. return -EBUSY;
  629. }
  630. d->owner=h;
  631. if(i2o_issue_claim(I2O_CMD_UTIL_CLAIM ,d->controller,d->lct_data.tid, 
  632.    I2O_CLAIM_PRIMARY))
  633. {
  634. d->owner = NULL;
  635. return -EBUSY;
  636. }
  637. up(&i2o_configuration_lock);
  638. return 0;
  639. }
  640. /**
  641.  * i2o_release_device - release a device that the OSM is using
  642.  * @d: device to claim
  643.  * @h: handler for this device
  644.  *
  645.  * Drop a claim by an OSM on a given I2O device. The handler is cleared
  646.  * and 0 is returned on success.
  647.  *
  648.  * AC - some devices seem to want to refuse an unclaim until they have
  649.  * finished internal processing. It makes sense since you don't want a
  650.  * new device to go reconfiguring the entire system until you are done.
  651.  * Thus we are prepared to wait briefly.
  652.  */
  653. int i2o_release_device(struct i2o_device *d, struct i2o_handler *h)
  654. {
  655. int err = 0;
  656. int tries;
  657. down(&i2o_configuration_lock);
  658. if (d->owner != h) {
  659. printk(KERN_INFO "Claim release called, but not owned by %s!n",
  660.        h->name);
  661. up(&i2o_configuration_lock);
  662. return -ENOENT;
  663. }
  664. for(tries=0;tries<10;tries++)
  665. {
  666. d->owner = NULL;
  667. /*
  668.  * If the controller takes a nonblocking approach to
  669.  * releases we have to sleep/poll for a few times.
  670.  */
  671.  
  672. if((err=i2o_issue_claim(I2O_CMD_UTIL_RELEASE, d->controller, d->lct_data.tid, I2O_CLAIM_PRIMARY)) )
  673. {
  674. err = -ENXIO;
  675. current->state = TASK_UNINTERRUPTIBLE;
  676. schedule_timeout(HZ);
  677. }
  678. else
  679. {
  680. err=0;
  681. break;
  682. }
  683. }
  684. up(&i2o_configuration_lock);
  685. return err;
  686. }
  687. /**
  688.  *  i2o_device_notify_on - Enable deletion notifiers
  689.  * @d: device for notification
  690.  * @h: handler to install
  691.  *
  692.  * Called by OSMs to let the core know that they want to be
  693.  * notified if the given device is deleted from the system.
  694.  */
  695. int i2o_device_notify_on(struct i2o_device *d, struct i2o_handler *h)
  696. {
  697. int i;
  698. if(d->num_managers == I2O_MAX_MANAGERS)
  699. return -ENOSPC;
  700. for(i = 0; i < I2O_MAX_MANAGERS; i++)
  701. {
  702. if(!d->managers[i])
  703. {
  704. d->managers[i] = h;
  705. break;
  706. }
  707. }
  708. d->num_managers++;
  709. return 0;
  710. }
  711. /**
  712.  *  i2o_device_notify_off - Remove deletion notifiers
  713.  * @d: device for notification
  714.  * @h: handler to remove
  715.  *
  716.  * Called by OSMs to let the core know that they no longer
  717.  * are interested in the fate of the given device.
  718.  */
  719. int i2o_device_notify_off(struct i2o_device *d, struct i2o_handler *h)
  720. {
  721. int i;
  722. for(i=0; i < I2O_MAX_MANAGERS; i++)
  723. {
  724. if(d->managers[i] == h)
  725. {
  726. d->managers[i] = NULL;
  727. d->num_managers--;
  728. return 0;
  729. }
  730. }
  731. return -ENOENT;
  732. }
  733. /**
  734.  * i2o_event_register - register interest in an event
  735.  *  @c: Controller to register interest with
  736.  * @tid: I2O task id
  737.  * @init_context: initiator context to use with this notifier
  738.  * @tr_context: transaction context to use with this notifier
  739.  * @evt_mask: mask of events
  740.  *
  741.  * Create and posts an event registration message to the task. No reply
  742.  * is waited for, or expected. Errors in posting will be reported.
  743.  */
  744.  
  745. int i2o_event_register(struct i2o_controller *c, u32 tid, 
  746. u32 init_context, u32 tr_context, u32 evt_mask)
  747. {
  748. u32 msg[5]; // Not performance critical, so we just 
  749. // i2o_post_this it instead of building it
  750. // in IOP memory
  751. msg[0] = FIVE_WORD_MSG_SIZE|SGL_OFFSET_0;
  752. msg[1] = I2O_CMD_UTIL_EVT_REGISTER<<24 | HOST_TID<<12 | tid;
  753. msg[2] = init_context;
  754. msg[3] = tr_context;
  755. msg[4] = evt_mask;
  756. return i2o_post_this(c, msg, sizeof(msg));
  757. }
  758. /*
  759.  *  i2o_event_ack - acknowledge an event
  760.  * @c: controller 
  761.  * @msg: pointer to the UTIL_EVENT_REGISTER reply we received
  762.  *
  763.  * We just take a pointer to the original UTIL_EVENT_REGISTER reply
  764.  * message and change the function code since that's what spec
  765.  * describes an EventAck message looking like.
  766.  */
  767.  
  768. int i2o_event_ack(struct i2o_controller *c, u32 *msg)
  769. {
  770. struct i2o_message *m = (struct i2o_message *)msg;
  771. m->function = I2O_CMD_UTIL_EVT_ACK;
  772. return i2o_post_wait(c, msg, m->size * 4, 2);
  773. }
  774. /*
  775.  * Core event handler.  Runs as a separate thread and is woken
  776.  * up whenever there is an Executive class event.
  777.  */
  778. static int i2o_core_evt(void *reply_data)
  779. {
  780. struct reply_info *reply = (struct reply_info *) reply_data;
  781. u32 *msg = reply->msg;
  782. struct i2o_controller *c = NULL;
  783. unsigned long flags;
  784. lock_kernel();
  785. daemonize();
  786. unlock_kernel();
  787. strcpy(current->comm, "i2oevtd");
  788. evt_running = 1;
  789. while(1)
  790. {
  791. if(down_interruptible(&evt_sem))
  792. {
  793. dprintk(KERN_INFO "I2O event thread deadn");
  794. printk("exiting...");
  795. evt_running = 0;
  796. complete_and_exit(&evt_dead, 0);
  797. }
  798. /* 
  799.  * Copy the data out of the queue so that we don't have to lock
  800.  * around the whole function and just around the qlen update
  801.  */
  802. spin_lock_irqsave(&i2o_evt_lock, flags);
  803. memcpy(reply, &events[evt_out], sizeof(struct reply_info));
  804. MODINC(evt_out, I2O_EVT_Q_LEN);
  805. evt_q_len--;
  806. spin_unlock_irqrestore(&i2o_evt_lock, flags);
  807. c = reply->iop;
  808.   dprintk(KERN_INFO "I2O IRTOS EVENT: iop%d, event %#10xn", c->unit, msg[4]);
  809. /* 
  810.  * We do not attempt to delete/quiesce/etc. the controller if
  811.  * some sort of error indidication occurs.  We may want to do
  812.  * so in the future, but for now we just let the user deal with 
  813.  * it.  One reason for this is that what to do with an error
  814.  * or when to send what 鎟ror is not really agreed on, so
  815.  * we get errors that may not be fatal but just look like they
  816.  * are...so let the user deal with it.
  817.  */
  818. switch(msg[4])
  819. {
  820. case I2O_EVT_IND_EXEC_RESOURCE_LIMITS:
  821. printk(KERN_ERR "%s: Out of resourcesn", c->name);
  822. break;
  823. case I2O_EVT_IND_EXEC_POWER_FAIL:
  824. printk(KERN_ERR "%s: Power failuren", c->name);
  825. break;
  826. case I2O_EVT_IND_EXEC_HW_FAIL:
  827. {
  828. char *fail[] = 
  829. "Unknown Error",
  830. "Power Lost",
  831. "Code Violation",
  832. "Parity Error",
  833. "Code Execution Exception",
  834. "Watchdog Timer Expired" 
  835. };
  836. if(msg[5] <= 6)
  837. printk(KERN_ERR "%s: Hardware Failure: %sn", 
  838. c->name, fail[msg[5]]);
  839. else
  840. printk(KERN_ERR "%s: Unknown Hardware Failuren", c->name);
  841. break;
  842. }
  843. /*
  844.    * New device created
  845.    * - Create a new i2o_device entry
  846.    * - Inform all interested drivers about this device's existence
  847.    */
  848. case I2O_EVT_IND_EXEC_NEW_LCT_ENTRY:
  849. {
  850. struct i2o_device *d = (struct i2o_device *)
  851. kmalloc(sizeof(struct i2o_device), GFP_KERNEL);
  852. int i;
  853. if (d == NULL) {
  854. printk(KERN_EMERG "i2oevtd: out of memoryn");
  855. break;
  856. }
  857. memcpy(&d->lct_data, &msg[5], sizeof(i2o_lct_entry));
  858. d->next = NULL;
  859. d->controller = c;
  860. d->flags = 0;
  861. i2o_report_controller_unit(c, d);
  862. i2o_install_device(c,d);
  863. for(i = 0; i < MAX_I2O_MODULES; i++)
  864. {
  865. if(i2o_handlers[i] && 
  866. i2o_handlers[i]->new_dev_notify &&
  867. (i2o_handlers[i]->class&d->lct_data.class_id))
  868. {
  869. spin_lock(&i2o_dev_lock);
  870. i2o_handlers[i]->new_dev_notify(c,d);
  871. spin_unlock(&i2o_dev_lock);
  872. }
  873. }
  874. break;
  875. }
  876. /*
  877.      * LCT entry for a device has been modified, so update it
  878.    * internally.
  879.    */
  880. case I2O_EVT_IND_EXEC_MODIFIED_LCT:
  881. {
  882. struct i2o_device *d;
  883. i2o_lct_entry *new_lct = (i2o_lct_entry *)&msg[5];
  884. for(d = c->devices; d; d = d->next)
  885. {
  886. if(d->lct_data.tid == new_lct->tid)
  887. {
  888. memcpy(&d->lct_data, new_lct, sizeof(i2o_lct_entry));
  889. break;
  890. }
  891. }
  892. break;
  893. }
  894. case I2O_EVT_IND_CONFIGURATION_FLAG:
  895. printk(KERN_WARNING "%s requires user configurationn", c->name);
  896. break;
  897. case I2O_EVT_IND_GENERAL_WARNING:
  898. printk(KERN_WARNING "%s: Warning notification received!"
  899. "Check configuration for errors!n", c->name);
  900. break;
  901. case I2O_EVT_IND_EVT_MASK_MODIFIED:
  902. /* Well I guess that was us hey .. */
  903. break;
  904. default:
  905. printk(KERN_WARNING "%s: No handler for event (0x%08x)n", c->name, msg[4]);
  906. break;
  907. }
  908. }
  909. return 0;
  910. }
  911. /*
  912.  * Dynamic LCT update.  This compares the LCT with the currently
  913.  * installed devices to check for device deletions..this needed b/c there
  914.  * is no DELETED_LCT_ENTRY EventIndicator for the Executive class so
  915.  * we can't just have the event handler do this...annoying
  916.  *
  917.  * This is a hole in the spec that will hopefully be fixed someday.
  918.  */
  919. static int i2o_dyn_lct(void *foo)
  920. {
  921. struct i2o_controller *c = (struct i2o_controller *)foo;
  922. struct i2o_device *d = NULL;
  923. struct i2o_device *d1 = NULL;
  924. int i = 0;
  925. int found = 0;
  926. int entries;
  927. void *tmp;
  928. char name[16];
  929. lock_kernel();
  930. daemonize();
  931. unlock_kernel();
  932. sprintf(name, "iop%d_lctd", c->unit);
  933. strcpy(current->comm, name);
  934. c->lct_running = 1;
  935. while(1)
  936. {
  937. down_interruptible(&c->lct_sem);
  938. if(signal_pending(current))
  939. {
  940. dprintk(KERN_ERR "%s: LCT thread deadn", c->name);
  941. c->lct_running = 0;
  942. return 0;
  943. }
  944. entries = c->dlct->table_size;
  945. entries -= 3;
  946. entries /= 9;
  947. dprintk(KERN_INFO "%s: Dynamic LCT Updaten",c->name);
  948. dprintk(KERN_INFO "%s: Dynamic LCT contains %d entriesn", c->name, entries);
  949. if(!entries)
  950. {
  951. printk(KERN_INFO "%s: Empty LCT???n", c->name);
  952. continue;
  953. }
  954. /*
  955.  * Loop through all the devices on the IOP looking for their
  956.  * LCT data in the LCT.  We assume that TIDs are not repeated.
  957.  * as that is the only way to really tell.  It's been confirmed
  958.  * by the IRTOS vendor(s?) that TIDs are not reused until they 
  959.  * wrap arround(4096), and I doubt a system will up long enough
  960.  * to create/delete that many devices.
  961.  */
  962. for(d = c->devices; d; )
  963. {
  964. found = 0;
  965. d1 = d->next;
  966. for(i = 0; i < entries; i++) 
  967. if(d->lct_data.tid == c->dlct->lct_entry[i].tid) 
  968. found = 1; 
  969. break; 
  970. if(!found) 
  971. {
  972. dprintk(KERN_INFO "i2o_core: Deleted device!n"); 
  973. spin_lock(&i2o_dev_lock);
  974. i2o_delete_device(d); 
  975. spin_unlock(&i2o_dev_lock);
  976. d = d1; 
  977. }
  978. /* 
  979.  * Tell LCT to renotify us next time there is a change
  980.    */
  981. i2o_lct_notify(c);
  982. /*
  983.  * Copy new LCT into public LCT
  984.  *
  985.  * Possible race if someone is reading LCT while  we are copying 
  986.  * over it. If this happens, we'll fix it then. but I doubt that
  987.  * the LCT will get updated often enough or will get read by
  988.  * a user often enough to worry.
  989.  */
  990. if(c->lct->table_size < c->dlct->table_size)
  991. {
  992. tmp = c->lct;
  993. c->lct = kmalloc(c->dlct->table_size<<2, GFP_KERNEL);
  994. if(!c->lct)
  995. {
  996. printk(KERN_ERR "%s: No memory for LCT!n", c->name);
  997. c->lct = tmp;
  998. continue;
  999. }
  1000. kfree(tmp);
  1001. }
  1002. memcpy(c->lct, c->dlct, c->dlct->table_size<<2);
  1003. }
  1004. return 0;
  1005. }
  1006. /**
  1007.  * i2o_run_queue - process pending events on a controller
  1008.  * @c: controller to process
  1009.  *
  1010.  * This is called by the bus specific driver layer when an interrupt
  1011.  * or poll of this card interface is desired.
  1012.  */
  1013.  
  1014. void i2o_run_queue(struct i2o_controller *c)
  1015. {
  1016. struct i2o_message *m;
  1017. u32 mv;
  1018. u32 *msg;
  1019. /*
  1020.  * Old 960 steppings had a bug in the I2O unit that caused
  1021.  * the queue to appear empty when it wasn't.
  1022.  */
  1023. if((mv=I2O_REPLY_READ32(c))==0xFFFFFFFF)
  1024. mv=I2O_REPLY_READ32(c);
  1025. while(mv!=0xFFFFFFFF)
  1026. {
  1027. struct i2o_handler *i;
  1028. /* Map the message from the page frame map to kernel virtual */
  1029. /* m=(struct i2o_message *)(mv - (unsigned long)c->page_frame_map + (unsigned long)c->page_frame); */
  1030. m=(struct i2o_message *)bus_to_virt(mv);
  1031. msg=(u32*)m;
  1032. /*
  1033.    * Ensure this message is seen coherently but cachably by
  1034.  * the processor 
  1035.    */
  1036. pci_dma_sync_single(c->pdev, c->page_frame_map, MSG_FRAME_SIZE, PCI_DMA_FROMDEVICE);
  1037. /*
  1038.  * Despatch it
  1039.    */
  1040. i=i2o_handlers[m->initiator_context&(MAX_I2O_MODULES-1)];
  1041. if(i && i->reply)
  1042. i->reply(i,c,m);
  1043. else
  1044. {
  1045. printk(KERN_WARNING "I2O: Spurious reply to handler %dn", 
  1046. m->initiator_context&(MAX_I2O_MODULES-1));
  1047. }
  1048.   i2o_flush_reply(c,mv);
  1049. mb();
  1050. /* That 960 bug again... */
  1051. if((mv=I2O_REPLY_READ32(c))==0xFFFFFFFF)
  1052. mv=I2O_REPLY_READ32(c);
  1053. }
  1054. }
  1055. /**
  1056.  * i2o_get_class_name -  do i2o class name lookup
  1057.  * @class: class number
  1058.  *
  1059.  * Return a descriptive string for an i2o class
  1060.  */
  1061.  
  1062. const char *i2o_get_class_name(int class)
  1063. {
  1064. int idx = 16;
  1065. static char *i2o_class_name[] = {
  1066. "Executive",
  1067. "Device Driver Module",
  1068. "Block Device",
  1069. "Tape Device",
  1070. "LAN Interface",
  1071. "WAN Interface",
  1072. "Fibre Channel Port",
  1073. "Fibre Channel Device",
  1074. "SCSI Device",
  1075. "ATE Port",
  1076. "ATE Device",
  1077. "Floppy Controller",
  1078. "Floppy Device",
  1079. "Secondary Bus Port",
  1080. "Peer Transport Agent",
  1081. "Peer Transport",
  1082. "Unknown"
  1083. };
  1084. switch(class&0xFFF)
  1085. {
  1086. case I2O_CLASS_EXECUTIVE:
  1087. idx = 0; break;
  1088. case I2O_CLASS_DDM:
  1089. idx = 1; break;
  1090. case I2O_CLASS_RANDOM_BLOCK_STORAGE:
  1091. idx = 2; break;
  1092. case I2O_CLASS_SEQUENTIAL_STORAGE:
  1093. idx = 3; break;
  1094. case I2O_CLASS_LAN:
  1095. idx = 4; break;
  1096. case I2O_CLASS_WAN:
  1097. idx = 5; break;
  1098. case I2O_CLASS_FIBRE_CHANNEL_PORT:
  1099. idx = 6; break;
  1100. case I2O_CLASS_FIBRE_CHANNEL_PERIPHERAL:
  1101. idx = 7; break;
  1102. case I2O_CLASS_SCSI_PERIPHERAL:
  1103. idx = 8; break;
  1104. case I2O_CLASS_ATE_PORT:
  1105. idx = 9; break;
  1106. case I2O_CLASS_ATE_PERIPHERAL:
  1107. idx = 10; break;
  1108. case I2O_CLASS_FLOPPY_CONTROLLER:
  1109. idx = 11; break;
  1110. case I2O_CLASS_FLOPPY_DEVICE:
  1111. idx = 12; break;
  1112. case I2O_CLASS_BUS_ADAPTER_PORT:
  1113. idx = 13; break;
  1114. case I2O_CLASS_PEER_TRANSPORT_AGENT:
  1115. idx = 14; break;
  1116. case I2O_CLASS_PEER_TRANSPORT:
  1117. idx = 15; break;
  1118. }
  1119. return i2o_class_name[idx];
  1120. }
  1121. /**
  1122.  * i2o_wait_message - obtain an i2o message from the IOP
  1123.  * @c: controller
  1124.  * @why: explanation 
  1125.  *
  1126.  * This function waits up to 5 seconds for a message slot to be
  1127.  * available. If no message is available it prints an error message
  1128.  * that is expected to be what the message will be used for (eg
  1129.  * "get_status"). 0xFFFFFFFF is returned on a failure.
  1130.  *
  1131.  * On a success the message is returned. This is the physical page
  1132.  * frame offset address from the read port. (See the i2o spec)
  1133.  */
  1134.  
  1135. u32 i2o_wait_message(struct i2o_controller *c, char *why)
  1136. {
  1137. long time=jiffies;
  1138. u32 m;
  1139. while((m=I2O_POST_READ32(c))==0xFFFFFFFF)
  1140. {
  1141. if((jiffies-time)>=5*HZ)
  1142. {
  1143. dprintk(KERN_ERR "%s: Timeout waiting for message frame to send %s.n", 
  1144. c->name, why);
  1145. return 0xFFFFFFFF;
  1146. }
  1147. schedule();
  1148. barrier();
  1149. }
  1150. return m;
  1151. }
  1152. /**
  1153.  * i2o_report_controller_unit - print information about a tid
  1154.  * @c: controller
  1155.  * @d: device
  1156.  *
  1157.  * Dump an information block associated with a given unit (TID). The
  1158.  * tables are read and a block of text is output to printk that is
  1159.  * formatted intended for the user.
  1160.  */
  1161.  
  1162. void i2o_report_controller_unit(struct i2o_controller *c, struct i2o_device *d)
  1163. {
  1164. char buf[64];
  1165. char str[22];
  1166. int ret;
  1167. int unit = d->lct_data.tid;
  1168. if(verbose==0)
  1169. return;
  1170. printk(KERN_INFO "Target ID %d.n", unit);
  1171. if((ret=i2o_query_scalar(c, unit, 0xF100, 3, buf, 16))>=0)
  1172. {
  1173. buf[16]=0;
  1174. printk(KERN_INFO "     Vendor: %sn", buf);
  1175. }
  1176. if((ret=i2o_query_scalar(c, unit, 0xF100, 4, buf, 16))>=0)
  1177. {
  1178. buf[16]=0;
  1179. printk(KERN_INFO "     Device: %sn", buf);
  1180. }
  1181. if(i2o_query_scalar(c, unit, 0xF100, 5, buf, 16)>=0)
  1182. {
  1183. buf[16]=0;
  1184. printk(KERN_INFO "     Description: %sn", buf);
  1185. }
  1186. if((ret=i2o_query_scalar(c, unit, 0xF100, 6, buf, 8))>=0)
  1187. {
  1188. buf[8]=0;
  1189. printk(KERN_INFO "        Rev: %sn", buf);
  1190. }
  1191. printk(KERN_INFO "    Class: ");
  1192. sprintf(str, "%-21s", i2o_get_class_name(d->lct_data.class_id));
  1193. printk("%sn", str);
  1194. printk(KERN_INFO "  Subclass: 0x%04Xn", d->lct_data.sub_class);
  1195. printk(KERN_INFO "     Flags: ");
  1196. if(d->lct_data.device_flags&(1<<0))
  1197. printk("C"); // ConfigDialog requested
  1198. if(d->lct_data.device_flags&(1<<1))
  1199. printk("U"); // Multi-user capable
  1200. if(!(d->lct_data.device_flags&(1<<4)))
  1201. printk("P"); // Peer service enabled!
  1202. if(!(d->lct_data.device_flags&(1<<5)))
  1203. printk("M"); // Mgmt service enabled!
  1204. printk("n");
  1205. }
  1206. /*
  1207.  * Parse the hardware resource table. Right now we print it out
  1208.  * and don't do a lot with it. We should collate these and then
  1209.  * interact with the Linux resource allocation block.
  1210.  *
  1211.  * Lets prove we can read it first eh ?
  1212.  *
  1213.  * This is full of endianisms!
  1214.  */
  1215.  
  1216. static int i2o_parse_hrt(struct i2o_controller *c)
  1217. {
  1218. #ifdef DRIVERDEBUG
  1219. u32 *rows=(u32*)c->hrt;
  1220. u8 *p=(u8 *)c->hrt;
  1221. u8 *d;
  1222. int count;
  1223. int length;
  1224. int i;
  1225. int state;
  1226. if(p[3]!=0)
  1227. {
  1228. printk(KERN_ERR "%s: HRT table for controller is too new a version.n",
  1229. c->name);
  1230. return -1;
  1231. }
  1232. count=p[0]|(p[1]<<8);
  1233. length = p[2];
  1234. printk(KERN_INFO "%s: HRT has %d entries of %d bytes each.n",
  1235. c->name, count, length<<2);
  1236. rows+=2;
  1237. for(i=0;i<count;i++)
  1238. {
  1239. printk(KERN_INFO "Adapter %08X: ", rows[0]);
  1240. p=(u8 *)(rows+1);
  1241. d=(u8 *)(rows+2);
  1242. state=p[1]<<8|p[0];
  1243. printk("TID %04X:[", state&0xFFF);
  1244. state>>=12;
  1245. if(state&(1<<0))
  1246. printk("H"); /* Hidden */
  1247. if(state&(1<<2))
  1248. {
  1249. printk("P"); /* Present */
  1250. if(state&(1<<1))
  1251. printk("C"); /* Controlled */
  1252. }
  1253. if(state>9)
  1254. printk("*"); /* Hard */
  1255. printk("]:");
  1256. switch(p[3]&0xFFFF)
  1257. {
  1258. case 0:
  1259. /* Adapter private bus - easy */
  1260. printk("Local bus %d: I/O at 0x%04X Mem 0x%08X", 
  1261. p[2], d[1]<<8|d[0], *(u32 *)(d+4));
  1262. break;
  1263. case 1:
  1264. /* ISA bus */
  1265. printk("ISA %d: CSN %d I/O at 0x%04X Mem 0x%08X",
  1266. p[2], d[2], d[1]<<8|d[0], *(u32 *)(d+4));
  1267. break;
  1268. case 2: /* EISA bus */
  1269. printk("EISA %d: Slot %d I/O at 0x%04X Mem 0x%08X",
  1270. p[2], d[3], d[1]<<8|d[0], *(u32 *)(d+4));
  1271. break;
  1272. case 3: /* MCA bus */
  1273. printk("MCA %d: Slot %d I/O at 0x%04X Mem 0x%08X",
  1274. p[2], d[3], d[1]<<8|d[0], *(u32 *)(d+4));
  1275. break;
  1276. case 4: /* PCI bus */
  1277. printk("PCI %d: Bus %d Device %d Function %d",
  1278. p[2], d[2], d[1], d[0]);
  1279. break;
  1280. case 0x80: /* Other */
  1281. default:
  1282. printk("Unsupported bus type.");
  1283. break;
  1284. }
  1285. printk("n");
  1286. rows+=length;
  1287. }
  1288. #endif
  1289. return 0;
  1290. }
  1291. /*
  1292.  * The logical configuration table tells us what we can talk to
  1293.  * on the board. Most of the stuff isn't interesting to us. 
  1294.  */
  1295. static int i2o_parse_lct(struct i2o_controller *c)
  1296. {
  1297. int i;
  1298. int max;
  1299. int tid;
  1300. struct i2o_device *d;
  1301. i2o_lct *lct = c->lct;
  1302. if (lct == NULL) {
  1303. printk(KERN_ERR "%s: LCT is empty???n", c->name);
  1304. return -1;
  1305. }
  1306. max = lct->table_size;
  1307. max -= 3;
  1308. max /= 9;
  1309. printk(KERN_INFO "%s: LCT has %d entries.n", c->name, max);
  1310. if(lct->iop_flags&(1<<0))
  1311. printk(KERN_WARNING "%s: Configuration dialog desired.n", c->name);
  1312. for(i=0;i<max;i++)
  1313. {
  1314. d = (struct i2o_device *)kmalloc(sizeof(struct i2o_device), GFP_KERNEL);
  1315. if(d==NULL)
  1316. {
  1317. printk(KERN_CRIT "i2o_core: Out of memory for I2O device data.n");
  1318. return -ENOMEM;
  1319. }
  1320. d->controller = c;
  1321. d->next = NULL;
  1322. memcpy(&d->lct_data, &lct->lct_entry[i], sizeof(i2o_lct_entry));
  1323. d->flags = 0;
  1324. tid = d->lct_data.tid;
  1325. i2o_report_controller_unit(c, d);
  1326. i2o_install_device(c, d);
  1327. }
  1328. return 0;
  1329. }
  1330. /**
  1331.  * i2o_quiesce_controller - quiesce controller
  1332.  * @c: controller 
  1333.  *
  1334.  * Quiesce an IOP. Causes IOP to make external operation quiescent
  1335.  * (i2o 'READY' state). Internal operation of the IOP continues normally.
  1336.  */
  1337.  
  1338. int i2o_quiesce_controller(struct i2o_controller *c)
  1339. {
  1340. u32 msg[4];
  1341. int ret;
  1342. i2o_status_get(c);
  1343. /* SysQuiesce discarded if IOP not in READY or OPERATIONAL state */
  1344. if ((c->status_block->iop_state != ADAPTER_STATE_READY) &&
  1345. (c->status_block->iop_state != ADAPTER_STATE_OPERATIONAL))
  1346. {
  1347. return 0;
  1348. }
  1349. msg[0] = FOUR_WORD_MSG_SIZE|SGL_OFFSET_0;
  1350. msg[1] = I2O_CMD_SYS_QUIESCE<<24|HOST_TID<<12|ADAPTER_TID;
  1351. msg[3] = 0;
  1352. /* Long timeout needed for quiesce if lots of devices */
  1353. if ((ret = i2o_post_wait(c, msg, sizeof(msg), 240)))
  1354. printk(KERN_INFO "%s: Unable to quiesce (status=%#x).n",
  1355. c->name, -ret);
  1356. else
  1357. dprintk(KERN_INFO "%s: Quiesced.n", c->name);
  1358. i2o_status_get(c); // Entered READY state
  1359. return ret;
  1360. }
  1361. /**
  1362.  * i2o_enable_controller - move controller from ready to operational
  1363.  * @c: controller
  1364.  *
  1365.  * Enable IOP. This allows the IOP to resume external operations and
  1366.  * reverses the effect of a quiesce. In the event of an error a negative
  1367.  * errno code is returned.
  1368.  */
  1369.  
  1370. int i2o_enable_controller(struct i2o_controller *c)
  1371. {
  1372. u32 msg[4];
  1373. int ret;
  1374. i2o_status_get(c);
  1375. /* Enable only allowed on READY state */
  1376. if(c->status_block->iop_state != ADAPTER_STATE_READY)
  1377. return -EINVAL;
  1378. msg[0]=FOUR_WORD_MSG_SIZE|SGL_OFFSET_0;
  1379. msg[1]=I2O_CMD_SYS_ENABLE<<24|HOST_TID<<12|ADAPTER_TID;
  1380. /* How long of a timeout do we need? */
  1381. if ((ret = i2o_post_wait(c, msg, sizeof(msg), 240)))
  1382. printk(KERN_ERR "%s: Could not enable (status=%#x).n",
  1383. c->name, -ret);
  1384. else
  1385. dprintk(KERN_INFO "%s: Enabled.n", c->name);
  1386. i2o_status_get(c); // entered OPERATIONAL state
  1387. return ret;
  1388. }
  1389. /**
  1390.  * i2o_clear_controller - clear a controller
  1391.  * @c: controller
  1392.  *
  1393.  * Clear an IOP to HOLD state, ie. terminate external operations, clear all
  1394.  * input queues and prepare for a system restart. IOP's internal operation
  1395.  * continues normally and the outbound queue is alive.
  1396.  * The IOP is not expected to rebuild its LCT.
  1397.  */
  1398.  
  1399. int i2o_clear_controller(struct i2o_controller *c)
  1400. {
  1401. struct i2o_controller *iop;
  1402. u32 msg[4];
  1403. int ret;
  1404. /* Quiesce all IOPs first */
  1405. for (iop = i2o_controller_chain; iop; iop = iop->next)
  1406. i2o_quiesce_controller(iop);
  1407. msg[0]=FOUR_WORD_MSG_SIZE|SGL_OFFSET_0;
  1408. msg[1]=I2O_CMD_ADAPTER_CLEAR<<24|HOST_TID<<12|ADAPTER_TID;
  1409. msg[3]=0;
  1410. if ((ret=i2o_post_wait(c, msg, sizeof(msg), 30)))
  1411. printk(KERN_INFO "%s: Unable to clear (status=%#x).n",
  1412. c->name, -ret);
  1413. else
  1414. dprintk(KERN_INFO "%s: Cleared.n",c->name);
  1415. i2o_status_get(c);
  1416. /* Enable other IOPs */
  1417. for (iop = i2o_controller_chain; iop; iop = iop->next)
  1418. if (iop != c)
  1419. i2o_enable_controller(iop);
  1420. return ret;
  1421. }
  1422. /**
  1423.  * i2o_reset_controller - reset an IOP
  1424.  * @c: controller to reset
  1425.  *
  1426.  * Reset the IOP into INIT state and wait until IOP gets into RESET state.
  1427.  * Terminate all external operations, clear IOP's inbound and outbound
  1428.  * queues, terminate all DDMs, and reload the IOP's operating environment
  1429.  * and all local DDMs. The IOP rebuilds its LCT.
  1430.  */
  1431.  
  1432. static int i2o_reset_controller(struct i2o_controller *c)
  1433. {
  1434. struct i2o_controller *iop;
  1435. u32 m;
  1436. u8 *status;
  1437. u32 *msg;
  1438. long time;
  1439. /* Quiesce all IOPs first */
  1440. for (iop = i2o_controller_chain; iop; iop = iop->next)
  1441. {
  1442. if(iop->type != I2O_TYPE_PCI || !iop->bus.pci.dpt)
  1443. i2o_quiesce_controller(iop);
  1444. }
  1445. m=i2o_wait_message(c, "AdapterReset");
  1446. if(m==0xFFFFFFFF)
  1447. return -ETIMEDOUT;
  1448. msg=(u32 *)(c->mem_offset+m);
  1449. status=(void *)kmalloc(4, GFP_KERNEL);
  1450. if(status==NULL) {
  1451. printk(KERN_ERR "IOP reset failed - no free memory.n");
  1452. return -ENOMEM;
  1453. }
  1454. memset(status, 0, 4);
  1455. writel(EIGHT_WORD_MSG_SIZE|SGL_OFFSET_0, msg + 0);
  1456. writel(I2O_CMD_ADAPTER_RESET<<24|HOST_TID<<12|ADAPTER_TID, msg + 1);
  1457. writel(core_context, msg + 2);
  1458. writel(0, msg + 3);
  1459. writel(0, msg + 4);
  1460. writel(0, msg + 5);
  1461. writel(virt_to_bus(status), msg + 6);
  1462. writel(0, msg + 7); /* 64bit host FIXME */
  1463. i2o_post_message(c,m);
  1464. /* Wait for a reply */
  1465. time=jiffies;
  1466. while(*status==0)
  1467. {
  1468. if((jiffies-time)>=20*HZ)
  1469. {
  1470. printk(KERN_ERR "IOP reset timeout.n");
  1471. // Better to leak this for safety: kfree(status);
  1472. return -ETIMEDOUT;
  1473. }
  1474. schedule();
  1475. barrier();
  1476. }
  1477. if (*status==I2O_CMD_IN_PROGRESS)
  1478. /* 
  1479.  * Once the reset is sent, the IOP goes into the INIT state 
  1480.  * which is indeterminate.  We need to wait until the IOP 
  1481.  * has rebooted before we can let the system talk to 
  1482.  * it. We read the inbound Free_List until a message is 
  1483.  * available.  If we can't read one in the given ammount of 
  1484.  * time, we assume the IOP could not reboot properly.  
  1485.  */ 
  1486. dprintk(KERN_INFO "%s: Reset in progress, waiting for reboot...n",
  1487. c->name); 
  1488. time = jiffies; 
  1489. m = I2O_POST_READ32(c); 
  1490. while(m == 0XFFFFFFFF) 
  1491. if((jiffies-time) >= 30*HZ)
  1492. {
  1493. printk(KERN_ERR "%s: Timeout waiting for IOP reset.n", 
  1494. c->name); 
  1495. return -ETIMEDOUT; 
  1496. schedule(); 
  1497. barrier(); 
  1498. m = I2O_POST_READ32(c); 
  1499. }
  1500. i2o_flush_reply(c,m);
  1501. }
  1502. /* If IopReset was rejected or didn't perform reset, try IopClear */
  1503. i2o_status_get(c);
  1504. if (status[0] == I2O_CMD_REJECTED || 
  1505. c->status_block->iop_state != ADAPTER_STATE_RESET)
  1506. {
  1507. printk(KERN_WARNING "%s: Reset rejected, trying to clearn",c->name);
  1508. i2o_clear_controller(c);
  1509. }
  1510. else
  1511. dprintk(KERN_INFO "%s: Reset completed.n", c->name);
  1512. /* Enable other IOPs */
  1513. for (iop = i2o_controller_chain; iop; iop = iop->next)
  1514. if (iop != c)
  1515. i2o_enable_controller(iop);
  1516. kfree(status);
  1517. return 0;
  1518. }
  1519. /**
  1520.  *  i2o_status_get - get the status block for the IOP
  1521.  * @c: controller
  1522.  *
  1523.  * Issue a status query on the controller. This updates the
  1524.  * attached status_block. If the controller fails to reply or an
  1525.  * error occurs then a negative errno code is returned. On success
  1526.  * zero is returned and the status_blok is updated.
  1527.  */
  1528.  
  1529. int i2o_status_get(struct i2o_controller *c)
  1530. {
  1531. long time;
  1532. u32 m;
  1533. u32 *msg;
  1534. u8 *status_block;
  1535. if (c->status_block == NULL) 
  1536. {
  1537. c->status_block = (i2o_status_block *)
  1538. kmalloc(sizeof(i2o_status_block),GFP_KERNEL);
  1539. if (c->status_block == NULL)
  1540. {
  1541. printk(KERN_CRIT "%s: Get Status Block failed; Out of memory.n",
  1542. c->name);
  1543. return -ENOMEM;
  1544. }
  1545. }
  1546. status_block = (u8*)c->status_block;
  1547. memset(c->status_block,0,sizeof(i2o_status_block));
  1548. m=i2o_wait_message(c, "StatusGet");
  1549. if(m==0xFFFFFFFF)
  1550. return -ETIMEDOUT;
  1551. msg=(u32 *)(c->mem_offset+m);
  1552. writel(NINE_WORD_MSG_SIZE|SGL_OFFSET_0, msg + 0);
  1553. writel(I2O_CMD_STATUS_GET<<24|HOST_TID<<12|ADAPTER_TID, msg + 1);
  1554. writel(core_context, msg + 2);
  1555. writel(0, msg + 3);
  1556. writel(0, msg + 4);
  1557. writel(0, msg + 5);
  1558. writel(virt_to_bus(c->status_block), msg + 6);
  1559. writel(0, msg + 7);   /* 64bit host FIXME */
  1560. writel(sizeof(i2o_status_block), msg + 8); /* always 88 bytes */
  1561. i2o_post_message(c,m);
  1562. /* Wait for a reply */
  1563. time=jiffies;
  1564. while(status_block[87]!=0xFF)
  1565. {
  1566. if((jiffies-time)>=5*HZ)
  1567. {
  1568. printk(KERN_ERR "%s: Get status timeout.n",c->name);
  1569. return -ETIMEDOUT;
  1570. }
  1571. schedule();
  1572. barrier();
  1573. }
  1574. #ifdef DRIVERDEBUG
  1575. printk(KERN_INFO "%s: State = ", c->name);
  1576. switch (c->status_block->iop_state) {
  1577. case 0x01:  
  1578. printk("INITn");
  1579. break;
  1580. case 0x02:
  1581. printk("RESETn");
  1582. break;
  1583. case 0x04:
  1584. printk("HOLDn");
  1585. break;
  1586. case 0x05:
  1587. printk("READYn");
  1588. break;
  1589. case 0x08:
  1590. printk("OPERATIONALn");
  1591. break;
  1592. case 0x10:
  1593. printk("FAILEDn");
  1594. break;
  1595. case 0x11:
  1596. printk("FAULTEDn");
  1597. break;
  1598. default: 
  1599. printk("%x (unknown !!)n",c->status_block->iop_state);
  1600. }     
  1601. #endif   
  1602. return 0;
  1603. }
  1604. /*
  1605.  * Get the Hardware Resource Table for the device.
  1606.  * The HRT contains information about possible hidden devices
  1607.  * but is mostly useless to us 
  1608.  */
  1609. int i2o_hrt_get(struct i2o_controller *c)
  1610. {
  1611. u32 msg[6];
  1612. int ret, size = sizeof(i2o_hrt);
  1613. /* First read just the header to figure out the real size */
  1614. do  {
  1615. if (c->hrt == NULL) {
  1616. c->hrt=kmalloc(size, GFP_KERNEL);
  1617. if (c->hrt == NULL) {
  1618. printk(KERN_CRIT "%s: Hrt Get failed; Out of memory.n", c->name);
  1619. return -ENOMEM;
  1620. }
  1621. }
  1622. msg[0]= SIX_WORD_MSG_SIZE| SGL_OFFSET_4;
  1623. msg[1]= I2O_CMD_HRT_GET<<24 | HOST_TID<<12 | ADAPTER_TID;
  1624. msg[3]= 0;
  1625. msg[4]= (0xD0000000 | size); /* Simple transaction */
  1626. msg[5]= virt_to_bus(c->hrt); /* Dump it here */
  1627. ret = i2o_post_wait_mem(c, msg, sizeof(msg), 20, c->hrt, NULL);
  1628. if(ret == -ETIMEDOUT)
  1629. {
  1630. /* The HRT block we used is in limbo somewhere. When the iop wakes up
  1631.    we will recover it */
  1632. c->hrt = NULL;
  1633. return ret;
  1634. }
  1635. if(ret<0)
  1636. {
  1637. printk(KERN_ERR "%s: Unable to get HRT (status=%#x)n",
  1638. c->name, -ret);
  1639. return ret;
  1640. }
  1641. if (c->hrt->num_entries * c->hrt->entry_len << 2 > size) {
  1642. size = c->hrt->num_entries * c->hrt->entry_len << 2;
  1643. kfree(c->hrt);
  1644. c->hrt = NULL;
  1645. }
  1646. } while (c->hrt == NULL);
  1647. i2o_parse_hrt(c); // just for debugging
  1648. return 0;
  1649. }
  1650. /*
  1651.  * Send the I2O System Table to the specified IOP
  1652.  *
  1653.  * The system table contains information about all the IOPs in the
  1654.  * system.  It is build and then sent to each IOP so that IOPs can
  1655.  * establish connections between each other.
  1656.  *
  1657.  */
  1658. static int i2o_systab_send(struct i2o_controller *iop)
  1659. {
  1660. u32 msg[12];
  1661. int ret;
  1662. u32 *privbuf = kmalloc(16, GFP_KERNEL);
  1663. if(privbuf == NULL)
  1664. return -ENOMEM;
  1665. if(iop->type == I2O_TYPE_PCI)
  1666. {
  1667. struct resource *root;
  1668. if(iop->status_block->current_mem_size < iop->status_block->desired_mem_size)
  1669. {
  1670. struct resource *res = &iop->mem_resource;
  1671. res->name = iop->pdev->bus->name;
  1672. res->flags = IORESOURCE_MEM;
  1673. res->start = 0;
  1674. res->end = 0;
  1675. printk("%s: requires private memory resources.n", iop->name);
  1676. root = pci_find_parent_resource(iop->pdev, res);
  1677. if(root==NULL)
  1678. printk("Can't find parent resource!n");
  1679. if(root && allocate_resource(root, res, 
  1680. iop->status_block->desired_mem_size,
  1681. iop->status_block->desired_mem_size,
  1682. iop->status_block->desired_mem_size,
  1683. 1<<20, /* Unspecified, so use 1Mb and play safe */
  1684. NULL,
  1685. NULL)>=0)
  1686. {
  1687. iop->mem_alloc = 1;
  1688. iop->status_block->current_mem_size = 1 + res->end - res->start;
  1689. iop->status_block->current_mem_base = res->start;
  1690. printk(KERN_INFO "%s: allocated %ld bytes of PCI memory at 0x%08lX.n", 
  1691. iop->name, 1+res->end-res->start, res->start);
  1692. }
  1693. }
  1694. if(iop->status_block->current_io_size < iop->status_block->desired_io_size)
  1695. {
  1696. struct resource *res = &iop->io_resource;
  1697. res->name = iop->pdev->bus->name;
  1698. res->flags = IORESOURCE_IO;
  1699. res->start = 0;
  1700. res->end = 0;
  1701. printk("%s: requires private memory resources.n", iop->name);
  1702. root = pci_find_parent_resource(iop->pdev, res);
  1703. if(root==NULL)
  1704. printk("Can't find parent resource!n");
  1705. if(root &&  allocate_resource(root, res, 
  1706. iop->status_block->desired_io_size,
  1707. iop->status_block->desired_io_size,
  1708. iop->status_block->desired_io_size,
  1709. 1<<20, /* Unspecified, so use 1Mb and play safe */
  1710. NULL,
  1711. NULL)>=0)
  1712. {
  1713. iop->io_alloc = 1;
  1714. iop->status_block->current_io_size = 1 + res->end - res->start;
  1715. iop->status_block->current_mem_base = res->start;
  1716. printk(KERN_INFO "%s: allocated %ld bytes of PCI I/O at 0x%08lX.n", 
  1717. iop->name, 1+res->end-res->start, res->start);
  1718. }
  1719. }
  1720. }
  1721. else
  1722. {
  1723. privbuf[0] = iop->status_block->current_mem_base;
  1724. privbuf[1] = iop->status_block->current_mem_size;
  1725. privbuf[2] = iop->status_block->current_io_base;
  1726. privbuf[3] = iop->status_block->current_io_size;
  1727. }
  1728. msg[0] = I2O_MESSAGE_SIZE(12) | SGL_OFFSET_6;
  1729. msg[1] = I2O_CMD_SYS_TAB_SET<<24 | HOST_TID<<12 | ADAPTER_TID;
  1730. msg[3] = 0;
  1731. msg[4] = (0<<16) | ((iop->unit+2) );      /* Host 0 IOP ID (unit + 2) */
  1732. msg[5] = 0;                               /* Segment 0 */
  1733. /* 
  1734.    * Provide three SGL-elements:
  1735.    * System table (SysTab), Private memory space declaration and 
  1736.    * Private i/o space declaration  
  1737.    *
  1738.    * FIXME: provide these for controllers needing them
  1739.    */
  1740. msg[6] = 0x54000000 | sys_tbl_len;
  1741. msg[7] = virt_to_bus(sys_tbl);
  1742. msg[8] = 0x54000000 | 8;
  1743. msg[9] = virt_to_bus(privbuf);
  1744. msg[10] = 0xD4000000 | 8;
  1745. msg[11] = virt_to_bus(privbuf+2);
  1746. ret=i2o_post_wait_mem(iop, msg, sizeof(msg), 120, privbuf, NULL);
  1747. if(ret==-ETIMEDOUT)
  1748. {
  1749. printk(KERN_ERR "%s: SysTab setup timed out.n", iop->name);
  1750. }
  1751. else if(ret<0)
  1752. {
  1753. printk(KERN_ERR "%s: Unable to set SysTab (status=%#x).n", 
  1754. iop->name, -ret);
  1755. kfree(privbuf);
  1756. }
  1757. else
  1758. {
  1759. dprintk(KERN_INFO "%s: SysTab set.n", iop->name);
  1760. kfree(privbuf);
  1761. }
  1762. i2o_status_get(iop); // Entered READY state
  1763. return ret;
  1764.  }
  1765. /*
  1766.  * Initialize I2O subsystem.
  1767.  */
  1768. static void __init i2o_sys_init(void)
  1769. {
  1770. struct i2o_controller *iop, *niop = NULL;
  1771. printk(KERN_INFO "Activating I2O controllers...n");
  1772. printk(KERN_INFO "This may take a few minutes if there are many devicesn");
  1773. /* In INIT state, Activate IOPs */
  1774. for (iop = i2o_controller_chain; iop; iop = niop) {
  1775. dprintk(KERN_INFO "Calling i2o_activate_controller for %s...n", 
  1776. iop->name);
  1777. niop = iop->next;
  1778. if (i2o_activate_controller(iop) < 0)
  1779. i2o_delete_controller(iop);
  1780. }
  1781. /* Active IOPs in HOLD state */
  1782. rebuild_sys_tab:
  1783. if (i2o_controller_chain == NULL)
  1784. return;
  1785. /*
  1786.  * If build_sys_table fails, we kill everything and bail
  1787.  * as we can't init the IOPs w/o a system table
  1788.  */
  1789. dprintk(KERN_INFO "i2o_core: Calling i2o_build_sys_table...n");
  1790. if (i2o_build_sys_table() < 0) {
  1791. i2o_sys_shutdown();
  1792. return;
  1793. }
  1794. /* If IOP don't get online, we need to rebuild the System table */
  1795. for (iop = i2o_controller_chain; iop; iop = niop) {
  1796. niop = iop->next;
  1797. dprintk(KERN_INFO "Calling i2o_online_controller for %s...n", iop->name);
  1798. if (i2o_online_controller(iop) < 0) {
  1799. i2o_delete_controller(iop);
  1800. goto rebuild_sys_tab;
  1801. }
  1802. }
  1803. /* Active IOPs now in OPERATIONAL state */
  1804. /*
  1805.  * Register for status updates from all IOPs
  1806.  */
  1807. for(iop = i2o_controller_chain; iop; iop=iop->next) {
  1808. /* Create a kernel thread to deal with dynamic LCT updates */
  1809. iop->lct_pid = kernel_thread(i2o_dyn_lct, iop, CLONE_SIGHAND);
  1810. /* Update change ind on DLCT */
  1811. iop->dlct->change_ind = iop->lct->change_ind;
  1812. /* Start dynamic LCT updates */
  1813. i2o_lct_notify(iop);
  1814. /* Register for all events from IRTOS */
  1815. i2o_event_register(iop, core_context, 0, 0, 0xFFFFFFFF);
  1816. }
  1817. }
  1818. /**
  1819.  * i2o_sys_shutdown - shutdown I2O system
  1820.  *
  1821.  * Bring down each i2o controller and then return. Each controller
  1822.  * is taken through an orderly shutdown
  1823.  */
  1824.  
  1825. static void i2o_sys_shutdown(void)
  1826. {
  1827. struct i2o_controller *iop, *niop;
  1828. /* Delete all IOPs from the controller chain */
  1829. /* that will reset all IOPs too */
  1830. for (iop = i2o_controller_chain; iop; iop = niop) {
  1831. niop = iop->next;
  1832. i2o_delete_controller(iop);
  1833. }
  1834. }
  1835. /**
  1836.  * i2o_activate_controller - bring controller up to HOLD
  1837.  * @iop: controller
  1838.  *
  1839.  * This function brings an I2O controller into HOLD state. The adapter
  1840.  * is reset if neccessary and then the queues and resource table
  1841.  * are read. -1 is returned on a failure, 0 on success.
  1842.  *
  1843.  */
  1844.  
  1845. int i2o_activate_controller(struct i2o_controller *iop)
  1846. {
  1847. /* In INIT state, Wait Inbound Q to initialize (in i2o_status_get) */
  1848. /* In READY state, Get status */
  1849. if (i2o_status_get(iop) < 0) {
  1850. printk(KERN_INFO "Unable to obtain status of %s, "
  1851. "attempting a reset.n", iop->name);
  1852. if (i2o_reset_controller(iop) < 0)
  1853. return -1;
  1854. }
  1855. if(iop->status_block->iop_state == ADAPTER_STATE_FAULTED) {
  1856. printk(KERN_CRIT "%s: hardware faultn", iop->name);
  1857. return -1;
  1858. }
  1859. if (iop->status_block->i2o_version > I2OVER15) {
  1860. printk(KERN_ERR "%s: Not running vrs. 1.5. of the I2O Specification.n",
  1861. iop->name);
  1862. return -1;
  1863. }
  1864. if (iop->status_block->iop_state == ADAPTER_STATE_READY ||
  1865.     iop->status_block->iop_state == ADAPTER_STATE_OPERATIONAL ||
  1866.     iop->status_block->iop_state == ADAPTER_STATE_HOLD ||
  1867.     iop->status_block->iop_state == ADAPTER_STATE_FAILED)
  1868. {
  1869. dprintk(KERN_INFO "%s: Already running, trying to reset...n",
  1870. iop->name);
  1871. if (i2o_reset_controller(iop) < 0)
  1872. return -1;
  1873. }
  1874. if (i2o_init_outbound_q(iop) < 0)
  1875. return -1;
  1876. if (i2o_post_outbound_messages(iop)) 
  1877. return -1;
  1878. /* In HOLD state */
  1879. if (i2o_hrt_get(iop) < 0)
  1880. return -1;
  1881. return 0;
  1882. }
  1883. /**
  1884.  * i2o_init_outbound_queue - setup the outbound queue
  1885.  * @c: controller
  1886.  *
  1887.  * Clear and (re)initialize IOP's outbound queue. Returns 0 on
  1888.  * success or a negative errno code on a failure.
  1889.  */
  1890.  
  1891. int i2o_init_outbound_q(struct i2o_controller *c)
  1892. {
  1893. u8 *status;
  1894. u32 m;
  1895. u32 *msg;
  1896. u32 time;
  1897. dprintk(KERN_INFO "%s: Initializing Outbound Queue...n", c->name);
  1898. m=i2o_wait_message(c, "OutboundInit");
  1899. if(m==0xFFFFFFFF)
  1900. return -ETIMEDOUT;
  1901. msg=(u32 *)(c->mem_offset+m);
  1902. status = kmalloc(4,GFP_KERNEL);
  1903. if (status==NULL) {
  1904. printk(KERN_ERR "%s: Outbound Queue initialization failed - no free memory.n",
  1905. c->name);
  1906. return -ENOMEM;
  1907. }
  1908. memset(status, 0, 4);
  1909. writel(EIGHT_WORD_MSG_SIZE| TRL_OFFSET_6, msg + 0);
  1910. writel(I2O_CMD_OUTBOUND_INIT<<24 | HOST_TID<<12 | ADAPTER_TID, msg + 1);
  1911. writel(core_context, msg + 2);
  1912. writel(0x0106, msg + 3); /* Transaction context */
  1913. writel(PAGE_SIZE, msg + 4); /* Host page frame size */
  1914. /* Frame size is in words. Pick 128, its what everyone elses uses and
  1915. other sizes break some adapters. */
  1916. writel(MSG_FRAME_SIZE<<16|0x80, msg + 5);/* Outbound msg frame size and Initcode */
  1917. writel(0xD0000004, msg + 6); /* Simple SG LE, EOB */
  1918. writel(virt_to_bus(status), msg + 7);
  1919. i2o_post_message(c,m);
  1920. barrier();
  1921. time=jiffies;
  1922. while(status[0] < I2O_CMD_REJECTED)
  1923. {
  1924. if((jiffies-time)>=30*HZ)
  1925. {
  1926. if(status[0]==0x00)
  1927. printk(KERN_ERR "%s: Ignored queue initialize request.n",
  1928. c->name);
  1929. else  
  1930. printk(KERN_ERR "%s: Outbound queue initialize timeout.n",
  1931. c->name);
  1932. kfree(status);
  1933. return -ETIMEDOUT;
  1934. }  
  1935. schedule();
  1936. barrier();
  1937. }  
  1938. if(status[0] != I2O_CMD_COMPLETED)
  1939. {
  1940. printk(KERN_ERR "%s: IOP outbound initialise failed.n", c->name);
  1941. kfree(status);
  1942. return -ETIMEDOUT;
  1943. }
  1944. return 0;
  1945. }
  1946. /**
  1947.  * i2o_post_outbound_messages - fill message queue
  1948.  * @c: controller
  1949.  *
  1950.  * Allocate a message frame and load the messages into the IOP. The
  1951.  * function returns zero on success or a negative errno code on
  1952.  * failure.
  1953.  */
  1954. int i2o_post_outbound_messages(struct i2o_controller *c)
  1955. {
  1956. int i;
  1957. u32 m;
  1958. /* Alloc space for IOP's outbound queue message frames */
  1959. c->page_frame = kmalloc(MSG_POOL_SIZE, GFP_KERNEL);
  1960. if(c->page_frame==NULL) {
  1961. printk(KERN_ERR "%s: Outbound Q initialize failed; out of memory.n",
  1962. c->name);
  1963. return -ENOMEM;
  1964. }
  1965. c->page_frame_map = pci_map_single(c->pdev, c->page_frame, MSG_POOL_SIZE, PCI_DMA_FROMDEVICE);
  1966. if(c->page_frame_map == 0)
  1967. {
  1968. kfree(c->page_frame);
  1969. printk(KERN_ERR "%s: Unable to map outbound queue.n", c->name);
  1970. return -ENOMEM;
  1971. }
  1972. m = c->page_frame_map;
  1973. /* Post frames */
  1974. for(i=0; i< NMBR_MSG_FRAMES; i++) {
  1975. I2O_REPLY_WRITE32(c,m);
  1976. mb();
  1977. m += MSG_FRAME_SIZE;
  1978. }
  1979. return 0;
  1980. }
  1981. /*
  1982.  * Get the IOP's Logical Configuration Table
  1983.  */
  1984. int i2o_lct_get(struct i2o_controller *c)
  1985. {
  1986. u32 msg[8];
  1987. int ret, size = c->status_block->expected_lct_size;
  1988. do {
  1989. if (c->lct == NULL) {
  1990. c->lct = kmalloc(size, GFP_KERNEL);
  1991. if(c->lct == NULL) {
  1992. printk(KERN_CRIT "%s: Lct Get failed. Out of memory.n",
  1993. c->name);
  1994. return -ENOMEM;
  1995. }
  1996. }
  1997. memset(c->lct, 0, size);
  1998. msg[0] = EIGHT_WORD_MSG_SIZE|SGL_OFFSET_6;
  1999. msg[1] = I2O_CMD_LCT_NOTIFY<<24 | HOST_TID<<12 | ADAPTER_TID;
  2000. /* msg[2] filled in i2o_post_wait */
  2001. msg[3] = 0;
  2002. msg[4] = 0xFFFFFFFF; /* All devices */
  2003. msg[5] = 0x00000000; /* Report now */
  2004. msg[6] = 0xD0000000|size;
  2005. msg[7] = virt_to_bus(c->lct);
  2006. ret=i2o_post_wait_mem(c, msg, sizeof(msg), 120, c->lct, NULL);
  2007. if(ret == -ETIMEDOUT)
  2008. {
  2009. c->lct = NULL;
  2010. return ret;
  2011. }
  2012. if(ret<0)
  2013. {
  2014. printk(KERN_ERR "%s: LCT Get failed (status=%#x.n", 
  2015. c->name, -ret);
  2016. return ret;
  2017. }
  2018. if (c->lct->table_size << 2 > size) {
  2019. size = c->lct->table_size << 2;
  2020. kfree(c->lct);
  2021. c->lct = NULL;
  2022. }
  2023. } while (c->lct == NULL);
  2024.         if ((ret=i2o_parse_lct(c)) < 0)
  2025.                 return ret;
  2026. return 0;
  2027. }
  2028. /*
  2029.  * Like above, but used for async notification.  The main
  2030.  * difference is that we keep track of the CurrentChangeIndiicator
  2031.  * so that we only get updates when it actually changes.
  2032.  *
  2033.  */
  2034. int i2o_lct_notify(struct i2o_controller *c)
  2035. {
  2036. u32 msg[8];
  2037. msg[0] = EIGHT_WORD_MSG_SIZE|SGL_OFFSET_6;
  2038. msg[1] = I2O_CMD_LCT_NOTIFY<<24 | HOST_TID<<12 | ADAPTER_TID;
  2039. msg[2] = core_context;
  2040. msg[3] = 0xDEADBEEF;
  2041. msg[4] = 0xFFFFFFFF; /* All devices */
  2042. msg[5] = c->dlct->change_ind+1; /* Next change */
  2043. msg[6] = 0xD0000000|8192;
  2044. msg[7] = virt_to_bus(c->dlct);
  2045. return i2o_post_this(c, msg, sizeof(msg));
  2046. }
  2047. /*
  2048.  * Bring a controller online into OPERATIONAL state. 
  2049.  */
  2050.  
  2051. int i2o_online_controller(struct i2o_controller *iop)
  2052. {
  2053. u32 v;
  2054. if (i2o_systab_send(iop) < 0)
  2055. return -1;
  2056. /* In READY state */
  2057. dprintk(KERN_INFO "%s: Attempting to enable...n", iop->name);
  2058. if (i2o_enable_controller(iop) < 0)
  2059. return -1;
  2060. /* In OPERATIONAL state  */
  2061. dprintk(KERN_INFO "%s: Attempting to get/parse lct...n", iop->name);
  2062. if (i2o_lct_get(iop) < 0)
  2063. return -1;
  2064. /* Check battery status */
  2065.  
  2066. iop->battery = 0;
  2067. if(i2o_query_scalar(iop, ADAPTER_TID, 0x0000, 4, &v, 4)>=0)
  2068. {
  2069. if(v&16)
  2070. iop->battery = 1;
  2071. }
  2072. return 0;
  2073. }
  2074. /*
  2075.  * Build system table
  2076.  *
  2077.  * The system table contains information about all the IOPs in the
  2078.  * system (duh) and is used by the Executives on the IOPs to establish
  2079.  * peer2peer connections.  We're not supporting peer2peer at the moment,
  2080.  * but this will be needed down the road for things like lan2lan forwarding.
  2081.  */
  2082. static int i2o_build_sys_table(void)
  2083. {
  2084. struct i2o_controller *iop = NULL;
  2085. struct i2o_controller *niop = NULL;
  2086. int count = 0;
  2087. sys_tbl_len = sizeof(struct i2o_sys_tbl) + // Header + IOPs
  2088. (i2o_num_controllers) *
  2089. sizeof(struct i2o_sys_tbl_entry);
  2090. if(sys_tbl)
  2091. kfree(sys_tbl);
  2092. sys_tbl = kmalloc(sys_tbl_len, GFP_KERNEL);
  2093. if(!sys_tbl) {
  2094. printk(KERN_CRIT "SysTab Set failed. Out of memory.n");
  2095. return -ENOMEM;
  2096. }
  2097. memset((void*)sys_tbl, 0, sys_tbl_len);
  2098. sys_tbl->num_entries = i2o_num_controllers;
  2099. sys_tbl->version = I2OVERSION; /* TODO: Version 2.0 */
  2100. sys_tbl->change_ind = sys_tbl_ind++;
  2101. for(iop = i2o_controller_chain; iop; iop = niop)
  2102. {
  2103. niop = iop->next;
  2104. /* 
  2105.  * Get updated IOP state so we have the latest information
  2106.  *
  2107.  * We should delete the controller at this point if it
  2108.  * doesn't respond since  if it's not on the system table 
  2109.  * it is techninically not part of the I2O subsy遲em...
  2110.  */
  2111. if(i2o_status_get(iop)) {
  2112. printk(KERN_ERR "%s: Deleting b/c could not get status while"
  2113. "attempting to build system tablen", iop->name);
  2114. i2o_delete_controller(iop);
  2115. sys_tbl->num_entries--;
  2116. continue; // try the next one
  2117. }
  2118. sys_tbl->iops[count].org_id = iop->status_block->org_id;
  2119. sys_tbl->iops[count].iop_id = iop->unit + 2;
  2120. sys_tbl->iops[count].seg_num = 0;
  2121. sys_tbl->iops[count].i2o_version = 
  2122. iop->status_block->i2o_version;
  2123. sys_tbl->iops[count].iop_state = 
  2124. iop->status_block->iop_state;
  2125. sys_tbl->iops[count].msg_type = 
  2126. iop->status_block->msg_type;
  2127. sys_tbl->iops[count].frame_size = 
  2128. iop->status_block->inbound_frame_size;
  2129. sys_tbl->iops[count].last_changed = sys_tbl_ind - 1; // ??
  2130. sys_tbl->iops[count].iop_capabilities = 
  2131. iop->status_block->iop_capabilities;
  2132. sys_tbl->iops[count].inbound_low = 
  2133. (u32)virt_to_bus(iop->post_port);
  2134. sys_tbl->iops[count].inbound_high = 0; // TODO: 64-bit support
  2135. count++;
  2136. }
  2137. #ifdef DRIVERDEBUG
  2138. {
  2139. u32 *table;
  2140. table = (u32*)sys_tbl;
  2141. for(count = 0; count < (sys_tbl_len >>2); count++)
  2142. printk(KERN_INFO "sys_tbl[%d] = %0#10xn", count, table[count]);
  2143. }
  2144. #endif
  2145. return 0;
  2146. }
  2147. /*
  2148.  * Run time support routines
  2149.  */
  2150.  
  2151. /*
  2152.  * Generic "post and forget" helpers. This is less efficient - we do
  2153.  * a memcpy for example that isnt strictly needed, but for most uses
  2154.  * this is simply not worth optimising
  2155.  */
  2156. int i2o_post_this(struct i2o_controller *c, u32 *data, int len)
  2157. {
  2158. u32 m;
  2159. u32 *msg;
  2160. unsigned long t=jiffies;
  2161. do
  2162. {
  2163. mb();
  2164. m = I2O_POST_READ32(c);
  2165. }
  2166. while(m==0xFFFFFFFF && (jiffies-t)<HZ);
  2167. if(m==0xFFFFFFFF)
  2168. {
  2169. printk(KERN_ERR "%s: Timeout waiting for message frame!n",
  2170.        c->name);
  2171. return -ETIMEDOUT;
  2172. }
  2173. msg = (u32 *)(c->mem_offset + m);
  2174.   memcpy_toio(msg, data, len);
  2175. i2o_post_message(c,m);
  2176. return 0;
  2177. }
  2178. /**
  2179.  *  i2o_post_wait_mem - I2O query/reply with DMA buffers
  2180.  * @c: controller
  2181.  * @msg: message to send
  2182.  * @len: length of message
  2183.  * @timeout: time in seconds to wait
  2184.  * @mem1: attached memory buffer 1
  2185.  * @mem2: attached memory buffer 2
  2186.  *
  2187.  *  This core API allows an OSM to post a message and then be told whether
  2188.  * or not the system received a successful reply. 
  2189.  *
  2190.  * If the message times out then the value '-ETIMEDOUT' is returned. This
  2191.  * is a special case. In this situation the message may (should) complete
  2192.  * at an indefinite time in the future. When it completes it will use the
  2193.  * memory buffers attached to the request. If -ETIMEDOUT is returned then
  2194.  * the memory buffers must not be freed. Instead the event completion will
  2195.  * free them for you. In all other cases the buffers are your problem.
  2196.  *
  2197.  * Pass NULL for unneeded buffers.
  2198.  */
  2199.  
  2200. int i2o_post_wait_mem(struct i2o_controller *c, u32 *msg, int len, int timeout, void *mem1, void *mem2)
  2201. {
  2202. DECLARE_WAIT_QUEUE_HEAD(wq_i2o_post);
  2203. DECLARE_WAITQUEUE(wait, current);
  2204. int complete = 0;
  2205. int status;
  2206. unsigned long flags = 0;
  2207. struct i2o_post_wait_data *wait_data =
  2208. kmalloc(sizeof(struct i2o_post_wait_data), GFP_KERNEL);
  2209. if(!wait_data)
  2210. return -ENOMEM;
  2211. /*
  2212.  * Create a new notification object
  2213.  */
  2214. wait_data->status = &status;
  2215. wait_data->complete = &complete;
  2216. wait_data->mem[0] = mem1;
  2217. wait_data->mem[1] = mem2;
  2218. /* 
  2219.  * Queue the event with its unique id
  2220.  */
  2221. spin_lock_irqsave(&post_wait_lock, flags);
  2222. wait_data->next = post_wait_queue;
  2223. post_wait_queue = wait_data;
  2224. wait_data->id = (++post_wait_id) & 0x7fff;
  2225. wait_data->wq = &wq_i2o_post;
  2226. spin_unlock_irqrestore(&post_wait_lock, flags);
  2227. /*
  2228.  * Fill in the message id
  2229.  */
  2230.  
  2231. msg[2] = 0x80000000|(u32)core_context|((u32)wait_data->id<<16);
  2232. /*
  2233.  * Post the message to the controller. At some point later it 
  2234.  * will return. If we time out before it returns then
  2235.  * complete will be zero.  From the point post_this returns
  2236.  * the wait_data may have been deleted.
  2237.  */
  2238. add_wait_queue(&wq_i2o_post, &wait);
  2239. set_current_state(TASK_INTERRUPTIBLE);
  2240. if ((status = i2o_post_this(c, msg, len))==0) {
  2241. schedule_timeout(HZ * timeout);
  2242. }  
  2243. else
  2244. {
  2245. remove_wait_queue(&wq_i2o_post, &wait);
  2246. return -EIO;
  2247. }
  2248. remove_wait_queue(&wq_i2o_post, &wait);
  2249. if(signal_pending(current))
  2250. status = -EINTR;
  2251. spin_lock_irqsave(&post_wait_lock, flags);
  2252. barrier(); /* Be sure we see complete as it is locked */
  2253. if(!complete)
  2254. {
  2255. /* 
  2256.  * Mark the entry dead. We cannot remove it. This is important.
  2257.  * When it does terminate (which it must do if the controller hasnt
  2258.  * died..) then it will otherwise scribble on stuff.
  2259.  * !complete lets us safely check if the entry is still
  2260.  * allocated and thus we can write into it
  2261.  */
  2262. wait_data->wq = NULL;
  2263. status = -ETIMEDOUT;
  2264. }
  2265. else
  2266. {
  2267. /* Debugging check - remove me soon */
  2268. if(status == -ETIMEDOUT)
  2269. {
  2270. printk("TIMEDOUT BUG!n");
  2271. status = -EIO;
  2272. }
  2273. }
  2274. /* And the wait_data is not leaked either! */  
  2275. spin_unlock_irqrestore(&post_wait_lock, flags);
  2276. return status;
  2277. }
  2278. /**
  2279.  *  i2o_post_wait - I2O query/reply
  2280.  * @c: controller
  2281.  * @msg: message to send
  2282.  * @len: length of message
  2283.  * @timeout: time in seconds to wait
  2284.  *
  2285.  *  This core API allows an OSM to post a message and then be told whether
  2286.  * or not the system received a successful reply. 
  2287.  */
  2288.  
  2289. int i2o_post_wait(struct i2o_controller *c, u32 *msg, int len, int timeout)
  2290. {
  2291. return i2o_post_wait_mem(c, msg, len, timeout, NULL, NULL);
  2292. }
  2293. /*
  2294.  * i2o_post_wait is completed and we want to wake up the 
  2295.  * sleeping proccess. Called by core's reply handler.
  2296.  */
  2297. static void i2o_post_wait_complete(u32 context, int status)
  2298. {
  2299. struct i2o_post_wait_data **p1, *q;
  2300. unsigned long flags;
  2301. /* 
  2302.  * We need to search through the post_wait 
  2303.  * queue to see if the given message is still
  2304.  * outstanding.  If not, it means that the IOP 
  2305.  * took longer to respond to the message than we 
  2306.  * had allowed and timer has already expired.  
  2307.  * Not much we can do about that except log
  2308.  * it for debug purposes, increase timeout, and recompile
  2309.  *
  2310.  * Lock needed to keep anyone from moving queue pointers 
  2311.  * around while we're looking through them.
  2312.  */
  2313. spin_lock_irqsave(&post_wait_lock, flags);
  2314. for(p1 = &post_wait_queue; *p1!=NULL; p1 = &((*p1)->next)) 
  2315. {
  2316. q = (*p1);
  2317. if(q->id == ((context >> 16) & 0x7fff)) {
  2318. /*
  2319.  * Delete it 
  2320.  */
  2321.  
  2322. *p1 = q->next;
  2323. /*
  2324.  * Live or dead ?
  2325.  */
  2326.  
  2327. if(q->wq)
  2328. {
  2329. /* Live entry - wakeup and set status */
  2330. *q->status = status;
  2331. *q->complete = 1;
  2332. wake_up(q->wq);
  2333. }
  2334. else
  2335. {
  2336. /*
  2337.  * Free resources. Caller is dead
  2338.  */
  2339. if(q->mem[0])
  2340. kfree(q->mem[0]);
  2341. if(q->mem[1])
  2342. kfree(q->mem[1]);
  2343. printk(KERN_WARNING "i2o_post_wait event completed after timeout.n");
  2344. }
  2345. kfree(q);
  2346. spin_unlock(&post_wait_lock);
  2347. return;
  2348. }
  2349. }
  2350. spin_unlock(&post_wait_lock);
  2351. printk(KERN_DEBUG "i2o_post_wait: Bogus reply!n");
  2352. }
  2353. /* Issue UTIL_PARAMS_GET or UTIL_PARAMS_SET
  2354.  *
  2355.  * This function can be used for all UtilParamsGet/Set operations.
  2356.  * The OperationList is given in oplist-buffer, 
  2357.  * and results are returned in reslist-buffer.
  2358.  * Note that the minimum sized reslist is 8 bytes and contains
  2359.  * ResultCount, ErrorInfoSize, BlockStatus and BlockSize.
  2360.  */
  2361. int i2o_issue_params(int cmd, struct i2o_controller *iop, int tid, 
  2362.                 void *oplist, int oplen, void *reslist, int reslen)
  2363. {
  2364. u32 msg[9]; 
  2365. u32 *res32 = (u32*)reslist;
  2366. u32 *restmp = (u32*)reslist;
  2367. int len = 0;
  2368. int i = 0;
  2369. int wait_status;
  2370. u32 *opmem, *resmem;
  2371. /* Get DMAable memory */
  2372. opmem = kmalloc(oplen, GFP_KERNEL);
  2373. if(opmem == NULL)
  2374. return -ENOMEM;
  2375. memcpy(opmem, oplist, oplen);
  2376. resmem = kmalloc(reslen, GFP_KERNEL);
  2377. if(resmem == NULL)
  2378. {
  2379. kfree(opmem);
  2380. return -ENOMEM;
  2381. }
  2382. msg[0] = NINE_WORD_MSG_SIZE | SGL_OFFSET_5;
  2383. msg[1] = cmd << 24 | HOST_TID << 12 | tid; 
  2384. msg[3] = 0;
  2385. msg[4] = 0;
  2386. msg[5] = 0x54000000 | oplen; /* OperationList */
  2387. msg[6] = virt_to_bus(opmem);
  2388. msg[7] = 0xD0000000 | reslen; /* ResultList */
  2389. msg[8] = virt_to_bus(resmem);
  2390. wait_status = i2o_post_wait_mem(iop, msg, sizeof(msg), 10, opmem, resmem);
  2391. /*
  2392.  * This only looks like a memory leak - don't "fix" it.
  2393.  */
  2394. if(wait_status == -ETIMEDOUT)
  2395. return wait_status;
  2396. /* Query failed */
  2397. if(wait_status != 0)
  2398. {
  2399. kfree(resmem);
  2400. kfree(opmem);
  2401. return wait_status;
  2402. }
  2403. memcpy(reslist, resmem, reslen);
  2404. /*
  2405.  * Calculate number of bytes of Result LIST
  2406.  * We need to loop through each Result BLOCK and grab the length
  2407.  */
  2408. restmp = res32 + 1;
  2409. len = 1;
  2410. for(i = 0; i < (res32[0]&0X0000FFFF); i++)
  2411. {
  2412. if(restmp[0]&0x00FF0000) /* BlockStatus != SUCCESS */
  2413. {
  2414. printk(KERN_WARNING "%s - Error:n  ErrorInfoSize = 0x%02x, " 
  2415. "BlockStatus = 0x%02x, BlockSize = 0x%04xn",
  2416. (cmd == I2O_CMD_UTIL_PARAMS_SET) ? "PARAMS_SET"
  2417. : "PARAMS_GET",   
  2418. res32[1]>>24, (res32[1]>>16)&0xFF, res32[1]&0xFFFF);
  2419. /*
  2420.  * If this is the only request,than we return an error
  2421.  */
  2422. if((res32[0]&0x0000FFFF) == 1)
  2423. {
  2424. return -((res32[1] >> 16) & 0xFF); /* -BlockStatus */
  2425. }
  2426. }
  2427. len += restmp[0] & 0x0000FFFF; /* Length of res BLOCK */
  2428. restmp += restmp[0] & 0x0000FFFF; /* Skip to next BLOCK */
  2429. }
  2430. return (len << 2);  /* bytes used by result list */
  2431. }
  2432. /*
  2433.  *  Query one scalar group value or a whole scalar group.
  2434.  */                  
  2435. int i2o_query_scalar(struct i2o_controller *iop, int tid, 
  2436.                      int group, int field, void *buf, int buflen)
  2437. {
  2438. u16 opblk[] = { 1, 0, I2O_PARAMS_FIELD_GET, group, 1, field };
  2439. u8  resblk[8+buflen]; /* 8 bytes for header */
  2440. int size;
  2441. if (field == -1)   /* whole group */
  2442.         opblk[4] = -1;
  2443.               
  2444. size = i2o_issue_params(I2O_CMD_UTIL_PARAMS_GET, iop, tid, 
  2445. opblk, sizeof(opblk), resblk, sizeof(resblk));
  2446. memcpy(buf, resblk+8, buflen);  /* cut off header */
  2447. if(size>buflen)
  2448. return buflen;
  2449. return size;
  2450. }
  2451. /*
  2452.  * Set a scalar group value or a whole group.
  2453.  */
  2454. int i2o_set_scalar(struct i2o_controller *iop, int tid, 
  2455.    int group, int field, void *buf, int buflen)
  2456. {
  2457. u16 *opblk;
  2458. u8  resblk[8+buflen]; /* 8 bytes for header */
  2459.         int size;
  2460. opblk = kmalloc(buflen+64, GFP_KERNEL);
  2461. if (opblk == NULL)
  2462. {
  2463. printk(KERN_ERR "i2o: no memory for operation buffer.n");
  2464. return -ENOMEM;
  2465. }
  2466. opblk[0] = 1;                        /* operation count */
  2467. opblk[1] = 0;                        /* pad */
  2468. opblk[2] = I2O_PARAMS_FIELD_SET;
  2469. opblk[3] = group;
  2470. if(field == -1) {               /* whole group */
  2471. opblk[4] = -1;
  2472. memcpy(opblk+5, buf, buflen);
  2473. }
  2474. else                            /* single field */
  2475. {
  2476. opblk[4] = 1;
  2477. opblk[5] = field;
  2478. memcpy(opblk+6, buf, buflen);
  2479. }   
  2480. size = i2o_issue_params(I2O_CMD_UTIL_PARAMS_SET, iop, tid, 
  2481. opblk, 12+buflen, resblk, sizeof(resblk));
  2482. kfree(opblk);
  2483. if(size>buflen)
  2484. return buflen;
  2485. return size;
  2486. }
  2487. /* 
  2488.  *  if oper == I2O_PARAMS_TABLE_GET, get from all rows 
  2489.  *  if fieldcount == -1 return all fields
  2490.  * ibuf and ibuflen are unused (use NULL, 0)
  2491.  *  else return specific fields
  2492.  *   ibuf contains fieldindexes
  2493.  *
  2494.  *  if oper == I2O_PARAMS_LIST_GET, get from specific rows
  2495.  *  if fieldcount == -1 return all fields
  2496.  * ibuf contains rowcount, keyvalues
  2497.  *  else return specific fields
  2498.  * fieldcount is # of fieldindexes
  2499.  *   ibuf contains fieldindexes, rowcount, keyvalues
  2500.  *
  2501.  * You could also use directly function i2o_issue_params().
  2502.  */
  2503. int i2o_query_table(int oper, struct i2o_controller *iop, int tid, int group,
  2504. int fieldcount, void *ibuf, int ibuflen,
  2505. void *resblk, int reslen) 
  2506. {
  2507. u16 *opblk;
  2508. int size;
  2509. opblk = kmalloc(10 + ibuflen, GFP_KERNEL);
  2510. if (opblk == NULL)
  2511. {
  2512. printk(KERN_ERR "i2o: no memory for query buffer.n");
  2513. return -ENOMEM;
  2514. }
  2515. opblk[0] = 1; /* operation count */
  2516. opblk[1] = 0; /* pad */
  2517. opblk[2] = oper;
  2518. opblk[3] = group;
  2519. opblk[4] = fieldcount;
  2520. memcpy(opblk+5, ibuf, ibuflen); /* other params */
  2521. size = i2o_issue_params(I2O_CMD_UTIL_PARAMS_GET,iop, tid, 
  2522. opblk, 10+ibuflen, resblk, reslen);
  2523. kfree(opblk);
  2524. if(size>reslen)
  2525. return reslen;
  2526. return size;
  2527. }
  2528. /*
  2529.  *  Clear table group, i.e. delete all rows.
  2530.  */
  2531. int i2o_clear_table(struct i2o_controller *iop, int tid, int group)
  2532. {
  2533. u16 opblk[] = { 1, 0, I2O_PARAMS_TABLE_CLEAR, group };
  2534. u8  resblk[32]; /* min 8 bytes for result header */
  2535. return i2o_issue_params(I2O_CMD_UTIL_PARAMS_SET, iop, tid, 
  2536. opblk, sizeof(opblk), resblk, sizeof(resblk));
  2537. }
  2538. /*
  2539.  *  Add a new row into a table group.
  2540.  *
  2541.  *  if fieldcount==-1 then we add whole rows
  2542.  * buf contains rowcount, keyvalues
  2543.  *  else just specific fields are given, rest use defaults
  2544.  *   buf contains fieldindexes, rowcount, keyvalues
  2545.  */
  2546. int i2o_row_add_table(struct i2o_controller *iop, int tid,
  2547.     int group, int fieldcount, void *buf, int buflen)
  2548. {
  2549. u16 *opblk;
  2550. u8  resblk[32]; /* min 8 bytes for header */
  2551. int size;
  2552. opblk = kmalloc(buflen+64, GFP_KERNEL);
  2553. if (opblk == NULL)
  2554. {
  2555. printk(KERN_ERR "i2o: no memory for operation buffer.n");
  2556. return -ENOMEM;
  2557. }
  2558. opblk[0] = 1; /* operation count */
  2559. opblk[1] = 0; /* pad */
  2560. opblk[2] = I2O_PARAMS_ROW_ADD;
  2561. opblk[3] = group;
  2562. opblk[4] = fieldcount;
  2563. memcpy(opblk+5, buf, buflen);
  2564. size = i2o_issue_params(I2O_CMD_UTIL_PARAMS_SET, iop, tid, 
  2565. opblk, 10+buflen, resblk, sizeof(resblk));
  2566. kfree(opblk);
  2567. if(size>buflen)
  2568. return buflen;
  2569. return size;
  2570. }
  2571. /*
  2572.  * Used for error reporting/debugging purposes.
  2573.  * Following fail status are common to all classes.
  2574.  * The preserved message must be handled in the reply handler. 
  2575.  */
  2576. void i2o_report_fail_status(u8 req_status, u32* msg)
  2577. {
  2578. static char *FAIL_STATUS[] = { 
  2579. "0x80", /* not used */
  2580. "SERVICE_SUSPENDED",  /* 0x81 */
  2581. "SERVICE_TERMINATED",  /* 0x82 */
  2582. "CONGESTION",
  2583. "FAILURE",
  2584. "STATE_ERROR",
  2585. "TIME_OUT",
  2586. "ROUTING_FAILURE",
  2587. "INVALID_VERSION",
  2588. "INVALID_OFFSET",
  2589. "INVALID_MSG_FLAGS",
  2590. "FRAME_TOO_SMALL",
  2591. "FRAME_TOO_LARGE",
  2592. "INVALID_TARGET_ID",
  2593. "INVALID_INITIATOR_ID",
  2594. "INVALID_INITIATOR_CONTEX", /* 0x8F */
  2595. "UNKNOWN_FAILURE" /* 0xFF */
  2596. };
  2597. if (req_status == I2O_FSC_TRANSPORT_UNKNOWN_FAILURE)
  2598. printk("TRANSPORT_UNKNOWN_FAILURE (%0#2x)n.", req_status);
  2599. else
  2600. printk("TRANSPORT_%s.n", FAIL_STATUS[req_status & 0x0F]);
  2601. /* Dump some details */
  2602. printk(KERN_ERR "  InitiatorId = %d, TargetId = %dn",
  2603. (msg[1] >> 12) & 0xFFF, msg[1] & 0xFFF); 
  2604. printk(KERN_ERR "  LowestVersion = 0x%02X, HighestVersion = 0x%02Xn",
  2605. (msg[4] >> 8) & 0xFF, msg[4] & 0xFF);
  2606. printk(KERN_ERR "  FailingHostUnit = 0x%04X,  FailingIOP = 0x%03Xn",
  2607. msg[5] >> 16, msg[5] & 0xFFF);
  2608. printk(KERN_ERR "  Severity:  0x%02X ", (msg[4] >> 16) & 0xFF); 
  2609. if (msg[4] & (1<<16))
  2610. printk("(FormatError), "
  2611. "this msg can never be delivered/processed.n");
  2612. if (msg[4] & (1<<17))
  2613. printk("(PathError), "
  2614. "this msg can no longer be delivered/processed.n");
  2615. if (msg[4] & (1<<18))
  2616. printk("(PathState), "
  2617. "the system state does not allow delivery.n");
  2618. if (msg[4] & (1<<19))
  2619. printk("(Congestion), resources temporarily not available;"
  2620. "do not retry immediately.n");
  2621. }
  2622. /*
  2623.  * Used for error reporting/debugging purposes.
  2624.  * Following reply status are common to all classes.
  2625.  */
  2626. void i2o_report_common_status(u8 req_status)
  2627. {
  2628. static char *REPLY_STATUS[] = { 
  2629. "SUCCESS", 
  2630. "ABORT_DIRTY", 
  2631. "ABORT_NO_DATA_TRANSFER",
  2632. "ABORT_PARTIAL_TRANSFER",
  2633. "ERROR_DIRTY",
  2634. "ERROR_NO_DATA_TRANSFER",
  2635. "ERROR_PARTIAL_TRANSFER",
  2636. "PROCESS_ABORT_DIRTY",
  2637. "PROCESS_ABORT_NO_DATA_TRANSFER",
  2638. "PROCESS_ABORT_PARTIAL_TRANSFER",
  2639. "TRANSACTION_ERROR",
  2640. "PROGRESS_REPORT"
  2641. };
  2642. if (req_status > I2O_REPLY_STATUS_PROGRESS_REPORT)
  2643. printk("RequestStatus = %0#2x", req_status);
  2644. else
  2645. printk("%s", REPLY_STATUS[req_status]);
  2646. }
  2647. /*
  2648.  * Used for error reporting/debugging purposes.
  2649.  * Following detailed status are valid  for executive class, 
  2650.  * utility class, DDM class and for transaction error replies.
  2651.  */
  2652. static void i2o_report_common_dsc(u16 detailed_status)
  2653. {
  2654. static char *COMMON_DSC[] = { 
  2655. "SUCCESS",
  2656. "0x01", // not used
  2657. "BAD_KEY",
  2658. "TCL_ERROR",
  2659. "REPLY_BUFFER_FULL",
  2660. "NO_SUCH_PAGE",
  2661. "INSUFFICIENT_RESOURCE_SOFT",
  2662. "INSUFFICIENT_RESOURCE_HARD",
  2663. "0x08", // not used
  2664. "CHAIN_BUFFER_TOO_LARGE",
  2665. "UNSUPPORTED_FUNCTION",
  2666. "DEVICE_LOCKED",
  2667. "DEVICE_RESET",
  2668. "INAPPROPRIATE_FUNCTION",
  2669. "INVALID_INITIATOR_ADDRESS",
  2670. "INVALID_MESSAGE_FLAGS",
  2671. "INVALID_OFFSET",
  2672. "INVALID_PARAMETER",
  2673. "INVALID_REQUEST",
  2674. "INVALID_TARGET_ADDRESS",
  2675. "MESSAGE_TOO_LARGE",
  2676. "MESSAGE_TOO_SMALL",
  2677. "MISSING_PARAMETER",
  2678. "TIMEOUT",
  2679. "UNKNOWN_ERROR",
  2680. "UNKNOWN_FUNCTION",
  2681. "UNSUPPORTED_VERSION",
  2682. "DEVICE_BUSY",
  2683. "DEVICE_NOT_AVAILABLE"
  2684. };
  2685. if (detailed_status > I2O_DSC_DEVICE_NOT_AVAILABLE)
  2686. printk(" / DetailedStatus = %0#4x.n", detailed_status);
  2687. else
  2688. printk(" / %s.n", COMMON_DSC[detailed_status]);
  2689. }
  2690. /*
  2691.  * Used for error reporting/debugging purposes
  2692.  */
  2693. static void i2o_report_lan_dsc(u16 detailed_status)
  2694. {
  2695. static char *LAN_DSC[] = { // Lan detailed status code strings
  2696. "SUCCESS",
  2697. "DEVICE_FAILURE",
  2698. "DESTINATION_NOT_FOUND",
  2699. "TRANSMIT_ERROR",
  2700. "TRANSMIT_ABORTED",
  2701. "RECEIVE_ERROR",
  2702. "RECEIVE_ABORTED",
  2703. "DMA_ERROR",
  2704. "BAD_PACKET_DETECTED",
  2705. "OUT_OF_MEMORY",
  2706. "BUCKET_OVERRUN",
  2707. "IOP_INTERNAL_ERROR",
  2708. "CANCELED",
  2709. "INVALID_TRANSACTION_CONTEXT",
  2710. "DEST_ADDRESS_DETECTED",
  2711. "DEST_ADDRESS_OMITTED",
  2712. "PARTIAL_PACKET_RETURNED",
  2713. "TEMP_SUSPENDED_STATE", // last Lan detailed status code
  2714. "INVALID_REQUEST" // general detailed status code
  2715. };
  2716. if (detailed_status > I2O_DSC_INVALID_REQUEST)
  2717. printk(" / %0#4x.n", detailed_status);
  2718. else
  2719. printk(" / %s.n", LAN_DSC[detailed_status]);
  2720. }
  2721. /*
  2722.  * Used for error reporting/debugging purposes
  2723.  */
  2724. static void i2o_report_util_cmd(u8 cmd)
  2725. {
  2726. switch (cmd) {
  2727. case I2O_CMD_UTIL_NOP:
  2728. printk("UTIL_NOP, ");
  2729. break;
  2730. case I2O_CMD_UTIL_ABORT:
  2731. printk("UTIL_ABORT, ");
  2732. break;
  2733. case I2O_CMD_UTIL_CLAIM:
  2734. printk("UTIL_CLAIM, ");
  2735. break;
  2736. case I2O_CMD_UTIL_RELEASE:
  2737. printk("UTIL_CLAIM_RELEASE, ");
  2738. break;
  2739. case I2O_CMD_UTIL_CONFIG_DIALOG:
  2740. printk("UTIL_CONFIG_DIALOG, ");
  2741. break;
  2742. case I2O_CMD_UTIL_DEVICE_RESERVE:
  2743. printk("UTIL_DEVICE_RESERVE, ");
  2744. break;
  2745. case I2O_CMD_UTIL_DEVICE_RELEASE:
  2746. printk("UTIL_DEVICE_RELEASE, ");
  2747. break;
  2748. case I2O_CMD_UTIL_EVT_ACK:
  2749. printk("UTIL_EVENT_ACKNOWLEDGE, ");
  2750. break;
  2751. case I2O_CMD_UTIL_EVT_REGISTER:
  2752. printk("UTIL_EVENT_REGISTER, ");
  2753. break;
  2754. case I2O_CMD_UTIL_LOCK:
  2755. printk("UTIL_LOCK, ");
  2756. break;
  2757. case I2O_CMD_UTIL_LOCK_RELEASE:
  2758. printk("UTIL_LOCK_RELEASE, ");
  2759. break;
  2760. case I2O_CMD_UTIL_PARAMS_GET:
  2761. printk("UTIL_PARAMS_GET, ");
  2762. break;
  2763. case I2O_CMD_UTIL_PARAMS_SET:
  2764. printk("UTIL_PARAMS_SET, ");
  2765. break;
  2766. case I2O_CMD_UTIL_REPLY_FAULT_NOTIFY:
  2767. printk("UTIL_REPLY_FAULT_NOTIFY, ");
  2768. break;
  2769. default:
  2770. printk("Cmd = %0#2x, ",cmd);
  2771. }
  2772. }
  2773. /*
  2774.  * Used for error reporting/debugging purposes
  2775.  */
  2776. static void i2o_report_exec_cmd(u8 cmd)
  2777. {
  2778. switch (cmd) {
  2779. case I2O_CMD_ADAPTER_ASSIGN:
  2780. printk("EXEC_ADAPTER_ASSIGN, ");
  2781. break;
  2782. case I2O_CMD_ADAPTER_READ:
  2783. printk("EXEC_ADAPTER_READ, ");
  2784. break;
  2785. case I2O_CMD_ADAPTER_RELEASE:
  2786. printk("EXEC_ADAPTER_RELEASE, ");
  2787. break;
  2788. case I2O_CMD_BIOS_INFO_SET:
  2789. printk("EXEC_BIOS_INFO_SET, ");
  2790. break;
  2791. case I2O_CMD_BOOT_DEVICE_SET:
  2792. printk("EXEC_BOOT_DEVICE_SET, ");
  2793. break;
  2794. case I2O_CMD_CONFIG_VALIDATE:
  2795. printk("EXEC_CONFIG_VALIDATE, ");
  2796. break;
  2797. case I2O_CMD_CONN_SETUP:
  2798. printk("EXEC_CONN_SETUP, ");
  2799. break;
  2800. case I2O_CMD_DDM_DESTROY:
  2801. printk("EXEC_DDM_DESTROY, ");
  2802. break;
  2803. case I2O_CMD_DDM_ENABLE:
  2804. printk("EXEC_DDM_ENABLE, ");
  2805. break;
  2806. case I2O_CMD_DDM_QUIESCE:
  2807. printk("EXEC_DDM_QUIESCE, ");
  2808. break;
  2809. case I2O_CMD_DDM_RESET:
  2810. printk("EXEC_DDM_RESET, ");
  2811. break;
  2812. case I2O_CMD_DDM_SUSPEND:
  2813. printk("EXEC_DDM_SUSPEND, ");
  2814. break;
  2815. case I2O_CMD_DEVICE_ASSIGN:
  2816. printk("EXEC_DEVICE_ASSIGN, ");
  2817. break;
  2818. case I2O_CMD_DEVICE_RELEASE:
  2819. printk("EXEC_DEVICE_RELEASE, ");
  2820. break;
  2821. case I2O_CMD_HRT_GET:
  2822. printk("EXEC_HRT_GET, ");
  2823. break;
  2824. case I2O_CMD_ADAPTER_CLEAR:
  2825. printk("EXEC_IOP_CLEAR, ");
  2826. break;
  2827. case I2O_CMD_ADAPTER_CONNECT:
  2828. printk("EXEC_IOP_CONNECT, ");
  2829. break;
  2830. case I2O_CMD_ADAPTER_RESET:
  2831. printk("EXEC_IOP_RESET, ");
  2832. break;
  2833. case I2O_CMD_LCT_NOTIFY:
  2834. printk("EXEC_LCT_NOTIFY, ");
  2835. break;
  2836. case I2O_CMD_OUTBOUND_INIT:
  2837. printk("EXEC_OUTBOUND_INIT, ");
  2838. break;
  2839. case I2O_CMD_PATH_ENABLE:
  2840. printk("EXEC_PATH_ENABLE, ");
  2841. break;
  2842. case I2O_CMD_PATH_QUIESCE:
  2843. printk("EXEC_PATH_QUIESCE, ");
  2844. break;
  2845. case I2O_CMD_PATH_RESET:
  2846. printk("EXEC_PATH_RESET, ");
  2847. break;
  2848. case I2O_CMD_STATIC_MF_CREATE:
  2849. printk("EXEC_STATIC_MF_CREATE, ");
  2850. break;
  2851. case I2O_CMD_STATIC_MF_RELEASE:
  2852. printk("EXEC_STATIC_MF_RELEASE, ");
  2853. break;
  2854. case I2O_CMD_STATUS_GET:
  2855. printk("EXEC_STATUS_GET, ");
  2856. break;
  2857. case I2O_CMD_SW_DOWNLOAD:
  2858. printk("EXEC_SW_DOWNLOAD, ");
  2859. break;
  2860. case I2O_CMD_SW_UPLOAD:
  2861. printk("EXEC_SW_UPLOAD, ");
  2862. break;
  2863. case I2O_CMD_SW_REMOVE:
  2864. printk("EXEC_SW_REMOVE, ");
  2865. break;
  2866. case I2O_CMD_SYS_ENABLE:
  2867. printk("EXEC_SYS_ENABLE, ");
  2868. break;
  2869. case I2O_CMD_SYS_MODIFY:
  2870. printk("EXEC_SYS_MODIFY, ");
  2871. break;
  2872. case I2O_CMD_SYS_QUIESCE:
  2873. printk("EXEC_SYS_QUIESCE, ");
  2874. break;
  2875. case I2O_CMD_SYS_TAB_SET:
  2876. printk("EXEC_SYS_TAB_SET, ");
  2877. break;
  2878. default:
  2879. printk("Cmd = %#02x, ",cmd);
  2880. }
  2881. }
  2882. /*
  2883.  * Used for error reporting/debugging purposes
  2884.  */
  2885. static void i2o_report_lan_cmd(u8 cmd)
  2886. {
  2887. switch (cmd) {
  2888. case LAN_PACKET_SEND:
  2889. printk("LAN_PACKET_SEND, "); 
  2890. break;
  2891. case LAN_SDU_SEND:
  2892. printk("LAN_SDU_SEND, ");
  2893. break;
  2894. case LAN_RECEIVE_POST:
  2895. printk("LAN_RECEIVE_POST, ");
  2896. break;
  2897. case LAN_RESET:
  2898. printk("LAN_RESET, ");
  2899. break;
  2900. case LAN_SUSPEND:
  2901. printk("LAN_SUSPEND, ");
  2902. break;
  2903. default:
  2904. printk("Cmd = %0#2x, ",cmd);
  2905. }
  2906. }
  2907. /*
  2908.  * Used for error reporting/debugging purposes.
  2909.  * Report Cmd name, Request status, Detailed Status.
  2910.  */
  2911. void i2o_report_status(const char *severity, const char *str, u32 *msg)
  2912. {
  2913. u8 cmd = (msg[1]>>24)&0xFF;
  2914. u8 req_status = (msg[4]>>24)&0xFF;
  2915. u16 detailed_status = msg[4]&0xFFFF;
  2916. struct i2o_handler *h = i2o_handlers[msg[2] & (MAX_I2O_MODULES-1)];
  2917. printk("%s%s: ", severity, str);
  2918. if (cmd < 0x1F)  // Utility cmd
  2919. i2o_report_util_cmd(cmd);
  2920. else if (cmd >= 0xA0 && cmd <= 0xEF)  // Executive cmd
  2921. i2o_report_exec_cmd(cmd);
  2922. else if (h->class == I2O_CLASS_LAN && cmd >= 0x30 && cmd <= 0x3F)
  2923. i2o_report_lan_cmd(cmd); // LAN cmd
  2924. else
  2925.          printk("Cmd = %0#2x, ", cmd); // Other cmds
  2926. if (msg[0] & MSG_FAIL) {
  2927. i2o_report_fail_status(req_status, msg);
  2928. return;
  2929. }
  2930. i2o_report_common_status(req_status);
  2931. if (cmd < 0x1F || (cmd >= 0xA0 && cmd <= 0xEF))
  2932. i2o_report_common_dsc(detailed_status);
  2933. else if (h->class == I2O_CLASS_LAN && cmd >= 0x30 && cmd <= 0x3F)
  2934. i2o_report_lan_dsc(detailed_status);
  2935. else
  2936. printk(" / DetailedStatus = %0#4x.n", detailed_status); 
  2937. }
  2938. /* Used to dump a message to syslog during debugging */
  2939. void i2o_dump_message(u32 *msg)
  2940. {
  2941. #ifdef DRIVERDEBUG
  2942. int i;
  2943. printk(KERN_INFO "Dumping I2O message size %d @ %pn", 
  2944. msg[0]>>16&0xffff, msg);
  2945. for(i = 0; i < ((msg[0]>>16)&0xffff); i++)
  2946. printk(KERN_INFO "  msg[%d] = %0#10xn", i, msg[i]);
  2947. #endif
  2948. }
  2949. /*
  2950.  * I2O reboot/shutdown notification.
  2951.  *
  2952.  * - Call each OSM's reboot notifier (if one exists)
  2953.  * - Quiesce each IOP in the system
  2954.  *
  2955.  * Each IOP has to be quiesced before we can ensure that the system
  2956.  * can be properly shutdown as a transaction that has already been
  2957.  * acknowledged still needs to be placed in permanent store on the IOP.
  2958.  * The SysQuiesce causes the IOP to force all HDMs to complete their
  2959.  * transactions before returning, so only at that point is it safe
  2960.  * 
  2961.  */
  2962. static int i2o_reboot_event(struct notifier_block *n, unsigned long code, void
  2963. *p)
  2964. {
  2965. int i = 0;
  2966. struct i2o_controller *c = NULL;
  2967. if(code != SYS_RESTART && code != SYS_HALT && code != SYS_POWER_OFF)
  2968. return NOTIFY_DONE;
  2969. printk(KERN_INFO "Shutting down I2O system.n");
  2970. printk(KERN_INFO 
  2971. "   This could take a few minutes if there are many devices attachedn");
  2972. for(i = 0; i < MAX_I2O_MODULES; i++)
  2973. {
  2974. if(i2o_handlers[i] && i2o_handlers[i]->reboot_notify)
  2975. i2o_handlers[i]->reboot_notify();
  2976. }
  2977. for(c = i2o_controller_chain; c; c = c->next)
  2978. {
  2979. if(i2o_quiesce_controller(c))
  2980. {
  2981. printk(KERN_WARNING "i2o: Could not quiesce %s."  "
  2982. Verify setup on next system power up.n", c->name);
  2983. }
  2984. }
  2985. printk(KERN_INFO "I2O system down.n");
  2986. return NOTIFY_DONE;
  2987. }
  2988. EXPORT_SYMBOL(i2o_controller_chain);
  2989. EXPORT_SYMBOL(i2o_num_controllers);
  2990. EXPORT_SYMBOL(i2o_find_controller);
  2991. EXPORT_SYMBOL(i2o_unlock_controller);
  2992. EXPORT_SYMBOL(i2o_status_get);
  2993. EXPORT_SYMBOL(i2o_install_handler);
  2994. EXPORT_SYMBOL(i2o_remove_handler);
  2995. EXPORT_SYMBOL(i2o_claim_device);
  2996. EXPORT_SYMBOL(i2o_release_device);
  2997. EXPORT_SYMBOL(i2o_device_notify_on);
  2998. EXPORT_SYMBOL(i2o_device_notify_off);
  2999. EXPORT_SYMBOL(i2o_post_this);
  3000. EXPORT_SYMBOL(i2o_post_wait);
  3001. EXPORT_SYMBOL(i2o_post_wait_mem);
  3002. EXPORT_SYMBOL(i2o_query_scalar);
  3003. EXPORT_SYMBOL(i2o_set_scalar);
  3004. EXPORT_SYMBOL(i2o_query_table);
  3005. EXPORT_SYMBOL(i2o_clear_table);
  3006. EXPORT_SYMBOL(i2o_row_add_table);
  3007. EXPORT_SYMBOL(i2o_issue_params);
  3008. EXPORT_SYMBOL(i2o_event_register);
  3009. EXPORT_SYMBOL(i2o_event_ack);
  3010. EXPORT_SYMBOL(i2o_report_status);
  3011. EXPORT_SYMBOL(i2o_dump_message);
  3012. EXPORT_SYMBOL(i2o_get_class_name);
  3013. #ifdef MODULE
  3014. MODULE_AUTHOR("Red Hat Software");
  3015. MODULE_DESCRIPTION("I2O Core");
  3016. MODULE_LICENSE("GPL");
  3017. int init_module(void)
  3018. {
  3019. printk(KERN_INFO "I2O Core - (C) Copyright 1999 Red Hat Softwaren");
  3020. if (i2o_install_handler(&i2o_core_handler) < 0)
  3021. {
  3022. printk(KERN_ERR 
  3023. "i2o_core: Unable to install core handler.nI2O stack not loaded!");
  3024. return 0;
  3025. }
  3026. core_context = i2o_core_handler.context;
  3027. /*
  3028.  * Attach core to I2O PCI transport (and others as they are developed)
  3029.  */
  3030. #ifdef CONFIG_I2O_PCI_MODULE
  3031. if(i2o_pci_core_attach(&i2o_core_functions) < 0)
  3032. printk(KERN_INFO "i2o: No PCI I2O controllers foundn");
  3033. #endif
  3034. /*
  3035.  * Initialize event handling thread
  3036.  */
  3037. init_MUTEX_LOCKED(&evt_sem);
  3038. evt_pid = kernel_thread(i2o_core_evt, &evt_reply, CLONE_SIGHAND);
  3039. if(evt_pid < 0)
  3040. {
  3041. printk(KERN_ERR "I2O: Could not create event handler kernel threadn");
  3042. i2o_remove_handler(&i2o_core_handler);
  3043. return 0;
  3044. }
  3045. else
  3046. printk(KERN_INFO "I2O: Event thread created as pid %dn", evt_pid);
  3047. if(i2o_num_controllers)
  3048. i2o_sys_init();
  3049. register_reboot_notifier(&i2o_reboot_notifier);
  3050. return 0;
  3051. }
  3052. void cleanup_module(void)
  3053. {
  3054. int stat;
  3055. unregister_reboot_notifier(&i2o_reboot_notifier);
  3056. if(i2o_num_controllers)
  3057. i2o_sys_shutdown();
  3058. /*
  3059.  * If this is shutdown time, the thread has already been killed
  3060.  */
  3061. if(evt_running) {
  3062. printk("Terminating i2o threads...");
  3063. stat = kill_proc(evt_pid, SIGTERM, 1);
  3064. if(!stat) {
  3065. printk("waiting...");
  3066. wait_for_completion(&evt_dead);
  3067. }
  3068. printk("done.n");
  3069. }
  3070. #ifdef CONFIG_I2O_PCI_MODULE
  3071. i2o_pci_core_detach();
  3072. #endif
  3073. i2o_remove_handler(&i2o_core_handler);
  3074. unregister_reboot_notifier(&i2o_reboot_notifier);
  3075. }
  3076. #else
  3077. extern int i2o_block_init(void);
  3078. extern int i2o_config_init(void);
  3079. extern int i2o_lan_init(void);
  3080. extern int i2o_pci_init(void);
  3081. extern int i2o_proc_init(void);
  3082. extern int i2o_scsi_init(void);
  3083. int __init i2o_init(void)
  3084. {
  3085. printk(KERN_INFO "Loading I2O Core - (c) Copyright 1999 Red Hat Softwaren");
  3086. if (i2o_install_handler(&i2o_core_handler) < 0)
  3087. {
  3088. printk(KERN_ERR 
  3089. "i2o_core: Unable to install core handler.nI2O stack not loaded!");
  3090. return 0;
  3091. }
  3092. core_context = i2o_core_handler.context;
  3093. /*
  3094.  * Initialize event handling thread
  3095.  * We may not find any controllers, but still want this as 
  3096.  * down the road we may have hot pluggable controllers that
  3097.  * need to be dealt with.
  3098.  */
  3099. init_MUTEX_LOCKED(&evt_sem);
  3100. if((evt_pid = kernel_thread(i2o_core_evt, &evt_reply, CLONE_SIGHAND)) < 0)
  3101. {
  3102. printk(KERN_ERR "I2O: Could not create event handler kernel threadn");
  3103. i2o_remove_handler(&i2o_core_handler);
  3104. return 0;
  3105. }
  3106. #ifdef CONFIG_I2O_PCI
  3107. i2o_pci_init();
  3108. #endif
  3109. if(i2o_num_controllers)
  3110. i2o_sys_init();
  3111. register_reboot_notifier(&i2o_reboot_notifier);
  3112. i2o_config_init();
  3113. #ifdef CONFIG_I2O_BLOCK
  3114. i2o_block_init();
  3115. #endif
  3116. #ifdef CONFIG_I2O_LAN
  3117. i2o_lan_init();
  3118. #endif
  3119. #ifdef CONFIG_I2O_PROC
  3120. i2o_proc_init();
  3121. #endif
  3122. return 0;
  3123. }
  3124. #endif