} else { /* Get vendor/device ID u32 */ rc = pci_bus_read_config_dword (ctrl->pci_dev->subordinate, PCI_DEVFN(func->device, func->function), PCI_VENDOR_ID, &temp_register); dbg("%s: pci_bus_read_config_dword returns %d\n", __FUNCTION__, rc); dbg("%s: temp_register is %x\n", __FUNCTION__, temp_register);  if (rc != 0) { /* Something's wrong here */ temp_register = 0xFFFFFFFF; dbg("%s: temp register set to %x by error\n", __FUNCTION__, temp_register); } /* Preset return code.  It will be changed later if things go okay. */ rc = NO_ADAPTER_PRESENT; }  /* All F's is an empty slot or an invalid board */ if (temp_register != 0xFFFFFFFF) {	  /* Check for a board in the slot */ res_lists.io_head = ctrl->io_head; res_lists.mem_head = ctrl->mem_head; res_lists.p_mem_head = ctrl->p_mem_head; res_lists.bus_head = ctrl->bus_head; res_lists.irqs = NULL;  rc = configure_new_device(ctrl, func, 0, &res_lists, 0, 0); dbg("%s: back from configure_new_device\n", __FUNCTION__);  ctrl->io_head = res_lists.io_head; ctrl->mem_head = res_lists.mem_head; ctrl->p_mem_head = res_lists.p_mem_head; ctrl->bus_head = res_lists.bus_head;  shpchp_resource_sort_and_combine(&(ctrl->mem_head)); shpchp_resource_sort_and_combine(&(ctrl->p_mem_head)); shpchp_resource_sort_and_combine(&(ctrl->io_head)); shpchp_resource_sort_and_combine(&(ctrl->bus_head));  if (rc) { /* Wait for exclusive access to hardware */ down(&ctrl->crit_sect);  /* turn off slot, turn on Amber LED, turn off Green LED */ retval = p_slot->hpc_ops->slot_disable(p_slot); if (retval) { err("%s: Issue of Slot Enable command failed\n", __FUNCTION__); /* Done with exclusive hardware access */ up(&ctrl->crit_sect); return retval; } /* Wait for the command to complete */ wait_for_ctrl_irq (ctrl);  retval = p_slot->hpc_ops->check_cmd_status(ctrl); if (retval) { err("%s: Failed to disable slot, error code(%d)\n", __FUNCTION__, retval); /* Done with exclusive hardware access */ up(&ctrl->crit_sect); return retval; }  /* Done with exclusive hardware access */ up(&ctrl->crit_sect);  return(rc); } shpchp_save_slot_config(ctrl, func);  func->status = 0; func->switch_save = 0x10; func->is_a_board = 0x01; func->pwr_save = 1;  /* Next, we will instantiate the linux pci_dev structures * (with appropriate driver notification, if already present) */ index = 0; do { new_func = shpchp_slot_find(ctrl->slot_bus, func->device, index++); if (new_func && !new_func->pci_dev) { dbg("%s:call pci_hp_configure_dev\n", __FUNCTION__); shpchp_configure_device(ctrl, new_func); } } while (new_func);  /* Wait for exclusive access to hardware */ down(&ctrl->crit_sect);  p_slot->hpc_ops->green_led_on(p_slot);  /* Wait for the command to complete */ wait_for_ctrl_irq (ctrl);   /* Done with exclusive hardware access */ up(&ctrl->crit_sect);  } else { /* Wait for exclusive access to hardware */ down(&ctrl->crit_sect);  /* turn off slot, turn on Amber LED, turn off Green LED */ rc = p_slot->hpc_ops->slot_disable(p_slot); if (rc) { err("%s: Issue of Slot Disable command failed\n", __FUNCTION__); /* Done with exclusive hardware access */ up(&ctrl->crit_sect); return rc; } /* Wait for the command to complete */ wait_for_ctrl_irq (ctrl);  rc = p_slot->hpc_ops->check_cmd_status(ctrl); if (rc) { err("%s: Failed to disable slot, error code(%d)\n", __FUNCTION__, rc); /* Done with exclusive hardware access */ up(&ctrl->crit_sect); return rc; }  /* Done with exclusive hardware access */ up(&ctrl->crit_sect);  return(rc); } 
goto err_exit; }  if (shpchp_configure_device(p_slot)) { err("Cannot add device at 0x%x:0x%x\n", p_slot->bus, p_slot->device); goto err_exit; }  shpchp_save_slot_config(ctrl, func);  func->status = 0; func->switch_save = 0x10; func->is_a_board = 0x01; func->pwr_save = 1;  /* Wait for exclusive access to hardware */ down(&ctrl->crit_sect);  p_slot->hpc_ops->green_led_on(p_slot);  /* Wait for the command to complete */ wait_for_ctrl_irq (ctrl);  /* Done with exclusive hardware access */ up(&ctrl->crit_sect);  
static u32 board_added(struct pci_func * func, struct controller * ctrl){	u8 hp_slot;	u8 slots_not_empty = 0;	int index;	u32 temp_register = 0xFFFFFFFF;	u32 retval, rc = 0;	struct pci_func *new_func = NULL;	struct slot *p_slot;	struct resource_lists res_lists;	enum pci_bus_speed adapter_speed, bus_speed, max_bus_speed;	u8 pi, mode;	p_slot = shpchp_find_slot(ctrl, func->device);	hp_slot = func->device - ctrl->slot_device_offset;	dbg("%s: func->device, slot_offset, hp_slot = %d, %d ,%d\n", __FUNCTION__, func->device, ctrl->slot_device_offset, hp_slot);	/* Wait for exclusive access to hardware */	down(&ctrl->crit_sect);	/* Power on slot without connecting to bus */	rc = p_slot->hpc_ops->power_on_slot(p_slot);	if (rc) {		err("%s: Failed to power on slot\n", __FUNCTION__);		/* Done with exclusive hardware access */		up(&ctrl->crit_sect);		return -1;	}				/* Wait for the command to complete */	wait_for_ctrl_irq (ctrl);		rc = p_slot->hpc_ops->check_cmd_status(ctrl);	if (rc) {		err("%s: Failed to power on slot, error code(%d)\n", __FUNCTION__, rc);		/* Done with exclusive hardware access */		up(&ctrl->crit_sect);		return -1;	}		if ((ctrl->pci_dev->vendor == 0x8086) && (ctrl->pci_dev->device == 0x0332)) {		if (slots_not_empty)			return WRONG_BUS_FREQUENCY;				if ((rc = p_slot->hpc_ops->set_bus_speed_mode(p_slot, PCI_SPEED_33MHz))) {			err("%s: Issue of set bus speed mode command failed\n", __FUNCTION__);			up(&ctrl->crit_sect);			return WRONG_BUS_FREQUENCY;		}		wait_for_ctrl_irq (ctrl);				if ((rc = p_slot->hpc_ops->check_cmd_status(ctrl))) {			err("%s: Can't set bus speed/mode in the case of adapter & bus mismatch\n",				  __FUNCTION__);			err("%s: Error code (%d)\n", __FUNCTION__, rc);			up(&ctrl->crit_sect);			return WRONG_BUS_FREQUENCY;		}		/* turn on board, blink green LED, turn off Amber LED */		if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {			err("%s: Issue of Slot Enable command failed\n", __FUNCTION__);			up(&ctrl->crit_sect);			return rc;		}		wait_for_ctrl_irq (ctrl);		if ((rc = p_slot->hpc_ops->check_cmd_status(ctrl))) {			err("%s: Failed to enable slot, error code(%d)\n", __FUNCTION__, rc);			up(&ctrl->crit_sect);			return rc;  		}	} 	rc = p_slot->hpc_ops->get_adapter_speed(p_slot, &adapter_speed);	/* 0 = PCI 33Mhz, 1 = PCI 66 Mhz, 2 = PCI-X 66 PA, 4 = PCI-X 66 ECC, */	/* 5 = PCI-X 133 PA, 7 = PCI-X 133 ECC,  0xa = PCI-X 133 Mhz 266, */	/* 0xd = PCI-X 133 Mhz 533 */	/* This encoding is different from the one used in cur_bus_speed & */	/* max_bus_speed */	if (rc  || adapter_speed == PCI_SPEED_UNKNOWN) {		err("%s: Can't get adapter speed or bus mode mismatch\n", __FUNCTION__);		/* Done with exclusive hardware access */		up(&ctrl->crit_sect);		return WRONG_BUS_FREQUENCY;	}	rc = p_slot->hpc_ops->get_cur_bus_speed(p_slot, &bus_speed);	if (rc || bus_speed == PCI_SPEED_UNKNOWN) {		err("%s: Can't get bus operation speed\n", __FUNCTION__);		/* Done with exclusive hardware access */		up(&ctrl->crit_sect);		return WRONG_BUS_FREQUENCY;	}	rc = p_slot->hpc_ops->get_max_bus_speed(p_slot, &max_bus_speed);	if (rc || max_bus_speed == PCI_SPEED_UNKNOWN) {		err("%s: Can't get max bus operation speed\n", __FUNCTION__);		max_bus_speed = bus_speed;	}	/* Done with exclusive hardware access */	up(&ctrl->crit_sect);	if ((rc  = p_slot->hpc_ops->get_prog_int(p_slot, &pi))) {		err("%s: Can't get controller programming interface, set it to 1\n", __FUNCTION__);		pi = 1;	}	/* Check if there are other slots or devices on the same bus */	if (!list_empty(&ctrl->pci_dev->subordinate->devices))		slots_not_empty = 1;	dbg("%s: slots_not_empty %d, pi %d\n", __FUNCTION__, 		slots_not_empty, pi);	dbg("adapter_speed %d, bus_speed %d, max_bus_speed %d\n", 		adapter_speed, bus_speed, max_bus_speed);	if (pi == 2) {		dbg("%s: In PI = %d\n", __FUNCTION__, pi);		if ((rc = p_slot->hpc_ops->get_mode1_ECC_cap(p_slot, &mode))) {			err("%s: Can't get Mode1_ECC, set mode to 0\n", __FUNCTION__);			mode = 0;		}		switch (adapter_speed) {		case PCI_SPEED_133MHz_PCIX_533:		case PCI_SPEED_133MHz_PCIX_266:			if ((bus_speed != adapter_speed) &&			   ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed)))) 				return rc;			break;			case PCI_SPEED_133MHz_PCIX_ECC:		case PCI_SPEED_133MHz_PCIX:			if (mode) { /* Bus - Mode 1 ECC */				if ((bus_speed != 0x7) &&				   ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed)))) 					return rc;			} else {				if ((bus_speed != 0x4) &&				   ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed)))) 					return rc;			}			break;		case PCI_SPEED_66MHz_PCIX_ECC:		case PCI_SPEED_66MHz_PCIX:			if (mode) { /* Bus - Mode 1 ECC */				if ((bus_speed != 0x5) &&				   ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed)))) 					return rc;			} else {				if ((bus_speed != 0x2) &&				   ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed)))) 					return rc;			}			break;		case PCI_SPEED_66MHz:			if ((bus_speed != 0x1) &&			   ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed)))) 				return rc;			break;			case PCI_SPEED_33MHz:			if (bus_speed > 0x0) {				if (slots_not_empty == 0) {					if ((rc = change_bus_speed(ctrl, p_slot, adapter_speed)))						return rc;				} else {					err("%s: speed of bus %x and adapter %x mismatch\n", __FUNCTION__, bus_speed, adapter_speed);					return WRONG_BUS_FREQUENCY;				}			}			break;		default:			err("%s: speed of bus %x and adapter %x mismatch\n", __FUNCTION__, bus_speed, adapter_speed);			return WRONG_BUS_FREQUENCY;		}	} else {		/* If adpater_speed == bus_speed, nothing to do here */		dbg("%s: In PI = %d\n", __FUNCTION__, pi);		if ((adapter_speed != bus_speed) &&		   ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))				return rc;	}	down(&ctrl->crit_sect);	/* turn on board, blink green LED, turn off Amber LED */	if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {		err("%s: Issue of Slot Enable command failed\n", __FUNCTION__);		up(&ctrl->crit_sect);		return rc;	}	wait_for_ctrl_irq (ctrl);	if ((rc = p_slot->hpc_ops->check_cmd_status(ctrl))) {		err("%s: Failed to enable slot, error code(%d)\n", __FUNCTION__, rc);		up(&ctrl->crit_sect);		return rc;  	}	up(&ctrl->crit_sect);	/* Wait for ~1 second */	dbg("%s: before long_delay\n", __FUNCTION__);	wait_for_ctrl_irq (ctrl);	dbg("%s: after long_delay\n", __FUNCTION__);	dbg("%s: func status = %x\n", __FUNCTION__, func->status);	/* Check for a power fault */	if (func->status == 0xFF) {		/* power fault occurred, but it was benign */		temp_register = 0xFFFFFFFF;		dbg("%s: temp register set to %x by power fault\n", __FUNCTION__, temp_register);		rc = POWER_FAILURE;		func->status = 0;	} else {		/* Get vendor/device ID u32 */		rc = pci_bus_read_config_dword (ctrl->pci_dev->subordinate, PCI_DEVFN(func->device, func->function), 			PCI_VENDOR_ID, &temp_register);		dbg("%s: pci_bus_read_config_dword returns %d\n", __FUNCTION__, rc);		dbg("%s: temp_register is %x\n", __FUNCTION__, temp_register);		if (rc != 0) {			/* Something's wrong here */			temp_register = 0xFFFFFFFF;			dbg("%s: temp register set to %x by error\n", __FUNCTION__, temp_register);		}		/* Preset return code.  It will be changed later if things go okay. */		rc = NO_ADAPTER_PRESENT;	}	/* All F's is an empty slot or an invalid board */	if (temp_register != 0xFFFFFFFF) {	  /* Check for a board in the slot */		res_lists.io_head = ctrl->io_head;		res_lists.mem_head = ctrl->mem_head;		res_lists.p_mem_head = ctrl->p_mem_head;		res_lists.bus_head = ctrl->bus_head;		res_lists.irqs = NULL;		rc = configure_new_device(ctrl, func, 0, &res_lists, 0, 0);		dbg("%s: back from configure_new_device\n", __FUNCTION__);		ctrl->io_head = res_lists.io_head;		ctrl->mem_head = res_lists.mem_head;		ctrl->p_mem_head = res_lists.p_mem_head;		ctrl->bus_head = res_lists.bus_head;		shpchp_resource_sort_and_combine(&(ctrl->mem_head));		shpchp_resource_sort_and_combine(&(ctrl->p_mem_head));		shpchp_resource_sort_and_combine(&(ctrl->io_head));		shpchp_resource_sort_and_combine(&(ctrl->bus_head));		if (rc) {			/* Wait for exclusive access to hardware */			down(&ctrl->crit_sect);			/* turn off slot, turn on Amber LED, turn off Green LED */			retval = p_slot->hpc_ops->slot_disable(p_slot);			if (retval) {				err("%s: Issue of Slot Enable command failed\n", __FUNCTION__);				/* Done with exclusive hardware access */				up(&ctrl->crit_sect);				return retval;			}			/* Wait for the command to complete */			wait_for_ctrl_irq (ctrl);			retval = p_slot->hpc_ops->check_cmd_status(ctrl);			if (retval) {				err("%s: Failed to disable slot, error code(%d)\n", __FUNCTION__, retval);				/* Done with exclusive hardware access */				up(&ctrl->crit_sect);				return retval;  			}			/* Done with exclusive hardware access */			up(&ctrl->crit_sect);			return(rc);		}		shpchp_save_slot_config(ctrl, func);		func->status = 0;		func->switch_save = 0x10;		func->is_a_board = 0x01;		func->pwr_save = 1;		/* Next, we will instantiate the linux pci_dev structures 		 * (with appropriate driver notification, if already present) 		 */		index = 0;		do {			new_func = shpchp_slot_find(ctrl->slot_bus, func->device, index++);			if (new_func && !new_func->pci_dev) {				dbg("%s:call pci_hp_configure_dev\n", __FUNCTION__);				shpchp_configure_device(ctrl, new_func);			}		} while (new_func);		/* Wait for exclusive access to hardware */		down(&ctrl->crit_sect);		p_slot->hpc_ops->green_led_on(p_slot);		/* Wait for the command to complete */		wait_for_ctrl_irq (ctrl);		/* Done with exclusive hardware access */		up(&ctrl->crit_sect);	} else {		/* Wait for exclusive access to hardware */		down(&ctrl->crit_sect);		/* turn off slot, turn on Amber LED, turn off Green LED */		rc = p_slot->hpc_ops->slot_disable(p_slot);		if (rc) {			err("%s: Issue of Slot Disable command failed\n", __FUNCTION__);			/* Done with exclusive hardware access */			up(&ctrl->crit_sect);			return rc;		}		/* Wait for the command to complete */		wait_for_ctrl_irq (ctrl);		rc = p_slot->hpc_ops->check_cmd_status(ctrl);		if (rc) {			err("%s: Failed to disable slot, error code(%d)\n", __FUNCTION__, rc);			/* Done with exclusive hardware access */			up(&ctrl->crit_sect);			return rc;  		}		/* Done with exclusive hardware access */		up(&ctrl->crit_sect);		return(rc);	}	return 0;}
10457	/local/tlutelli/issta_data/temp/c/2005_temp/2005/10457/dbd7a78818d125a0ebd5507d4edb4dd5900006ab/shpchp_ctrl.c/clean/drivers/pci/hotplug/shpchp_ctrl.c