23 static void falcon_writel(struct falcon *falcon, u32 value, u32 offset)  in falcon_writel()  argument
25 	writel(value, falcon->regs + offset);  in falcon_writel()
28 int falcon_wait_idle(struct falcon *falcon)  in falcon_wait_idle()  argument
32 	return readl_poll_timeout(falcon->regs + FALCON_IDLESTATE, value,  in falcon_wait_idle()
36 static int falcon_dma_wait_idle(struct falcon *falcon)  in falcon_dma_wait_idle()  argument
40 	return readl_poll_timeout(falcon->regs + FALCON_DMATRFCMD, value,  in falcon_dma_wait_idle()
44 static int falcon_copy_chunk(struct falcon *falcon,  in falcon_copy_chunk()  argument
54 	falcon_writel(falcon, offset, FALCON_DMATRFMOFFS);  in falcon_copy_chunk()
55 	falcon_writel(falcon, base, FALCON_DMATRFFBOFFS);  in falcon_copy_chunk()
56 	falcon_writel(falcon, cmd, FALCON_DMATRFCMD);  in falcon_copy_chunk()
58 	return falcon_dma_wait_idle(falcon);  in falcon_copy_chunk()
61 static void falcon_copy_firmware_image(struct falcon *falcon,  in falcon_copy_firmware_image()  argument
64 	u32 *firmware_vaddr = falcon->firmware.vaddr;  in falcon_copy_firmware_image()
74 	daddr = dma_map_single(falcon->dev, firmware_vaddr,  in falcon_copy_firmware_image()
75 			       falcon->firmware.size, DMA_TO_DEVICE);  in falcon_copy_firmware_image()
76 	err = dma_mapping_error(falcon->dev, daddr);  in falcon_copy_firmware_image()
78 		dev_err(falcon->dev, "failed to map firmware: %d\n", err);  in falcon_copy_firmware_image()
81 	dma_sync_single_for_device(falcon->dev, daddr,  in falcon_copy_firmware_image()
82 				   falcon->firmware.size, DMA_TO_DEVICE);  in falcon_copy_firmware_image()
83 	dma_unmap_single(falcon->dev, daddr, falcon->firmware.size,  in falcon_copy_firmware_image()
87 static int falcon_parse_firmware_image(struct falcon *falcon)  in falcon_parse_firmware_image()  argument
89 	struct falcon_fw_bin_header_v1 *bin = (void *)falcon->firmware.vaddr;  in falcon_parse_firmware_image()
94 		dev_err(falcon->dev, "incorrect firmware magic\n");  in falcon_parse_firmware_image()
100 		dev_err(falcon->dev, "unsupported firmware version\n");  in falcon_parse_firmware_image()
105 	if (bin->size > falcon->firmware.size) {  in falcon_parse_firmware_image()
106 		dev_err(falcon->dev, "firmware image size inconsistency\n");  in falcon_parse_firmware_image()
110 	os = falcon->firmware.vaddr + bin->os_header_offset;  in falcon_parse_firmware_image()
112 	falcon->firmware.bin_data.size = bin->os_size;  in falcon_parse_firmware_image()
113 	falcon->firmware.bin_data.offset = bin->os_data_offset;  in falcon_parse_firmware_image()
114 	falcon->firmware.code.offset = os->code_offset;  in falcon_parse_firmware_image()
115 	falcon->firmware.code.size = os->code_size;  in falcon_parse_firmware_image()
116 	falcon->firmware.data.offset = os->data_offset;  in falcon_parse_firmware_image()
117 	falcon->firmware.data.size = os->data_size;  in falcon_parse_firmware_image()
122 int falcon_read_firmware(struct falcon *falcon, const char *name)  in falcon_read_firmware()  argument
127 	err = request_firmware(&falcon->firmware.firmware, name, falcon->dev);  in falcon_read_firmware()
134 int falcon_load_firmware(struct falcon *falcon)  in falcon_load_firmware()  argument
136 	const struct firmware *firmware = falcon->firmware.firmware;  in falcon_load_firmware()
139 	falcon->firmware.size = firmware->size;  in falcon_load_firmware()
142 	falcon->firmware.vaddr = falcon->ops->alloc(falcon, firmware->size,  in falcon_load_firmware()
143 						    &falcon->firmware.paddr);  in falcon_load_firmware()
144 	if (!falcon->firmware.vaddr) {  in falcon_load_firmware()
145 		dev_err(falcon->dev, "dma memory mapping failed\n");  in falcon_load_firmware()
150 	falcon_copy_firmware_image(falcon, firmware);  in falcon_load_firmware()
153 	err = falcon_parse_firmware_image(falcon);  in falcon_load_firmware()
155 		dev_err(falcon->dev, "failed to parse firmware image\n");  in falcon_load_firmware()
160 	falcon->firmware.firmware = NULL;  in falcon_load_firmware()
165 	falcon->ops->free(falcon, falcon->firmware.size,  in falcon_load_firmware()
166 			  falcon->firmware.paddr, falcon->firmware.vaddr);  in falcon_load_firmware()
171 int falcon_init(struct falcon *falcon)  in falcon_init()  argument
174 	if (!falcon->ops || !falcon->ops->alloc || !falcon->ops->free)  in falcon_init()
177 	falcon->firmware.vaddr = NULL;  in falcon_init()
182 void falcon_exit(struct falcon *falcon)  in falcon_exit()  argument
184 	if (falcon->firmware.firmware) {  in falcon_exit()
185 		release_firmware(falcon->firmware.firmware);  in falcon_exit()
186 		falcon->firmware.firmware = NULL;  in falcon_exit()
189 	if (falcon->firmware.vaddr) {  in falcon_exit()
190 		falcon->ops->free(falcon, falcon->firmware.size,  in falcon_exit()
191 				  falcon->firmware.paddr,  in falcon_exit()
192 				  falcon->firmware.vaddr);  in falcon_exit()
193 		falcon->firmware.vaddr = NULL;  in falcon_exit()
197 int falcon_boot(struct falcon *falcon)  in falcon_boot()  argument
202 	if (!falcon->firmware.vaddr)  in falcon_boot()
205 	falcon_writel(falcon, 0, FALCON_DMACTL);  in falcon_boot()
208 	falcon_writel(falcon, (falcon->firmware.paddr +  in falcon_boot()
209 			       falcon->firmware.bin_data.offset) >> 8,  in falcon_boot()
213 	for (offset = 0; offset < falcon->firmware.data.size; offset += 256)  in falcon_boot()
214 		falcon_copy_chunk(falcon,  in falcon_boot()
215 				  falcon->firmware.data.offset + offset,  in falcon_boot()
219 	falcon_copy_chunk(falcon, falcon->firmware.code.offset,  in falcon_boot()
223 	falcon_writel(falcon, FALCON_IRQMSET_EXT(0xff) |  in falcon_boot()
230 	falcon_writel(falcon, FALCON_IRQDEST_EXT(0xff) |  in falcon_boot()
238 	falcon_writel(falcon, FALCON_ITFEN_MTHDEN |  in falcon_boot()
243 	falcon_writel(falcon, 0x00000000, FALCON_BOOTVEC);  in falcon_boot()
244 	falcon_writel(falcon, FALCON_CPUCTL_STARTCPU, FALCON_CPUCTL);  in falcon_boot()
246 	err = falcon_wait_idle(falcon);  in falcon_boot()
248 		dev_err(falcon->dev, "Falcon boot failed due to timeout\n");  in falcon_boot()
255 void falcon_execute_method(struct falcon *falcon, u32 method, u32 data)  in falcon_execute_method()  argument
257 	falcon_writel(falcon, method >> 2, FALCON_UCLASS_METHOD_OFFSET);  in falcon_execute_method()
258 	falcon_writel(falcon, data, FALCON_UCLASS_METHOD_DATA);  in falcon_execute_method()