/* ----------------------------------------------------------------------- * * * Copyright 2009 Erwan Velu - All Rights Reserved * * Permission is hereby granted, free of charge, to any person * obtaining a copy of this software and associated documentation * files (the "Software"), to deal in the Software without * restriction, including without limitation the rights to use, * copy, modify, merge, publish, distribute, sublicense, and/or * sell copies of the Software, and to permit persons to whom * the Software is furnished to do so, subject to the following * conditions: * * The above copyright notice and this permission notice shall * be included in all copies or substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR * OTHER DEALINGS IN THE SOFTWARE. * * ----------------------------------------------------------------------- */ #include #include #include #include #include "syslinux/config.h" #include "../lib/sys/vesa/vesa.h" #include "hdt-common.h" #include #include #include /* ISOlinux requires a 8.3 format */ void convert_isolinux_filename(char *filename, struct s_hardware *hardware) { /* Exit if we are not running ISOLINUX */ if (hardware->sv->filesystem != SYSLINUX_FS_ISOLINUX) return; /* Searching the dot */ char *dot = strchr(filename, '.'); /* Exiting if no dot exists in that string */ if (dot == NULL) return; /* Exiting if the extension is 3 char or less */ if (strlen(dot) <= 4) return; /* We have an extension bigger than .blah * so we have to shorten it to 3*/ dot[4] = '\0'; } void detect_parameters(const int argc, const char *argv[], struct s_hardware *hardware) { /* Quiet mode - make the output more quiet */ quiet = true; /* Silent mode - make not output at all */ silent = false; /* Vesa mode isn't set until we explictly call it */ vesamode = false; /* Automode isn't the default*/ automode = false; /* Menu mode is the default*/ menumode = true; for (int i = 1; i < argc; i++) { if (!strncmp(argv[i], "quiet", 5)) { quiet = true; } else if (!strncmp(argv[i], "silent", 6)) { silent = true; } else if (!strncmp(argv[i], "verbose", 7)) { quiet = false; } else if (!strncmp(argv[i], "modules_pcimap=", 15)) { strlcpy(hardware->modules_pcimap_path, argv[i] + 15, sizeof(hardware->modules_pcimap_path)); convert_isolinux_filename(hardware->modules_pcimap_path, hardware); } else if (!strncmp(argv[i], "pciids=", 7)) { strlcpy(hardware->pciids_path, argv[i] + 7, sizeof(hardware->pciids_path)); convert_isolinux_filename(hardware->pciids_path, hardware); } else if (!strncmp(argv[i], "modules_alias=", 14)) { strlcpy(hardware->modules_alias_path, argv[i] + 14, sizeof(hardware->modules_alias_path)); convert_isolinux_filename(hardware->modules_alias_path, hardware); } else if (!strncmp(argv[i], "memtest=", 8)) { strlcpy(hardware->memtest_label, argv[i] + 8, sizeof(hardware->memtest_label)); convert_isolinux_filename(hardware->memtest_label, hardware); } else if (!strncmp(argv[i], "vesa", 4)) { vesamode = true; max_console_lines = MAX_VESA_CLI_LINES; /* If the user defines a background image */ if (!strncmp(argv[i], "vesa=", 5)) { strlcpy(hardware->vesa_background, argv[i] + 5, sizeof(hardware->vesa_background)); } } else if (!strncmp(argv[i], "novesa", 6)) { vesamode = false; max_console_lines = MAX_CLI_LINES; } else if (!strncmp(argv[i], "nomenu", 6)) { menumode = false; } else if (!strncmp(argv[i], "dump_filename=", 14)) { strlcpy(hardware->dump_filename, argv[i] + 14, sizeof(hardware->dump_filename)); } else if (!strncmp(argv[i], "dump_path=", 10)) { strlcpy(hardware->dump_path, argv[i] + 10, sizeof(hardware->dump_path)); } else if (!strncmp(argv[i], "tftp_ip=", 8)) { strlcpy(hardware->tftp_ip, argv[i] + 8, sizeof(hardware->tftp_ip)); } else if (!strncmp(argv[i], "postexec=", 9)) { /* The postexec= parameter is separated in several argv[] * as it can contains spaces. * We use the AUTO_DELIMITER char to define the limits * of this parameter. * i.e postexec='linux memtest.bin' */ char *argument = (char*)argv[i]+10; /* Extracting the first parameter */ strcpy(hardware->postexec, argument); /* While we can't find the other AUTO_DELIMITER, let's process the argv[] */ while ((strchr(argument, AUTO_DELIMITER) == NULL) && (i+1postexec, " "); strcat(hardware->postexec, argument); } hardware->postexec[strlen(hardware->postexec) - 1] = 0; } else if (!strncmp(argv[i], "auto=", 5)) { /* The auto= parameter is separated in several argv[] * as it can contains spaces. * We use the AUTO_DELIMITER char to define the limits * of this parameter. * i.e auto='show dmi; show pci' */ automode=true; char *argument = (char*)argv[i]+6; /* Extracting the first parameter */ strcpy(hardware->auto_label, argument); /* While we can't find the other AUTO_DELIMITER, let's process the argv[] */ while ((strchr(argument, AUTO_DELIMITER) == NULL) && (i+1auto_label, " "); strcat(hardware->auto_label, argument); } hardware->auto_label[strlen(hardware->auto_label) - 1] = 0; } } } void detect_syslinux(struct s_hardware *hardware) { hardware->sv = syslinux_version(); switch (hardware->sv->filesystem) { case SYSLINUX_FS_SYSLINUX: strlcpy(hardware->syslinux_fs, "SYSlinux", 9); break; case SYSLINUX_FS_PXELINUX: strlcpy(hardware->syslinux_fs, "PXElinux", 9); break; case SYSLINUX_FS_ISOLINUX: strlcpy(hardware->syslinux_fs, "ISOlinux", 9); break; case SYSLINUX_FS_EXTLINUX: strlcpy(hardware->syslinux_fs, "EXTlinux", 9); break; case SYSLINUX_FS_UNKNOWN: default: strlcpy(hardware->syslinux_fs, "Unknown Bootloader", sizeof hardware->syslinux_fs); break; } } void init_hardware(struct s_hardware *hardware) { hardware->pci_ids_return_code = 0; hardware->modules_pcimap_return_code = 0; hardware->modules_alias_return_code = 0; hardware->cpu_detection = false; hardware->pci_detection = false; hardware->disk_detection = false; hardware->disks_count = 0; hardware->dmi_detection = false; hardware->pxe_detection = false; hardware->vesa_detection = false; hardware->vpd_detection = false; hardware->memory_detection = false; hardware->acpi_detection = false; hardware->nb_pci_devices = 0; hardware->is_dmi_valid = false; hardware->is_pxe_valid = false; hardware->is_vpd_valid = false; hardware->is_acpi_valid = false; hardware->pci_domain = NULL; hardware->detected_memory_size = 0; hardware->physical_cpu_count =1; /* we have at least one cpu */ /* Cleaning structures */ memset(hardware->disk_info, 0, sizeof(hardware->disk_info)); memset(hardware->mbr_ids, 0, sizeof(hardware->mbr_ids)); memset(&hardware->dmi, 0, sizeof(s_dmi)); memset(&hardware->cpu, 0, sizeof(s_cpu)); memset(&hardware->pxe, 0, sizeof(struct s_pxe)); memset(&hardware->vesa, 0, sizeof(struct s_vesa)); memset(&hardware->vpd, 0, sizeof(s_vpd)); memset(&hardware->acpi, 0, sizeof(s_acpi)); memset(hardware->syslinux_fs, 0, sizeof hardware->syslinux_fs); memset(hardware->pciids_path, 0, sizeof hardware->pciids_path); memset(hardware->modules_pcimap_path, 0, sizeof hardware->modules_pcimap_path); memset(hardware->modules_alias_path, 0, sizeof hardware->modules_alias_path); memset(hardware->memtest_label, 0, sizeof hardware->memtest_label); memset(hardware->auto_label, 0, sizeof hardware->auto_label); memset(hardware->dump_path, 0, sizeof hardware->dump_path); memset(hardware->dump_filename, 0, sizeof hardware->dump_filename); memset(hardware->vesa_background, 0, sizeof hardware->vesa_background); memset(hardware->tftp_ip, 0, sizeof hardware->tftp_ip); memset(hardware->postexec, 0, sizeof hardware->postexec); strcat(hardware->dump_path, "hdt"); strcat(hardware->dump_filename, "%{m}+%{p}+%{v}"); strcat(hardware->pciids_path, "pci.ids"); strcat(hardware->modules_pcimap_path, "modules.pcimap"); strcat(hardware->modules_alias_path, "modules.alias"); strcat(hardware->memtest_label, "memtest"); strlcpy(hardware->vesa_background, CLI_DEFAULT_BACKGROUND, sizeof(hardware->vesa_background)); } /* * Detecting if a DMI table exist * if yes, let's parse it */ int detect_dmi(struct s_hardware *hardware) { if (hardware->dmi_detection == true) return -1; hardware->dmi_detection = true; if (dmi_iterate(&hardware->dmi) == -ENODMITABLE) { hardware->is_dmi_valid = false; return -ENODMITABLE; } parse_dmitable(&hardware->dmi); hardware->is_dmi_valid = true; return 0; } /* * Detecting ACPI * if yes, let's parse it */ int detect_acpi(struct s_hardware *hardware) { int retval; if (hardware->acpi_detection == true) return -1; hardware->acpi_detection = true; if ((retval=parse_acpi(&hardware->acpi)) != ACPI_FOUND) { hardware->is_acpi_valid = false; return retval; } hardware->is_acpi_valid = true; return retval; } /** * vpd_detection - populate the VPD structure * * VPD is a structure available on IBM machines. * It is documented at: * http://www.pc.ibm.com/qtechinfo/MIGR-45120.html * (XXX the page seems to be gone) **/ int detect_vpd(struct s_hardware *hardware) { if (hardware->vpd_detection) return -1; else hardware->vpd_detection = true; if (vpd_decode(&hardware->vpd) == -ENOVPDTABLE) { hardware->is_vpd_valid = false; return -ENOVPDTABLE; } else { hardware->is_vpd_valid = true; return 0; } } /* Detection vesa stuff*/ int detect_vesa(struct s_hardware *hardware) { static com32sys_t rm; struct vesa_general_info *gi; struct vesa_mode_info *mi; uint16_t mode, *mode_ptr; char *oem_ptr; if (hardware->vesa_detection == true) return -1; hardware->vesa_detection = true; hardware->is_vesa_valid = false; /* Allocate space in the bounce buffer for these structures */ gi = &((struct vesa_info *)__com32.cs_bounce)->gi; mi = &((struct vesa_info *)__com32.cs_bounce)->mi; gi->signature = VBE2_MAGIC; /* Get VBE2 extended data */ rm.eax.w[0] = 0x4F00; /* Get SVGA general information */ rm.edi.w[0] = OFFS(gi); rm.es = SEG(gi); __intcall(0x10, &rm, &rm); if (rm.eax.w[0] != 0x004F) { return -1; }; mode_ptr = GET_PTR(gi->video_mode_ptr); oem_ptr = GET_PTR(gi->oem_vendor_name_ptr); strlcpy(hardware->vesa.vendor, oem_ptr, sizeof(hardware->vesa.vendor)); oem_ptr = GET_PTR(gi->oem_product_name_ptr); strlcpy(hardware->vesa.product, oem_ptr, sizeof(hardware->vesa.product)); oem_ptr = GET_PTR(gi->oem_product_rev_ptr); strlcpy(hardware->vesa.product_revision, oem_ptr, sizeof(hardware->vesa.product_revision)); hardware->vesa.major_version = (gi->version >> 8) & 0xff; hardware->vesa.minor_version = gi->version & 0xff; hardware->vesa.total_memory = gi->total_memory; hardware->vesa.software_rev = gi->oem_software_rev; hardware->vesa.vmi_count = 0; while ((mode = *mode_ptr++) != 0xFFFF) { rm.eax.w[0] = 0x4F01; /* Get SVGA mode information */ rm.ecx.w[0] = mode; rm.edi.w[0] = OFFS(mi); rm.es = SEG(mi); __intcall(0x10, &rm, &rm); /* Must be a supported mode */ if (rm.eax.w[0] != 0x004f) continue; /* Saving detected values */ memcpy(&hardware->vesa.vmi[hardware->vesa.vmi_count].mi, mi, sizeof(struct vesa_mode_info)); hardware->vesa.vmi[hardware->vesa.vmi_count].mode = mode; hardware->vesa.vmi_count++; } hardware->is_vesa_valid = true; return 0; } /* Try to detect disks from port 0x80 to 0xff */ void detect_disks(struct s_hardware *hardware) { int i = -1; int err; if (hardware->disk_detection) return; hardware->disk_detection = true; for (int drive = 0x80; drive < 0xff; drive++) { i++; hardware->disk_info[i].disk = drive; err = get_drive_parameters(&hardware->disk_info[i]); /* * Do not print output when drive does not exist or * doesn't support int13 (cdrom, ...) */ if (err == -1 || !hardware->disk_info[i].cbios) continue; /* Detect MBR */ hardware->mbr_ids[i] = get_mbr_id(&hardware->disk_info[i]); hardware->disks_count++; } } int detect_pxe(struct s_hardware *hardware) { void *dhcpdata; size_t dhcplen; t_PXENV_UNDI_GET_NIC_TYPE gnt; if (hardware->pxe_detection == true) return -1; hardware->pxe_detection = true; hardware->is_pxe_valid = false; memset(&gnt, 0, sizeof(t_PXENV_UNDI_GET_NIC_TYPE)); memset(&hardware->pxe, 0, sizeof(struct s_pxe)); /* This code can only work if pxelinux is loaded */ if (hardware->sv->filesystem != SYSLINUX_FS_PXELINUX) { return -1; } // printf("PXE: PXElinux detected\n"); if (!pxe_get_cached_info(PXENV_PACKET_TYPE_DHCP_ACK, &dhcpdata, &dhcplen)) { pxe_bootp_t *dhcp = &hardware->pxe.dhcpdata; memcpy(&hardware->pxe.dhcpdata, dhcpdata, sizeof(hardware->pxe.dhcpdata)); snprintf(hardware->pxe.mac_addr, sizeof(hardware->pxe.mac_addr), "%02x:%02x:%02x:%02x:%02x:%02x", dhcp->CAddr[0], dhcp->CAddr[1], dhcp->CAddr[2], dhcp->CAddr[3], dhcp->CAddr[4], dhcp->CAddr[5]); /* Saving our IP address in a easy format */ hardware->pxe.ip_addr[0] = hardware->pxe.dhcpdata.yip & 0xff; hardware->pxe.ip_addr[1] = hardware->pxe.dhcpdata.yip >> 8 & 0xff; hardware->pxe.ip_addr[2] = hardware->pxe.dhcpdata.yip >> 16 & 0xff; hardware->pxe.ip_addr[3] = hardware->pxe.dhcpdata.yip >> 24 & 0xff; if (!pxe_get_nic_type(&gnt)) { switch (gnt.NicType) { case PCI_NIC: hardware->is_pxe_valid = true; hardware->pxe.vendor_id = gnt.info.pci.Vendor_ID; hardware->pxe.product_id = gnt.info.pci.Dev_ID; hardware->pxe.subvendor_id = gnt.info.pci.SubVendor_ID; hardware->pxe.subproduct_id = gnt.info.pci.SubDevice_ID, hardware->pxe.rev = gnt.info.pci.Rev; hardware->pxe.pci_bus = (gnt.info.pci.BusDevFunc >> 8) & 0xff; hardware->pxe.pci_dev = (gnt.info.pci.BusDevFunc >> 3) & 0x7; hardware->pxe.pci_func = gnt.info.pci.BusDevFunc & 0x03; hardware->pxe.base_class = gnt.info.pci.Base_Class; hardware->pxe.sub_class = gnt.info.pci.Sub_Class; hardware->pxe.prog_intf = gnt.info.pci.Prog_Intf; hardware->pxe.nictype = gnt.NicType; break; case CardBus_NIC: hardware->is_pxe_valid = true; hardware->pxe.vendor_id = gnt.info.cardbus.Vendor_ID; hardware->pxe.product_id = gnt.info.cardbus.Dev_ID; hardware->pxe.subvendor_id = gnt.info.cardbus.SubVendor_ID; hardware->pxe.subproduct_id = gnt.info.cardbus.SubDevice_ID, hardware->pxe.rev = gnt.info.cardbus.Rev; hardware->pxe.pci_bus = (gnt.info.cardbus.BusDevFunc >> 8) & 0xff; hardware->pxe.pci_dev = (gnt.info.cardbus.BusDevFunc >> 3) & 0x7; hardware->pxe.pci_func = gnt.info.cardbus.BusDevFunc & 0x03; hardware->pxe.base_class = gnt.info.cardbus.Base_Class; hardware->pxe.sub_class = gnt.info.cardbus.Sub_Class; hardware->pxe.prog_intf = gnt.info.cardbus.Prog_Intf; hardware->pxe.nictype = gnt.NicType; break; case PnP_NIC: default: return -1; break; } /* The firt pass try to find the exact pci device */ hardware->pxe.pci_device = NULL; hardware->pxe.pci_device_pos = 0; struct pci_device *pci_device; int pci_number = 0; for_each_pci_func(pci_device, hardware->pci_domain) { pci_number++; if ((__pci_bus == hardware->pxe.pci_bus) && (__pci_slot == hardware->pxe.pci_dev) && (__pci_func == hardware->pxe.pci_func) && (pci_device->vendor == hardware->pxe.vendor_id) && (pci_device->product == hardware->pxe.product_id)) { hardware->pxe.pci_device = pci_device; hardware->pxe.pci_device_pos = pci_number; return 0; } } /* If we reach that part, it means the pci device pointed by * the pxe rom wasn't found in our list. * Let's try to find the device only by its pci ids. * The pci device we'll match is maybe not exactly the good one * as we can have the same pci id several times. * At least, the pci id, the vendor/product will be right. * That's clearly a workaround for some weird cases. * This should happend very unlikely */ hardware->pxe.pci_device = NULL; hardware->pxe.pci_device_pos = 0; pci_number = 0; for_each_pci_func(pci_device, hardware->pci_domain) { pci_number++; if ((pci_device->vendor == hardware->pxe.vendor_id) && (pci_device->product == hardware->pxe.product_id)) { hardware->pxe.pci_device = pci_device; hardware->pxe.pci_device_pos = pci_number; return 0; } } } } return 0; } void detect_memory(struct s_hardware *hardware) { if (hardware->memory_detection == false) { hardware->memory_detection = true; hardware->detected_memory_size = detect_memsize(); } } void detect_pci(struct s_hardware *hardware) { if (hardware->pci_detection == true) return; hardware->pci_detection = true; hardware->nb_pci_devices = 0; /* Scanning to detect pci buses and devices */ hardware->pci_domain = pci_scan(); if (!hardware->pci_domain) return; /* Gathering addtional information */ gather_additional_pci_config(hardware->pci_domain); struct pci_device *pci_device; for_each_pci_func(pci_device, hardware->pci_domain) { hardware->nb_pci_devices++; } if (!quiet) { more_printf("PCI: %d devices detected\n", hardware->nb_pci_devices); more_printf("PCI: Resolving names\n"); } /* Assigning product & vendor name for each device */ hardware->pci_ids_return_code = get_name_from_pci_ids(hardware->pci_domain, hardware->pciids_path); if (!quiet) more_printf("PCI: Resolving class names\n"); /* Assigning class name for each device */ hardware->pci_ids_return_code = get_class_name_from_pci_ids(hardware->pci_domain, hardware->pciids_path); if (!quiet) more_printf("PCI: Resolving module names\n"); /* Detecting which kernel module should match each device using modules.pcimap */ hardware->modules_pcimap_return_code = get_module_name_from_pcimap(hardware->pci_domain, hardware->modules_pcimap_path); /* Detecting which kernel module should match each device using modules.alias */ hardware->modules_alias_return_code = get_module_name_from_alias(hardware->pci_domain, hardware->modules_alias_path); } void cpu_detect(struct s_hardware *hardware) { if (hardware->cpu_detection == true) return; detect_cpu(&hardware->cpu); /* Old processors doesn't manage the identify commands * Let's use the dmi value in that case */ if (strlen(remove_spaces(hardware->cpu.model)) == 0) strlcpy(hardware->cpu.model, hardware->dmi.processor.version, sizeof(hardware->cpu.model)); /* Some CPUs like to put many spaces in the model name * That makes some weird display in console/menu * Let's remove that mulitple spaces */ strlcpy(hardware->cpu.model,del_multi_spaces(hardware->cpu.model),sizeof(hardware->cpu.model)); if ((hardware->is_acpi_valid) && (hardware->acpi.madt.valid)) { hardware->physical_cpu_count=hardware->acpi.madt.processor_local_apic_count / hardware->cpu.num_cores; } hardware->cpu_detection = true; } /* * Find the last instance of a particular command line argument * (which should include the final =; do not use for boolean arguments) */ const char *find_argument(const char **argv, const char *argument) { int la = strlen(argument); const char **arg; const char *ptr = NULL; for (arg = argv; *arg; arg++) { if (!memcmp(*arg, argument, la)) ptr = *arg + la; } return ptr; } void clear_screen(void) { move_cursor_to_next_line(); disable_utf8(); set_g1_special_char(); set_us_g0_charset(); display_cursor(false); clear_entire_screen(); gotoxy(0,0); reset_more_printf(); } /* remove begining spaces */ char *skip_spaces(char *p) { while (*p && *p <= ' ') { p++; } return p; } /* remove trailing & begining spaces */ char *remove_spaces(char *p) { char *save = p; p += strlen(p) - 1; while (*p && *p <= ' ') { *p = '\0'; p--; } p = save; while (*p && *p <= ' ') { p++; } return p; } /* remove trailing LF */ char *remove_trailing_lf(char *p) { char *save = p; p += strlen(p) - 1; while (*p && *p == 10) { *p = '\0'; p--; } p = save; return p; } /* delete multiple spaces, one is enough */ char *del_multi_spaces(char *p) { /* Saving the original pointer */ char *save = p; /* Let's parse the complete string * As we search for a double spacing * we have to be sure then string is * long enough to be processed */ while (*p && *(p + 1)) { /* If we have two consecutive spaces */ if ((*p == ' ') && (*(p + 1) == ' ')) { /* Let's copy to the current position * the content from the second space*/ strlcpy(p, p + 1, strlen(p + 1)); /* Don't increment the pointer as we * changed the content of the current position*/ continue; } /* Nothing as been found, let's see on the next char */ p++; } /* Returning the original pointer */ return save; } /* Reset the more_printf counter */ void reset_more_printf(void) { display_line_nb = 0; } int draw_background(const char *what) { if (!what) return vesacon_default_background(); else return vesacon_load_background(what); } void init_console(struct s_hardware *hardware) { if (vesamode) { openconsole(&dev_rawcon_r, &dev_vesaserial_w); draw_background(hardware->vesa_background); } else console_ansi_raw(); } void detect_hardware(struct s_hardware *hardware) { if (!quiet) more_printf("ACPI: Detecting\n"); detect_acpi(hardware); if (!quiet) more_printf("MEMORY: Detecting\n"); detect_memory(hardware); if (!quiet) more_printf("DMI: Detecting Table\n"); if (detect_dmi(hardware) == -ENODMITABLE) { more_printf("DMI: ERROR ! Table not found ! \n"); more_printf("DMI: Many hardware components will not be detected ! \n"); } else { if (!quiet) more_printf("DMI: Table found ! (version %u.%u)\n", hardware->dmi.dmitable.major_version, hardware->dmi.dmitable.minor_version); } if (!quiet) more_printf("CPU: Detecting\n"); cpu_detect(hardware); if (!quiet) more_printf("DISKS: Detecting\n"); detect_disks(hardware); if (!quiet) more_printf("VPD: Detecting\n"); detect_vpd(hardware); detect_pci(hardware); if (!quiet) more_printf("PCI: %d Devices Found\n", hardware->nb_pci_devices); if (!quiet) more_printf("PXE: Detecting\n"); detect_pxe(hardware); if (!quiet) more_printf("VESA: Detecting\n"); detect_vesa(hardware); }