intersil/p54/p54spi.c

46 static void p54spi_spi_read(struct p54s_priv *priv, u8 address,
67 	spi_sync(priv->spi, &m);
71 static void p54spi_spi_write(struct p54s_priv *priv, u8 address,
101 	spi_sync(priv->spi, &m);
104 static u32 p54spi_read32(struct p54s_priv *priv, u8 addr)
108 	p54spi_spi_read(priv, addr, &val, sizeof(val));
113 static inline void p54spi_write16(struct p54s_priv *priv, u8 addr, __le16 val)
115 	p54spi_spi_write(priv, addr, &val, sizeof(val));
118 static inline void p54spi_write32(struct p54s_priv *priv, u8 addr, __le32 val)
120 	p54spi_spi_write(priv, addr, &val, sizeof(val));
123 static int p54spi_wait_bit(struct p54s_priv *priv, u16 reg, u32 bits)
128 		u32 buffer = p54spi_read32(priv, reg);
135 static int p54spi_spi_write_dma(struct p54s_priv *priv, __le32 base,
138 	if (!p54spi_wait_bit(priv, SPI_ADRS_DMA_WRITE_CTRL, HOST_ALLOWED)) {
139 		dev_err(&priv->spi->dev, "spi_write_dma not allowed "
144 	p54spi_write16(priv, SPI_ADRS_DMA_WRITE_CTRL,
147 	p54spi_write16(priv, SPI_ADRS_DMA_WRITE_LEN, cpu_to_le16(len));
148 	p54spi_write32(priv, SPI_ADRS_DMA_WRITE_BASE, base);
149 	p54spi_spi_write(priv, SPI_ADRS_DMA_DATA, buf, len);
155 	struct p54s_priv *priv = dev->priv;
159 	ret = request_firmware(&priv->firmware, "3826.arm", &priv->spi->dev);
162 		dev_err(&priv->spi->dev, "request_firmware() failed: %d", ret);
166 	ret = p54_parse_firmware(dev, priv->firmware);
177 	struct p54s_priv *priv = dev->priv;
184 	ret = request_firmware_direct(&eeprom, "3826.eeprom", &priv->spi->dev);
187 		dev_info(&priv->spi->dev, "loading default eeprom...\n");
191 		dev_err(&priv->spi->dev, "Failed to request user eeprom\n");
194 		dev_info(&priv->spi->dev, "loading user eeprom...\n");
204 	struct p54s_priv *priv = dev->priv;
210 	fw_len = priv->firmware->size;
211 	fw = kmemdup(priv->firmware->data, fw_len, GFP_KERNEL);
216 	p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
222 	p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
231 		err = p54spi_spi_write_dma(priv, cpu_to_le32(
244 	p54spi_write32(priv, SPI_ADRS_HOST_INT_EN,
248 	p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
254 	p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
263 static void p54spi_power_off(struct p54s_priv *priv)
269 static void p54spi_power_on(struct p54s_priv *priv)
280 static inline void p54spi_int_ack(struct p54s_priv *priv, u32 val)
282 	p54spi_write32(priv, SPI_ADRS_HOST_INT_ACK, cpu_to_le32(val));
285 static int p54spi_wakeup(struct p54s_priv *priv)
288 	p54spi_write32(priv, SPI_ADRS_ARM_INTERRUPTS,
292 	if (!p54spi_wait_bit(priv, SPI_ADRS_HOST_INTERRUPTS,
294 		dev_err(&priv->spi->dev, "INT_READY timeout\n");
298 	p54spi_int_ack(priv, SPI_HOST_INT_READY);
302 static inline void p54spi_sleep(struct p54s_priv *priv)
304 	p54spi_write32(priv, SPI_ADRS_ARM_INTERRUPTS,
308 static void p54spi_int_ready(struct p54s_priv *priv)
310 	p54spi_write32(priv, SPI_ADRS_HOST_INT_EN, cpu_to_le32(
313 	switch (priv->fw_state) {
315 		priv->fw_state = FW_STATE_READY;
316 		complete(&priv->fw_comp);
319 		priv->fw_state = FW_STATE_READY;
327 static int p54spi_rx(struct p54s_priv *priv)
334 	if (p54spi_wakeup(priv) < 0)
341 	p54spi_spi_read(priv, SPI_ADRS_DMA_DATA, rx_head, sizeof(rx_head));
345 		p54spi_sleep(priv);
346 		dev_err(&priv->spi->dev, "rx request of zero bytes\n");
357 		p54spi_sleep(priv);
358 		dev_err(&priv->spi->dev, "could not alloc skb");
366 		p54spi_spi_read(priv, SPI_ADRS_DMA_DATA,
370 	p54spi_sleep(priv);
376 	if (p54_rx(priv->hw, skb) == 0)
386 	struct p54s_priv *priv = spi_get_drvdata(spi);
388 	ieee80211_queue_work(priv->hw, &priv->work);
393 static int p54spi_tx_frame(struct p54s_priv *priv, struct sk_buff *skb)
398 	if (p54spi_wakeup(priv) < 0)
401 	ret = p54spi_spi_write_dma(priv, hdr->req_id, skb->data, skb->len);
405 	if (!p54spi_wait_bit(priv, SPI_ADRS_HOST_INTERRUPTS,
407 		dev_err(&priv->spi->dev, "WR_READY timeout\n");
412 	p54spi_int_ack(priv, SPI_HOST_INT_WR_READY);
415 		p54_free_skb(priv->hw, skb);
417 	p54spi_sleep(priv);
421 static int p54spi_wq_tx(struct p54s_priv *priv)
431 	spin_lock_irqsave(&priv->tx_lock, flags);
433 	while (!list_empty(&priv->tx_pending)) {
434 		entry = list_entry(priv->tx_pending.next,
439 		spin_unlock_irqrestore(&priv->tx_lock, flags);
449 		ret = p54spi_tx_frame(priv, skb);
452 			p54_free_skb(priv->hw, skb);
456 		spin_lock_irqsave(&priv->tx_lock, flags);
458 	spin_unlock_irqrestore(&priv->tx_lock, flags);
464 	struct p54s_priv *priv = dev->priv;
472 	spin_lock_irqsave(&priv->tx_lock, flags);
473 	list_add_tail(&di->tx_list, &priv->tx_pending);
474 	spin_unlock_irqrestore(&priv->tx_lock, flags);
476 	ieee80211_queue_work(priv->hw, &priv->work);
481 	struct p54s_priv *priv = container_of(work, struct p54s_priv, work);
485 	mutex_lock(&priv->mutex);
487 	if (priv->fw_state == FW_STATE_OFF)
490 	ints = p54spi_read32(priv, SPI_ADRS_HOST_INTERRUPTS);
493 		p54spi_int_ready(priv);
494 		p54spi_int_ack(priv, SPI_HOST_INT_READY);
497 	if (priv->fw_state != FW_STATE_READY)
501 		p54spi_int_ack(priv, SPI_HOST_INT_UPDATE);
502 		ret = p54spi_rx(priv);
507 		p54spi_int_ack(priv, SPI_HOST_INT_SW_UPDATE);
508 		ret = p54spi_rx(priv);
513 	ret = p54spi_wq_tx(priv);
515 	mutex_unlock(&priv->mutex);
520 	struct p54s_priv *priv = dev->priv;
524 	if (mutex_lock_interruptible(&priv->mutex)) {
529 	priv->fw_state = FW_STATE_BOOTING;
531 	p54spi_power_on(priv);
535 		p54spi_power_off(priv);
539 	mutex_unlock(&priv->mutex);
542 	timeout = wait_for_completion_interruptible_timeout(&priv->fw_comp,
545 		dev_err(&priv->spi->dev, "firmware boot failed");
546 		p54spi_power_off(priv);
551 	if (mutex_lock_interruptible(&priv->mutex)) {
553 		p54spi_power_off(priv);
557 	WARN_ON(priv->fw_state != FW_STATE_READY);
560 	mutex_unlock(&priv->mutex);
568 	struct p54s_priv *priv = dev->priv;
571 	mutex_lock(&priv->mutex);
572 	WARN_ON(priv->fw_state != FW_STATE_READY);
574 	p54spi_power_off(priv);
575 	spin_lock_irqsave(&priv->tx_lock, flags);
576 	INIT_LIST_HEAD(&priv->tx_pending);
577 	spin_unlock_irqrestore(&priv->tx_lock, flags);
579 	priv->fw_state = FW_STATE_OFF;
580 	mutex_unlock(&priv->mutex);
582 	cancel_work_sync(&priv->work);
587 	struct p54s_priv *priv = NULL;
591 	hw = p54_init_common(sizeof(*priv));
597 	priv = hw->priv;
598 	priv->hw = hw;
599 	spi_set_drvdata(spi, priv);
600 	priv->spi = spi;
607 		dev_err(&priv->spi->dev, "spi_setup failed");
613 		dev_err(&priv->spi->dev, "power GPIO request failed: %d", ret);
619 		dev_err(&priv->spi->dev, "irq GPIO request failed: %d", ret);
628 			  priv->spi);
630 		dev_err(&priv->spi->dev, "request_irq() failed");
638 	INIT_WORK(&priv->work, p54spi_work);
639 	init_completion(&priv->fw_comp);
640 	INIT_LIST_HEAD(&priv->tx_pending);
641 	mutex_init(&priv->mutex);
642 	spin_lock_init(&priv->tx_lock);
644 	priv->common.open = p54spi_op_start;
645 	priv->common.stop = p54spi_op_stop;
646 	priv->common.tx = p54spi_op_tx;
656 	ret = p54_register_common(hw, &priv->spi->dev);
663 	release_firmware(priv->firmware);
670 	p54_free_common(priv->hw);
676 	struct p54s_priv *priv = spi_get_drvdata(spi);
678 	p54_unregister_common(priv->hw);
684 	release_firmware(priv->firmware);
686 	mutex_destroy(&priv->mutex);
688 	p54_free_common(priv->hw);