51 static u64 cvmx_bootmem_phy_named_block_find(struct octeon_device *oct,
168 #define CVMX_BOOTMEM_DESC_GET_FIELD(oct, field)                              \  argument
169 	__cvmx_bootmem_desc_get(oct, oct->bootmem_desc_addr,                 \
187 #define CVMX_BOOTMEM_NAMED_GET_FIELD(oct, addr, field)                   \  argument
188 	__cvmx_bootmem_desc_get(oct, addr,                               \
205 static inline u64 __cvmx_bootmem_desc_get(struct octeon_device *oct,  in __cvmx_bootmem_desc_get()  argument
213 		return octeon_read_device_mem32(oct, base);  in __cvmx_bootmem_desc_get()
215 		return octeon_read_device_mem64(oct, base);  in __cvmx_bootmem_desc_get()
231 static void CVMX_BOOTMEM_NAMED_GET_NAME(struct octeon_device *oct,  in CVMX_BOOTMEM_NAMED_GET_NAME()  argument
237 	octeon_pci_read_core_mem(oct, addr, str, len);  in CVMX_BOOTMEM_NAMED_GET_NAME()
253 static int __cvmx_bootmem_check_version(struct octeon_device *oct,  in __cvmx_bootmem_check_version()  argument
259 	if (!oct->bootmem_desc_addr)  in __cvmx_bootmem_check_version()
260 		oct->bootmem_desc_addr =  in __cvmx_bootmem_check_version()
261 			octeon_read_device_mem64(oct,  in __cvmx_bootmem_check_version()
264 		(u32)CVMX_BOOTMEM_DESC_GET_FIELD(oct, major_version);  in __cvmx_bootmem_check_version()
266 		(u32)CVMX_BOOTMEM_DESC_GET_FIELD(oct, minor_version);  in __cvmx_bootmem_check_version()
267 	dev_dbg(&oct->pci_dev->dev, "%s: major_version=%d\n", __func__,  in __cvmx_bootmem_check_version()
271 		dev_err(&oct->pci_dev->dev, "bootmem ver mismatch %d.%d addr:0x%llx\n",  in __cvmx_bootmem_check_version()
273 			CAST_ULL(oct->bootmem_desc_addr));  in __cvmx_bootmem_check_version()
281 *__cvmx_bootmem_find_named_block_flags(struct octeon_device *oct,  in __cvmx_bootmem_find_named_block_flags()  argument
285 		&oct->bootmem_named_block_desc;  in __cvmx_bootmem_find_named_block_flags()
286 	u64 named_addr = cvmx_bootmem_phy_named_block_find(oct, name, flags);  in __cvmx_bootmem_find_named_block_flags()
289 		desc->base_addr = CVMX_BOOTMEM_NAMED_GET_FIELD(oct, named_addr,  in __cvmx_bootmem_find_named_block_flags()
292 			CVMX_BOOTMEM_NAMED_GET_FIELD(oct, named_addr, size);  in __cvmx_bootmem_find_named_block_flags()
295 		return &oct->bootmem_named_block_desc;  in __cvmx_bootmem_find_named_block_flags()
301 static u64 cvmx_bootmem_phy_named_block_find(struct octeon_device *oct,  in cvmx_bootmem_phy_named_block_find()  argument
308 	if (!__cvmx_bootmem_check_version(oct, 3)) {  in cvmx_bootmem_phy_named_block_find()
311 			CVMX_BOOTMEM_DESC_GET_FIELD(oct,  in cvmx_bootmem_phy_named_block_find()
314 			CVMX_BOOTMEM_DESC_GET_FIELD(oct, nb_num_blocks);  in cvmx_bootmem_phy_named_block_find()
316 			CVMX_BOOTMEM_DESC_GET_FIELD(oct, named_block_name_len);  in cvmx_bootmem_phy_named_block_find()
321 				CVMX_BOOTMEM_NAMED_GET_FIELD(oct, named_addr,  in cvmx_bootmem_phy_named_block_find()
326 				CVMX_BOOTMEM_NAMED_GET_NAME(oct, named_addr,  in cvmx_bootmem_phy_named_block_find()
357 static int octeon_named_block_find(struct octeon_device *oct, const char *name,  in octeon_named_block_find()  argument
363 	named_block = __cvmx_bootmem_find_named_block_flags(oct, name, 0);  in octeon_named_block_find()
383 int octeon_console_send_cmd(struct octeon_device *oct, char *cmd_str,  in octeon_console_send_cmd()  argument
388 	dev_dbg(&oct->pci_dev->dev, "sending \"%s\" to bootloader\n", cmd_str);  in octeon_console_send_cmd()
391 		dev_err(&oct->pci_dev->dev, "Command string too long, max length is: %d\n",  in octeon_console_send_cmd()
396 	if (octeon_wait_for_bootloader(oct, wait_hundredths) != 0) {  in octeon_console_send_cmd()
397 		dev_err(&oct->pci_dev->dev, "Bootloader not ready for command.\n");  in octeon_console_send_cmd()
403 	octeon_pci_write_core_mem(oct, BOOTLOADER_PCI_READ_BUFFER_DATA_ADDR,  in octeon_console_send_cmd()
405 	octeon_write_device_mem32(oct, BOOTLOADER_PCI_READ_BUFFER_LEN_ADDR,  in octeon_console_send_cmd()
407 	octeon_write_device_mem32(oct, BOOTLOADER_PCI_READ_BUFFER_OWNER_ADDR,  in octeon_console_send_cmd()
413 	if (octeon_wait_for_bootloader(oct, 200) != 0) {  in octeon_console_send_cmd()
415 		dev_err(&oct->pci_dev->dev, "Bootloader did not accept command.\n");  in octeon_console_send_cmd()
422 int octeon_wait_for_bootloader(struct octeon_device *oct,  in octeon_wait_for_bootloader()  argument
425 	dev_dbg(&oct->pci_dev->dev, "waiting %d0 ms for bootloader\n",  in octeon_wait_for_bootloader()
428 	if (octeon_mem_access_ok(oct))  in octeon_wait_for_bootloader()
432 	       octeon_read_device_mem32(oct,  in octeon_wait_for_bootloader()
442 static void octeon_console_handle_result(struct octeon_device *oct,  in octeon_console_handle_result()  argument
448 	console = &oct->console[console_num];  in octeon_console_handle_result()
455 static void output_console_line(struct octeon_device *oct,  in output_console_line()  argument
470 				dev_info(&oct->pci_dev->dev, "%lu: %s%s\n",  in output_console_line()
475 				dev_info(&oct->pci_dev->dev, "%lu: %s\n",  in output_console_line()
494 	struct octeon_device *oct = (struct octeon_device *)wk->ctxptr;  in check_console()  local
498 	console = &oct->console[console_num];  in check_console()
507 			octeon_console_read(oct, console_num, console_buffer,  in check_console()
512 				octeon_console_handle_result(oct, console_num,  in check_console()
517 				output_console_line(oct, console, console_num,  in check_console()
521 			dev_err(&oct->pci_dev->dev, "Error reading console %lu, ret=%d\n",  in check_console()
533 		dev_info(&oct->pci_dev->dev, "%lu: %s\n",  in check_console()
543 int octeon_init_consoles(struct octeon_device *oct)  in octeon_init_consoles()  argument
548 	ret = octeon_mem_access_ok(oct);  in octeon_init_consoles()
550 		dev_err(&oct->pci_dev->dev, "Memory access not okay'\n");  in octeon_init_consoles()
554 	ret = octeon_named_block_find(oct, OCTEON_PCI_CONSOLE_BLOCK_NAME, &addr,  in octeon_init_consoles()
557 		dev_err(&oct->pci_dev->dev, "Could not find console '%s'\n",  in octeon_init_consoles()
565 	oct->num_consoles = octeon_read_device_mem32(oct,  in octeon_init_consoles()
568 	oct->console_desc_addr = addr;  in octeon_init_consoles()
570 	dev_dbg(&oct->pci_dev->dev, "Initialized consoles. %d available\n",  in octeon_init_consoles()
571 		oct->num_consoles);  in octeon_init_consoles()
576 int octeon_add_console(struct octeon_device *oct, u32 console_num)  in octeon_add_console()  argument
584 	if (console_num >= oct->num_consoles) {  in octeon_add_console()
585 		dev_err(&oct->pci_dev->dev,  in octeon_add_console()
587 			console_num, oct->num_consoles);  in octeon_add_console()
589 		console = &oct->console[console_num];  in octeon_add_console()
593 		coreaddr = oct->console_desc_addr + console_num * 8 +  in octeon_add_console()
596 		console->addr = octeon_read_device_mem64(oct, coreaddr);  in octeon_add_console()
599 		console->buffer_size = octeon_read_device_mem32(oct, coreaddr);  in octeon_add_console()
603 			octeon_read_device_mem64(oct, coreaddr);  in octeon_add_console()
607 			octeon_read_device_mem64(oct, coreaddr);  in octeon_add_console()
610 		work = &oct->console_poll_work[console_num].work;  in octeon_add_console()
613 		oct->console_poll_work[console_num].ctxptr = (void *)oct;  in octeon_add_console()
614 		oct->console_poll_work[console_num].ctxul = console_num;  in octeon_add_console()
619 			ret = octeon_console_send_cmd(oct,  in octeon_add_console()
635 void octeon_remove_consoles(struct octeon_device *oct)  in octeon_remove_consoles()  argument
640 	for (i = 0; i < oct->num_consoles; i++) {  in octeon_remove_consoles()
641 		console = &oct->console[i];  in octeon_remove_consoles()
646 		cancel_delayed_work_sync(&oct->console_poll_work[i].  in octeon_remove_consoles()
654 	oct->num_consoles = 0;  in octeon_remove_consoles()
678 int octeon_console_read(struct octeon_device *oct, u32 console_num,  in octeon_console_read()  argument
685 	if (console_num >= oct->num_consoles) {  in octeon_console_read()
686 		dev_err(&oct->pci_dev->dev, "Attempted to read from disabled console %d\n",  in octeon_console_read()
691 	console = &oct->console[console_num];  in octeon_console_read()
696 	rd_idx = octeon_read_device_mem32(oct, console->addr +  in octeon_console_read()
698 	wr_idx = octeon_read_device_mem32(oct, console->addr +  in octeon_console_read()
714 	octeon_pci_read_core_mem(oct, console->output_base_addr + rd_idx,  in octeon_console_read()
716 	octeon_write_device_mem32(oct, console->addr +  in octeon_console_read()