Linux Audio

Check our new training course

Loading...
Note: File does not exist in v5.4.
  1/*
  2 * This file is part of wl1271
  3 *
  4 * Copyright (C) 2008-2010 Nokia Corporation
  5 *
  6 * Contact: Luciano Coelho <luciano.coelho@nokia.com>
  7 *
  8 * This program is free software; you can redistribute it and/or
  9 * modify it under the terms of the GNU General Public License
 10 * version 2 as published by the Free Software Foundation.
 11 *
 12 * This program is distributed in the hope that it will be useful, but
 13 * WITHOUT ANY WARRANTY; without even the implied warranty of
 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 15 * General Public License for more details.
 16 *
 17 * You should have received a copy of the GNU General Public License
 18 * along with this program; if not, write to the Free Software
 19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 20 * 02110-1301 USA
 21 *
 22 */
 23
 24#include <linux/slab.h>
 25#include <linux/wl12xx.h>
 26
 27#include "acx.h"
 28#include "reg.h"
 29#include "boot.h"
 30#include "io.h"
 31#include "event.h"
 32#include "rx.h"
 33
 34static struct wl1271_partition_set part_table[PART_TABLE_LEN] = {
 35	[PART_DOWN] = {
 36		.mem = {
 37			.start = 0x00000000,
 38			.size  = 0x000177c0
 39		},
 40		.reg = {
 41			.start = REGISTERS_BASE,
 42			.size  = 0x00008800
 43		},
 44		.mem2 = {
 45			.start = 0x00000000,
 46			.size  = 0x00000000
 47		},
 48		.mem3 = {
 49			.start = 0x00000000,
 50			.size  = 0x00000000
 51		},
 52	},
 53
 54	[PART_WORK] = {
 55		.mem = {
 56			.start = 0x00040000,
 57			.size  = 0x00014fc0
 58		},
 59		.reg = {
 60			.start = REGISTERS_BASE,
 61			.size  = 0x0000a000
 62		},
 63		.mem2 = {
 64			.start = 0x003004f8,
 65			.size  = 0x00000004
 66		},
 67		.mem3 = {
 68			.start = 0x00040404,
 69			.size  = 0x00000000
 70		},
 71	},
 72
 73	[PART_DRPW] = {
 74		.mem = {
 75			.start = 0x00040000,
 76			.size  = 0x00014fc0
 77		},
 78		.reg = {
 79			.start = DRPW_BASE,
 80			.size  = 0x00006000
 81		},
 82		.mem2 = {
 83			.start = 0x00000000,
 84			.size  = 0x00000000
 85		},
 86		.mem3 = {
 87			.start = 0x00000000,
 88			.size  = 0x00000000
 89		}
 90	}
 91};
 92
 93static void wl1271_boot_set_ecpu_ctrl(struct wl1271 *wl, u32 flag)
 94{
 95	u32 cpu_ctrl;
 96
 97	/* 10.5.0 run the firmware (I) */
 98	cpu_ctrl = wl1271_read32(wl, ACX_REG_ECPU_CONTROL);
 99
100	/* 10.5.1 run the firmware (II) */
101	cpu_ctrl |= flag;
102	wl1271_write32(wl, ACX_REG_ECPU_CONTROL, cpu_ctrl);
103}
104
105static unsigned int wl12xx_get_fw_ver_quirks(struct wl1271 *wl)
106{
107	unsigned int quirks = 0;
108	unsigned int *fw_ver = wl->chip.fw_ver;
109
110	/* Only for wl127x */
111	if ((fw_ver[FW_VER_CHIP] == FW_VER_CHIP_WL127X) &&
112	    /* Check STA version */
113	    (((fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_STA) &&
114	      (fw_ver[FW_VER_MINOR] < FW_VER_MINOR_1_SPARE_STA_MIN)) ||
115	     /* Check AP version */
116	     ((fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_AP) &&
117	      (fw_ver[FW_VER_MINOR] < FW_VER_MINOR_1_SPARE_AP_MIN))))
118		quirks |= WL12XX_QUIRK_USE_2_SPARE_BLOCKS;
119
120	/* Only new station firmwares support routing fw logs to the host */
121	if ((fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_STA) &&
122	    (fw_ver[FW_VER_MINOR] < FW_VER_MINOR_FWLOG_STA_MIN))
123		quirks |= WL12XX_QUIRK_FWLOG_NOT_IMPLEMENTED;
124
125	/* This feature is not yet supported for AP mode */
126	if (fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_AP)
127		quirks |= WL12XX_QUIRK_FWLOG_NOT_IMPLEMENTED;
128
129	return quirks;
130}
131
132static void wl1271_parse_fw_ver(struct wl1271 *wl)
133{
134	int ret;
135
136	ret = sscanf(wl->chip.fw_ver_str + 4, "%u.%u.%u.%u.%u",
137		     &wl->chip.fw_ver[0], &wl->chip.fw_ver[1],
138		     &wl->chip.fw_ver[2], &wl->chip.fw_ver[3],
139		     &wl->chip.fw_ver[4]);
140
141	if (ret != 5) {
142		wl1271_warning("fw version incorrect value");
143		memset(wl->chip.fw_ver, 0, sizeof(wl->chip.fw_ver));
144		return;
145	}
146
147	/* Check if any quirks are needed with older fw versions */
148	wl->quirks |= wl12xx_get_fw_ver_quirks(wl);
149}
150
151static void wl1271_boot_fw_version(struct wl1271 *wl)
152{
153	struct wl1271_static_data static_data;
154
155	wl1271_read(wl, wl->cmd_box_addr, &static_data, sizeof(static_data),
156		    false);
157
158	strncpy(wl->chip.fw_ver_str, static_data.fw_version,
159		sizeof(wl->chip.fw_ver_str));
160
161	/* make sure the string is NULL-terminated */
162	wl->chip.fw_ver_str[sizeof(wl->chip.fw_ver_str) - 1] = '\0';
163
164	wl1271_parse_fw_ver(wl);
165}
166
167static int wl1271_boot_upload_firmware_chunk(struct wl1271 *wl, void *buf,
168					     size_t fw_data_len, u32 dest)
169{
170	struct wl1271_partition_set partition;
171	int addr, chunk_num, partition_limit;
172	u8 *p, *chunk;
173
174	/* whal_FwCtrl_LoadFwImageSm() */
175
176	wl1271_debug(DEBUG_BOOT, "starting firmware upload");
177
178	wl1271_debug(DEBUG_BOOT, "fw_data_len %zd chunk_size %d",
179		     fw_data_len, CHUNK_SIZE);
180
181	if ((fw_data_len % 4) != 0) {
182		wl1271_error("firmware length not multiple of four");
183		return -EIO;
184	}
185
186	chunk = kmalloc(CHUNK_SIZE, GFP_KERNEL);
187	if (!chunk) {
188		wl1271_error("allocation for firmware upload chunk failed");
189		return -ENOMEM;
190	}
191
192	memcpy(&partition, &part_table[PART_DOWN], sizeof(partition));
193	partition.mem.start = dest;
194	wl1271_set_partition(wl, &partition);
195
196	/* 10.1 set partition limit and chunk num */
197	chunk_num = 0;
198	partition_limit = part_table[PART_DOWN].mem.size;
199
200	while (chunk_num < fw_data_len / CHUNK_SIZE) {
201		/* 10.2 update partition, if needed */
202		addr = dest + (chunk_num + 2) * CHUNK_SIZE;
203		if (addr > partition_limit) {
204			addr = dest + chunk_num * CHUNK_SIZE;
205			partition_limit = chunk_num * CHUNK_SIZE +
206				part_table[PART_DOWN].mem.size;
207			partition.mem.start = addr;
208			wl1271_set_partition(wl, &partition);
209		}
210
211		/* 10.3 upload the chunk */
212		addr = dest + chunk_num * CHUNK_SIZE;
213		p = buf + chunk_num * CHUNK_SIZE;
214		memcpy(chunk, p, CHUNK_SIZE);
215		wl1271_debug(DEBUG_BOOT, "uploading fw chunk 0x%p to 0x%x",
216			     p, addr);
217		wl1271_write(wl, addr, chunk, CHUNK_SIZE, false);
218
219		chunk_num++;
220	}
221
222	/* 10.4 upload the last chunk */
223	addr = dest + chunk_num * CHUNK_SIZE;
224	p = buf + chunk_num * CHUNK_SIZE;
225	memcpy(chunk, p, fw_data_len % CHUNK_SIZE);
226	wl1271_debug(DEBUG_BOOT, "uploading fw last chunk (%zd B) 0x%p to 0x%x",
227		     fw_data_len % CHUNK_SIZE, p, addr);
228	wl1271_write(wl, addr, chunk, fw_data_len % CHUNK_SIZE, false);
229
230	kfree(chunk);
231	return 0;
232}
233
234static int wl1271_boot_upload_firmware(struct wl1271 *wl)
235{
236	u32 chunks, addr, len;
237	int ret = 0;
238	u8 *fw;
239
240	fw = wl->fw;
241	chunks = be32_to_cpup((__be32 *) fw);
242	fw += sizeof(u32);
243
244	wl1271_debug(DEBUG_BOOT, "firmware chunks to be uploaded: %u", chunks);
245
246	while (chunks--) {
247		addr = be32_to_cpup((__be32 *) fw);
248		fw += sizeof(u32);
249		len = be32_to_cpup((__be32 *) fw);
250		fw += sizeof(u32);
251
252		if (len > 300000) {
253			wl1271_info("firmware chunk too long: %u", len);
254			return -EINVAL;
255		}
256		wl1271_debug(DEBUG_BOOT, "chunk %d addr 0x%x len %u",
257			     chunks, addr, len);
258		ret = wl1271_boot_upload_firmware_chunk(wl, fw, len, addr);
259		if (ret != 0)
260			break;
261		fw += len;
262	}
263
264	return ret;
265}
266
267static int wl1271_boot_upload_nvs(struct wl1271 *wl)
268{
269	size_t nvs_len, burst_len;
270	int i;
271	u32 dest_addr, val;
272	u8 *nvs_ptr, *nvs_aligned;
273
274	if (wl->nvs == NULL)
275		return -ENODEV;
276
277	if (wl->chip.id == CHIP_ID_1283_PG20) {
278		struct wl128x_nvs_file *nvs = (struct wl128x_nvs_file *)wl->nvs;
279
280		if (wl->nvs_len == sizeof(struct wl128x_nvs_file)) {
281			if (nvs->general_params.dual_mode_select)
282				wl->enable_11a = true;
283		} else {
284			wl1271_error("nvs size is not as expected: %zu != %zu",
285				     wl->nvs_len,
286				     sizeof(struct wl128x_nvs_file));
287			kfree(wl->nvs);
288			wl->nvs = NULL;
289			wl->nvs_len = 0;
290			return -EILSEQ;
291		}
292
293		/* only the first part of the NVS needs to be uploaded */
294		nvs_len = sizeof(nvs->nvs);
295		nvs_ptr = (u8 *)nvs->nvs;
296
297	} else {
298		struct wl1271_nvs_file *nvs =
299			(struct wl1271_nvs_file *)wl->nvs;
300		/*
301		 * FIXME: the LEGACY NVS image support (NVS's missing the 5GHz
302		 * band configurations) can be removed when those NVS files stop
303		 * floating around.
304		 */
305		if (wl->nvs_len == sizeof(struct wl1271_nvs_file) ||
306		    wl->nvs_len == WL1271_INI_LEGACY_NVS_FILE_SIZE) {
307			/* for now 11a is unsupported in AP mode */
308			if (wl->bss_type != BSS_TYPE_AP_BSS &&
309			    nvs->general_params.dual_mode_select)
310				wl->enable_11a = true;
311		}
312
313		if (wl->nvs_len != sizeof(struct wl1271_nvs_file) &&
314		    (wl->nvs_len != WL1271_INI_LEGACY_NVS_FILE_SIZE ||
315		     wl->enable_11a)) {
316			wl1271_error("nvs size is not as expected: %zu != %zu",
317				wl->nvs_len, sizeof(struct wl1271_nvs_file));
318			kfree(wl->nvs);
319			wl->nvs = NULL;
320			wl->nvs_len = 0;
321			return -EILSEQ;
322		}
323
324		/* only the first part of the NVS needs to be uploaded */
325		nvs_len = sizeof(nvs->nvs);
326		nvs_ptr = (u8 *) nvs->nvs;
327	}
328
329	/* update current MAC address to NVS */
330	nvs_ptr[11] = wl->mac_addr[0];
331	nvs_ptr[10] = wl->mac_addr[1];
332	nvs_ptr[6] = wl->mac_addr[2];
333	nvs_ptr[5] = wl->mac_addr[3];
334	nvs_ptr[4] = wl->mac_addr[4];
335	nvs_ptr[3] = wl->mac_addr[5];
336
337	/*
338	 * Layout before the actual NVS tables:
339	 * 1 byte : burst length.
340	 * 2 bytes: destination address.
341	 * n bytes: data to burst copy.
342	 *
343	 * This is ended by a 0 length, then the NVS tables.
344	 */
345
346	/* FIXME: Do we need to check here whether the LSB is 1? */
347	while (nvs_ptr[0]) {
348		burst_len = nvs_ptr[0];
349		dest_addr = (nvs_ptr[1] & 0xfe) | ((u32)(nvs_ptr[2] << 8));
350
351		/*
352		 * Due to our new wl1271_translate_reg_addr function,
353		 * we need to add the REGISTER_BASE to the destination
354		 */
355		dest_addr += REGISTERS_BASE;
356
357		/* We move our pointer to the data */
358		nvs_ptr += 3;
359
360		for (i = 0; i < burst_len; i++) {
361			val = (nvs_ptr[0] | (nvs_ptr[1] << 8)
362			       | (nvs_ptr[2] << 16) | (nvs_ptr[3] << 24));
363
364			wl1271_debug(DEBUG_BOOT,
365				     "nvs burst write 0x%x: 0x%x",
366				     dest_addr, val);
367			wl1271_write32(wl, dest_addr, val);
368
369			nvs_ptr += 4;
370			dest_addr += 4;
371		}
372	}
373
374	/*
375	 * We've reached the first zero length, the first NVS table
376	 * is located at an aligned offset which is at least 7 bytes further.
377	 * NOTE: The wl->nvs->nvs element must be first, in order to
378	 * simplify the casting, we assume it is at the beginning of
379	 * the wl->nvs structure.
380	 */
381	nvs_ptr = (u8 *)wl->nvs +
382			ALIGN(nvs_ptr - (u8 *)wl->nvs + 7, 4);
383	nvs_len -= nvs_ptr - (u8 *)wl->nvs;
384
385	/* Now we must set the partition correctly */
386	wl1271_set_partition(wl, &part_table[PART_WORK]);
387
388	/* Copy the NVS tables to a new block to ensure alignment */
389	nvs_aligned = kmemdup(nvs_ptr, nvs_len, GFP_KERNEL);
390	if (!nvs_aligned)
391		return -ENOMEM;
392
393	/* And finally we upload the NVS tables */
394	wl1271_write(wl, CMD_MBOX_ADDRESS, nvs_aligned, nvs_len, false);
395
396	kfree(nvs_aligned);
397	return 0;
398}
399
400static void wl1271_boot_enable_interrupts(struct wl1271 *wl)
401{
402	wl1271_enable_interrupts(wl);
403	wl1271_write32(wl, ACX_REG_INTERRUPT_MASK,
404		       WL1271_ACX_INTR_ALL & ~(WL1271_INTR_MASK));
405	wl1271_write32(wl, HI_CFG, HI_CFG_DEF_VAL);
406}
407
408static int wl1271_boot_soft_reset(struct wl1271 *wl)
409{
410	unsigned long timeout;
411	u32 boot_data;
412
413	/* perform soft reset */
414	wl1271_write32(wl, ACX_REG_SLV_SOFT_RESET, ACX_SLV_SOFT_RESET_BIT);
415
416	/* SOFT_RESET is self clearing */
417	timeout = jiffies + usecs_to_jiffies(SOFT_RESET_MAX_TIME);
418	while (1) {
419		boot_data = wl1271_read32(wl, ACX_REG_SLV_SOFT_RESET);
420		wl1271_debug(DEBUG_BOOT, "soft reset bootdata 0x%x", boot_data);
421		if ((boot_data & ACX_SLV_SOFT_RESET_BIT) == 0)
422			break;
423
424		if (time_after(jiffies, timeout)) {
425			/* 1.2 check pWhalBus->uSelfClearTime if the
426			 * timeout was reached */
427			wl1271_error("soft reset timeout");
428			return -1;
429		}
430
431		udelay(SOFT_RESET_STALL_TIME);
432	}
433
434	/* disable Rx/Tx */
435	wl1271_write32(wl, ENABLE, 0x0);
436
437	/* disable auto calibration on start*/
438	wl1271_write32(wl, SPARE_A2, 0xffff);
439
440	return 0;
441}
442
443static int wl1271_boot_run_firmware(struct wl1271 *wl)
444{
445	int loop, ret;
446	u32 chip_id, intr;
447
448	wl1271_boot_set_ecpu_ctrl(wl, ECPU_CONTROL_HALT);
449
450	chip_id = wl1271_read32(wl, CHIP_ID_B);
451
452	wl1271_debug(DEBUG_BOOT, "chip id after firmware boot: 0x%x", chip_id);
453
454	if (chip_id != wl->chip.id) {
455		wl1271_error("chip id doesn't match after firmware boot");
456		return -EIO;
457	}
458
459	/* wait for init to complete */
460	loop = 0;
461	while (loop++ < INIT_LOOP) {
462		udelay(INIT_LOOP_DELAY);
463		intr = wl1271_read32(wl, ACX_REG_INTERRUPT_NO_CLEAR);
464
465		if (intr == 0xffffffff) {
466			wl1271_error("error reading hardware complete "
467				     "init indication");
468			return -EIO;
469		}
470		/* check that ACX_INTR_INIT_COMPLETE is enabled */
471		else if (intr & WL1271_ACX_INTR_INIT_COMPLETE) {
472			wl1271_write32(wl, ACX_REG_INTERRUPT_ACK,
473				       WL1271_ACX_INTR_INIT_COMPLETE);
474			break;
475		}
476	}
477
478	if (loop > INIT_LOOP) {
479		wl1271_error("timeout waiting for the hardware to "
480			     "complete initialization");
481		return -EIO;
482	}
483
484	/* get hardware config command mail box */
485	wl->cmd_box_addr = wl1271_read32(wl, REG_COMMAND_MAILBOX_PTR);
486
487	/* get hardware config event mail box */
488	wl->event_box_addr = wl1271_read32(wl, REG_EVENT_MAILBOX_PTR);
489
490	/* set the working partition to its "running" mode offset */
491	wl1271_set_partition(wl, &part_table[PART_WORK]);
492
493	wl1271_debug(DEBUG_MAILBOX, "cmd_box_addr 0x%x event_box_addr 0x%x",
494		     wl->cmd_box_addr, wl->event_box_addr);
495
496	wl1271_boot_fw_version(wl);
497
498	/*
499	 * in case of full asynchronous mode the firmware event must be
500	 * ready to receive event from the command mailbox
501	 */
502
503	/* unmask required mbox events  */
504	wl->event_mask = BSS_LOSE_EVENT_ID |
505		SCAN_COMPLETE_EVENT_ID |
506		PS_REPORT_EVENT_ID |
507		JOIN_EVENT_COMPLETE_ID |
508		DISCONNECT_EVENT_COMPLETE_ID |
509		RSSI_SNR_TRIGGER_0_EVENT_ID |
510		PSPOLL_DELIVERY_FAILURE_EVENT_ID |
511		SOFT_GEMINI_SENSE_EVENT_ID |
512		PERIODIC_SCAN_REPORT_EVENT_ID |
513		PERIODIC_SCAN_COMPLETE_EVENT_ID;
514
515	if (wl->bss_type == BSS_TYPE_AP_BSS)
516		wl->event_mask |= STA_REMOVE_COMPLETE_EVENT_ID |
517				  INACTIVE_STA_EVENT_ID |
518				  MAX_TX_RETRY_EVENT_ID;
519	else
520		wl->event_mask |= DUMMY_PACKET_EVENT_ID |
521			BA_SESSION_RX_CONSTRAINT_EVENT_ID;
522
523	ret = wl1271_event_unmask(wl);
524	if (ret < 0) {
525		wl1271_error("EVENT mask setting failed");
526		return ret;
527	}
528
529	wl1271_event_mbox_config(wl);
530
531	/* firmware startup completed */
532	return 0;
533}
534
535static int wl1271_boot_write_irq_polarity(struct wl1271 *wl)
536{
537	u32 polarity;
538
539	polarity = wl1271_top_reg_read(wl, OCP_REG_POLARITY);
540
541	/* We use HIGH polarity, so unset the LOW bit */
542	polarity &= ~POLARITY_LOW;
543	wl1271_top_reg_write(wl, OCP_REG_POLARITY, polarity);
544
545	return 0;
546}
547
548static void wl1271_boot_hw_version(struct wl1271 *wl)
549{
550	u32 fuse;
551
552	fuse = wl1271_top_reg_read(wl, REG_FUSE_DATA_2_1);
553	fuse = (fuse & PG_VER_MASK) >> PG_VER_OFFSET;
554
555	wl->hw_pg_ver = (s8)fuse;
556
557	if (((wl->hw_pg_ver & PG_MAJOR_VER_MASK) >> PG_MAJOR_VER_OFFSET) < 3)
558		wl->quirks |= WL12XX_QUIRK_END_OF_TRANSACTION;
559}
560
561static int wl128x_switch_tcxo_to_fref(struct wl1271 *wl)
562{
563	u16 spare_reg;
564
565	/* Mask bits [2] & [8:4] in the sys_clk_cfg register */
566	spare_reg = wl1271_top_reg_read(wl, WL_SPARE_REG);
567	if (spare_reg == 0xFFFF)
568		return -EFAULT;
569	spare_reg |= (BIT(3) | BIT(5) | BIT(6));
570	wl1271_top_reg_write(wl, WL_SPARE_REG, spare_reg);
571
572	/* Enable FREF_CLK_REQ & mux MCS and coex PLLs to FREF */
573	wl1271_top_reg_write(wl, SYS_CLK_CFG_REG,
574			     WL_CLK_REQ_TYPE_PG2 | MCS_PLL_CLK_SEL_FREF);
575
576	/* Delay execution for 15msec, to let the HW settle */
577	mdelay(15);
578
579	return 0;
580}
581
582static bool wl128x_is_tcxo_valid(struct wl1271 *wl)
583{
584	u16 tcxo_detection;
585
586	tcxo_detection = wl1271_top_reg_read(wl, TCXO_CLK_DETECT_REG);
587	if (tcxo_detection & TCXO_DET_FAILED)
588		return false;
589
590	return true;
591}
592
593static bool wl128x_is_fref_valid(struct wl1271 *wl)
594{
595	u16 fref_detection;
596
597	fref_detection = wl1271_top_reg_read(wl, FREF_CLK_DETECT_REG);
598	if (fref_detection & FREF_CLK_DETECT_FAIL)
599		return false;
600
601	return true;
602}
603
604static int wl128x_manually_configure_mcs_pll(struct wl1271 *wl)
605{
606	wl1271_top_reg_write(wl, MCS_PLL_M_REG, MCS_PLL_M_REG_VAL);
607	wl1271_top_reg_write(wl, MCS_PLL_N_REG, MCS_PLL_N_REG_VAL);
608	wl1271_top_reg_write(wl, MCS_PLL_CONFIG_REG, MCS_PLL_CONFIG_REG_VAL);
609
610	return 0;
611}
612
613static int wl128x_configure_mcs_pll(struct wl1271 *wl, int clk)
614{
615	u16 spare_reg;
616	u16 pll_config;
617	u8 input_freq;
618
619	/* Mask bits [3:1] in the sys_clk_cfg register */
620	spare_reg = wl1271_top_reg_read(wl, WL_SPARE_REG);
621	if (spare_reg == 0xFFFF)
622		return -EFAULT;
623	spare_reg |= BIT(2);
624	wl1271_top_reg_write(wl, WL_SPARE_REG, spare_reg);
625
626	/* Handle special cases of the TCXO clock */
627	if (wl->tcxo_clock == WL12XX_TCXOCLOCK_16_8 ||
628	    wl->tcxo_clock == WL12XX_TCXOCLOCK_33_6)
629		return wl128x_manually_configure_mcs_pll(wl);
630
631	/* Set the input frequency according to the selected clock source */
632	input_freq = (clk & 1) + 1;
633
634	pll_config = wl1271_top_reg_read(wl, MCS_PLL_CONFIG_REG);
635	if (pll_config == 0xFFFF)
636		return -EFAULT;
637	pll_config |= (input_freq << MCS_SEL_IN_FREQ_SHIFT);
638	pll_config |= MCS_PLL_ENABLE_HP;
639	wl1271_top_reg_write(wl, MCS_PLL_CONFIG_REG, pll_config);
640
641	return 0;
642}
643
644/*
645 * WL128x has two clocks input - TCXO and FREF.
646 * TCXO is the main clock of the device, while FREF is used to sync
647 * between the GPS and the cellular modem.
648 * In cases where TCXO is 32.736MHz or 16.368MHz, the FREF will be used
649 * as the WLAN/BT main clock.
650 */
651static int wl128x_boot_clk(struct wl1271 *wl, int *selected_clock)
652{
653	u16 sys_clk_cfg;
654
655	/* For XTAL-only modes, FREF will be used after switching from TCXO */
656	if (wl->ref_clock == WL12XX_REFCLOCK_26_XTAL ||
657	    wl->ref_clock == WL12XX_REFCLOCK_38_XTAL) {
658		if (!wl128x_switch_tcxo_to_fref(wl))
659			return -EINVAL;
660		goto fref_clk;
661	}
662
663	/* Query the HW, to determine which clock source we should use */
664	sys_clk_cfg = wl1271_top_reg_read(wl, SYS_CLK_CFG_REG);
665	if (sys_clk_cfg == 0xFFFF)
666		return -EINVAL;
667	if (sys_clk_cfg & PRCM_CM_EN_MUX_WLAN_FREF)
668		goto fref_clk;
669
670	/* If TCXO is either 32.736MHz or 16.368MHz, switch to FREF */
671	if (wl->tcxo_clock == WL12XX_TCXOCLOCK_16_368 ||
672	    wl->tcxo_clock == WL12XX_TCXOCLOCK_32_736) {
673		if (!wl128x_switch_tcxo_to_fref(wl))
674			return -EINVAL;
675		goto fref_clk;
676	}
677
678	/* TCXO clock is selected */
679	if (!wl128x_is_tcxo_valid(wl))
680		return -EINVAL;
681	*selected_clock = wl->tcxo_clock;
682	goto config_mcs_pll;
683
684fref_clk:
685	/* FREF clock is selected */
686	if (!wl128x_is_fref_valid(wl))
687		return -EINVAL;
688	*selected_clock = wl->ref_clock;
689
690config_mcs_pll:
691	return wl128x_configure_mcs_pll(wl, *selected_clock);
692}
693
694static int wl127x_boot_clk(struct wl1271 *wl)
695{
696	u32 pause;
697	u32 clk;
698
699	wl1271_boot_hw_version(wl);
700
701	if (wl->ref_clock == CONF_REF_CLK_19_2_E ||
702	    wl->ref_clock == CONF_REF_CLK_38_4_E ||
703	    wl->ref_clock == CONF_REF_CLK_38_4_M_XTAL)
704		/* ref clk: 19.2/38.4/38.4-XTAL */
705		clk = 0x3;
706	else if (wl->ref_clock == CONF_REF_CLK_26_E ||
707		 wl->ref_clock == CONF_REF_CLK_52_E)
708		/* ref clk: 26/52 */
709		clk = 0x5;
710	else
711		return -EINVAL;
712
713	if (wl->ref_clock != CONF_REF_CLK_19_2_E) {
714		u16 val;
715		/* Set clock type (open drain) */
716		val = wl1271_top_reg_read(wl, OCP_REG_CLK_TYPE);
717		val &= FREF_CLK_TYPE_BITS;
718		wl1271_top_reg_write(wl, OCP_REG_CLK_TYPE, val);
719
720		/* Set clock pull mode (no pull) */
721		val = wl1271_top_reg_read(wl, OCP_REG_CLK_PULL);
722		val |= NO_PULL;
723		wl1271_top_reg_write(wl, OCP_REG_CLK_PULL, val);
724	} else {
725		u16 val;
726		/* Set clock polarity */
727		val = wl1271_top_reg_read(wl, OCP_REG_CLK_POLARITY);
728		val &= FREF_CLK_POLARITY_BITS;
729		val |= CLK_REQ_OUTN_SEL;
730		wl1271_top_reg_write(wl, OCP_REG_CLK_POLARITY, val);
731	}
732
733	wl1271_write32(wl, PLL_PARAMETERS, clk);
734
735	pause = wl1271_read32(wl, PLL_PARAMETERS);
736
737	wl1271_debug(DEBUG_BOOT, "pause1 0x%x", pause);
738
739	pause &= ~(WU_COUNTER_PAUSE_VAL);
740	pause |= WU_COUNTER_PAUSE_VAL;
741	wl1271_write32(wl, WU_COUNTER_PAUSE, pause);
742
743	return 0;
744}
745
746/* uploads NVS and firmware */
747int wl1271_load_firmware(struct wl1271 *wl)
748{
749	int ret = 0;
750	u32 tmp, clk;
751	int selected_clock = -1;
752
753	if (wl->chip.id == CHIP_ID_1283_PG20) {
754		ret = wl128x_boot_clk(wl, &selected_clock);
755		if (ret < 0)
756			goto out;
757	} else {
758		ret = wl127x_boot_clk(wl);
759		if (ret < 0)
760			goto out;
761	}
762
763	/* Continue the ELP wake up sequence */
764	wl1271_write32(wl, WELP_ARM_COMMAND, WELP_ARM_COMMAND_VAL);
765	udelay(500);
766
767	wl1271_set_partition(wl, &part_table[PART_DRPW]);
768
769	/* Read-modify-write DRPW_SCRATCH_START register (see next state)
770	   to be used by DRPw FW. The RTRIM value will be added by the FW
771	   before taking DRPw out of reset */
772
773	wl1271_debug(DEBUG_BOOT, "DRPW_SCRATCH_START %08x", DRPW_SCRATCH_START);
774	clk = wl1271_read32(wl, DRPW_SCRATCH_START);
775
776	wl1271_debug(DEBUG_BOOT, "clk2 0x%x", clk);
777
778	if (wl->chip.id == CHIP_ID_1283_PG20) {
779		clk |= ((selected_clock & 0x3) << 1) << 4;
780	} else {
781		clk |= (wl->ref_clock << 1) << 4;
782	}
783
784	if (wl->quirks & WL12XX_QUIRK_LPD_MODE)
785		clk |= SCRATCH_ENABLE_LPD;
786
787	wl1271_write32(wl, DRPW_SCRATCH_START, clk);
788
789	wl1271_set_partition(wl, &part_table[PART_WORK]);
790
791	/* Disable interrupts */
792	wl1271_write32(wl, ACX_REG_INTERRUPT_MASK, WL1271_ACX_INTR_ALL);
793
794	ret = wl1271_boot_soft_reset(wl);
795	if (ret < 0)
796		goto out;
797
798	/* 2. start processing NVS file */
799	ret = wl1271_boot_upload_nvs(wl);
800	if (ret < 0)
801		goto out;
802
803	/* write firmware's last address (ie. it's length) to
804	 * ACX_EEPROMLESS_IND_REG */
805	wl1271_debug(DEBUG_BOOT, "ACX_EEPROMLESS_IND_REG");
806
807	wl1271_write32(wl, ACX_EEPROMLESS_IND_REG, ACX_EEPROMLESS_IND_REG);
808
809	tmp = wl1271_read32(wl, CHIP_ID_B);
810
811	wl1271_debug(DEBUG_BOOT, "chip id 0x%x", tmp);
812
813	/* 6. read the EEPROM parameters */
814	tmp = wl1271_read32(wl, SCR_PAD2);
815
816	/* WL1271: The reference driver skips steps 7 to 10 (jumps directly
817	 * to upload_fw) */
818
819	if (wl->chip.id == CHIP_ID_1283_PG20)
820		wl1271_top_reg_write(wl, SDIO_IO_DS, wl->conf.hci_io_ds);
821
822	ret = wl1271_boot_upload_firmware(wl);
823	if (ret < 0)
824		goto out;
825
826out:
827	return ret;
828}
829EXPORT_SYMBOL_GPL(wl1271_load_firmware);
830
831int wl1271_boot(struct wl1271 *wl)
832{
833	int ret;
834
835	/* upload NVS and firmware */
836	ret = wl1271_load_firmware(wl);
837	if (ret)
838		return ret;
839
840	/* 10.5 start firmware */
841	ret = wl1271_boot_run_firmware(wl);
842	if (ret < 0)
843		goto out;
844
845	ret = wl1271_boot_write_irq_polarity(wl);
846	if (ret < 0)
847		goto out;
848
849	wl1271_write32(wl, ACX_REG_INTERRUPT_MASK,
850		       WL1271_ACX_ALL_EVENTS_VECTOR);
851
852	/* Enable firmware interrupts now */
853	wl1271_boot_enable_interrupts(wl);
854
855	/* set the wl1271 default filters */
856	wl1271_set_default_filters(wl);
857
858	wl1271_event_mbox_config(wl);
859
860out:
861	return ret;
862}