cavium/liquidio/octeon_console.c

35 static u64 cvmx_bootmem_phy_named_block_find(struct octeon_device *oct,
38 static int octeon_console_read(struct octeon_device *oct, u32 console_num,
139  * @param oct    Pointer to current octeon device
147 static inline u64 __cvmx_bootmem_desc_get(struct octeon_device *oct,
155 		return octeon_read_device_mem32(oct, base);
157 		return octeon_read_device_mem64(oct, base);
173 static void CVMX_BOOTMEM_NAMED_GET_NAME(struct octeon_device *oct,
179 	octeon_pci_read_core_mem(oct, addr, (u8 *)str, len);
195 static int __cvmx_bootmem_check_version(struct octeon_device *oct,
201 	if (!oct->bootmem_desc_addr)
202 		oct->bootmem_desc_addr =
203 			octeon_read_device_mem64(oct,
206 			oct, oct->bootmem_desc_addr,
210 			oct, oct->bootmem_desc_addr,
214 	dev_dbg(&oct->pci_dev->dev, "%s: major_version=%d\n", __func__,
218 		dev_err(&oct->pci_dev->dev, "bootmem ver mismatch %d.%d addr:0x%llx\n",
220 			(long long)oct->bootmem_desc_addr);
228 *__cvmx_bootmem_find_named_block_flags(struct octeon_device *oct,
232 		&oct->bootmem_named_block_desc;
233 	u64 named_addr = cvmx_bootmem_phy_named_block_find(oct, name, flags);
237 				oct, named_addr,
243 		desc->size = __cvmx_bootmem_desc_get(oct, named_addr,
251 		return &oct->bootmem_named_block_desc;
257 static u64 cvmx_bootmem_phy_named_block_find(struct octeon_device *oct,
263 	if (!__cvmx_bootmem_check_version(oct, 3)) {
267 					oct, oct->bootmem_desc_addr,
273 					oct, oct->bootmem_desc_addr,
280 					oct, oct->bootmem_desc_addr,
290 					oct, named_addr,
304 				CVMX_BOOTMEM_NAMED_GET_NAME(oct, named_addr,
334 static int octeon_named_block_find(struct octeon_device *oct, const char *name,
340 	named_block = __cvmx_bootmem_find_named_block_flags(oct, name, 0);
360 int octeon_console_send_cmd(struct octeon_device *oct, char *cmd_str,
365 	dev_dbg(&oct->pci_dev->dev, "sending \"%s\" to bootloader\n", cmd_str);
368 		dev_err(&oct->pci_dev->dev, "Command string too long, max length is: %d\n",
373 	if (octeon_wait_for_bootloader(oct, wait_hundredths) != 0) {
374 		dev_err(&oct->pci_dev->dev, "Bootloader not ready for command.\n");
380 	octeon_pci_write_core_mem(oct, BOOTLOADER_PCI_READ_BUFFER_DATA_ADDR,
382 	octeon_write_device_mem32(oct, BOOTLOADER_PCI_READ_BUFFER_LEN_ADDR,
384 	octeon_write_device_mem32(oct, BOOTLOADER_PCI_READ_BUFFER_OWNER_ADDR,
390 	if (octeon_wait_for_bootloader(oct, 200) != 0) {
392 		dev_err(&oct->pci_dev->dev, "Bootloader did not accept command.\n");
399 int octeon_wait_for_bootloader(struct octeon_device *oct,
402 	dev_dbg(&oct->pci_dev->dev, "waiting %d0 ms for bootloader\n",
405 	if (octeon_mem_access_ok(oct))
409 	       octeon_read_device_mem32(oct,
419 static void octeon_console_handle_result(struct octeon_device *oct,
424 	console = &oct->console[console_num];
431 static void output_console_line(struct octeon_device *oct,
456 					(*console->print)(oct, (u32)console_num,
462 					(*console->print)(oct, (u32)console_num,
484 	struct octeon_device *oct = (struct octeon_device *)wk->ctxptr;
488 	console = &oct->console[console_num];
497 			octeon_console_read(oct, console_num, console_buffer,
502 				octeon_console_handle_result(oct, console_num);
504 				output_console_line(oct, console, console_num,
508 			dev_err(&oct->pci_dev->dev, "Error reading console %u, ret=%d\n",
523 		output_console_line(oct, console, console_num,
533 int octeon_init_consoles(struct octeon_device *oct)
538 	ret = octeon_mem_access_ok(oct);
540 		dev_err(&oct->pci_dev->dev, "Memory access not okay'\n");
544 	ret = octeon_named_block_find(oct, OCTEON_PCI_CONSOLE_BLOCK_NAME, &addr,
547 		dev_err(&oct->pci_dev->dev, "Could not find console '%s'\n",
556 	oct->console_nb_info.bar1_index = BAR1_INDEX_STATIC_MAP;
557 	oct->fn_list.bar1_idx_setup(oct, addr, oct->console_nb_info.bar1_index,
559 	oct->console_nb_info.dram_region_base = addr
565 	oct->num_consoles = octeon_read_device_mem32(oct,
568 	oct->console_desc_addr = addr;
570 	dev_dbg(&oct->pci_dev->dev, "Initialized consoles. %d available\n",
571 		oct->num_consoles);
576 static void octeon_get_uboot_version(struct octeon_device *oct)
590 	if (octeon_console_send_cmd(oct, "setenv stdout pci\n", 50)) {
595 	if (octeon_console_send_cmd(oct, "version\n", 1)) {
600 	console = &oct->console[console_num];
609 			octeon_console_read(oct,
618 				octeon_console_handle_result(oct, console_num);
620 			dev_err(&oct->pci_dev->dev, "Error reading console %u, ret=%d\n",
631 		dev_dbg(&oct->pci_dev->dev, "%u: %s\n",
644 			dev_info(&oct->pci_dev->dev, "%s\n", uboot_ver);
649 	octeon_console_send_cmd(oct, "setenv stdout serial\n", 50);
652 int octeon_add_console(struct octeon_device *oct, u32 console_num,
661 	if (console_num >= oct->num_consoles) {
662 		dev_err(&oct->pci_dev->dev,
664 			console_num, oct->num_consoles);
666 		console = &oct->console[console_num];
670 		coreaddr = oct->console_desc_addr + console_num * 8 +
673 		console->addr = octeon_read_device_mem64(oct, coreaddr);
676 		console->buffer_size = octeon_read_device_mem32(oct, coreaddr);
680 			octeon_read_device_mem64(oct, coreaddr);
684 			octeon_read_device_mem64(oct, coreaddr);
687 		work = &oct->console_poll_work[console_num].work;
689 		octeon_get_uboot_version(oct);
692 		oct->console_poll_work[console_num].ctxptr = (void *)oct;
693 		oct->console_poll_work[console_num].ctxul = console_num;
701 			ret = octeon_console_send_cmd(oct, dbg_enb, 2000);
712  * @param oct         octeon device
714 void octeon_remove_consoles(struct octeon_device *oct)
719 	for (i = 0; i < oct->num_consoles; i++) {
720 		console = &oct->console[i];
725 		cancel_delayed_work_sync(&oct->console_poll_work[i].
733 	oct->num_consoles = 0;
757 static int octeon_console_read(struct octeon_device *oct, u32 console_num,
764 	if (console_num >= oct->num_consoles) {
765 		dev_err(&oct->pci_dev->dev, "Attempted to read from disabled console %d\n",
770 	console = &oct->console[console_num];
775 	rd_idx = octeon_read_device_mem32(oct, console->addr +
777 	wr_idx = octeon_read_device_mem32(oct, console->addr +
793 	octeon_pci_read_core_mem(oct, console->output_base_addr + rd_idx,
795 	octeon_write_device_mem32(oct, console->addr +
807 int octeon_download_firmware(struct octeon_device *oct, const u8 *data,
820 		dev_err(&oct->pci_dev->dev, "Firmware file too small (%d < %d).\n",
829 		dev_err(&oct->pci_dev->dev, "Unrecognized firmware file.\n");
837 		dev_err(&oct->pci_dev->dev, "Firmware CRC mismatch (0x%08x != 0x%08x).\n",
844 		dev_err(&oct->pci_dev->dev, "Unmatched firmware version. Expected %s.x, got %s.\n",
851 		dev_err(&oct->pci_dev->dev, "Too many images in firmware file (%d).\n",
856 	dev_info(&oct->pci_dev->dev, "Firmware version: %s\n", h->version);
857 	snprintf(oct->fw_info.liquidio_firmware_version, 32, "LIQUIDIO: %s",
862 	dev_info(&oct->pci_dev->dev, "%s: Loading %d images\n", __func__,
869 		dev_info(&oct->pci_dev->dev, "Loading firmware %d at %llx\n",
882 			octeon_pci_write_core_mem(oct, load_addr, data, (u32)size);
904 		dev_err(&oct->pci_dev->dev, "Boot command buffer too small\n");
910 	dev_info(&oct->pci_dev->dev, "Writing boot command: %s\n",
914 	ret = octeon_console_send_cmd(oct, h->bootcmd, 50);
916 		dev_info(&oct->pci_dev->dev, "Boot command send failed\n");