Lines Matching refs:moxtet
125 if (mdev->moxtet == new_dev->moxtet && mdev->id == new_dev->id && in moxtet_dev_check()
135 put_device(mdev->moxtet->dev); in moxtet_dev_release()
140 moxtet_alloc_device(struct moxtet *moxtet) in moxtet_alloc_device() argument
144 if (!get_device(moxtet->dev)) in moxtet_alloc_device()
149 put_device(moxtet->dev); in moxtet_alloc_device()
153 dev->moxtet = moxtet; in moxtet_alloc_device()
154 dev->dev.parent = moxtet->dev; in moxtet_alloc_device()
183 dev_err(dev->moxtet->dev, "can't add %s, status %d\n", in moxtet_add_device()
184 dev_name(dev->moxtet->dev), ret); in moxtet_add_device()
204 of_register_moxtet_device(struct moxtet *moxtet, struct device_node *nc) in of_register_moxtet_device() argument
210 dev = moxtet_alloc_device(moxtet); in of_register_moxtet_device()
212 dev_err(moxtet->dev, in of_register_moxtet_device()
219 dev_err(moxtet->dev, "%pOF has no valid 'reg' property (%d)\n", in of_register_moxtet_device()
227 dev_err(moxtet->dev, "%pOF Moxtet address 0x%x out of range\n", in of_register_moxtet_device()
233 dev->id = moxtet->modules[dev->idx]; in of_register_moxtet_device()
236 dev_err(moxtet->dev, "%pOF Moxtet address 0x%x is empty\n", nc, in of_register_moxtet_device()
247 dev_err(moxtet->dev, in of_register_moxtet_device()
260 static void of_register_moxtet_devices(struct moxtet *moxtet) in of_register_moxtet_devices() argument
265 if (!moxtet->dev->of_node) in of_register_moxtet_devices()
268 for_each_available_child_of_node(moxtet->dev->of_node, nc) { in of_register_moxtet_devices()
271 dev = of_register_moxtet_device(moxtet, nc); in of_register_moxtet_devices()
273 dev_warn(moxtet->dev, in of_register_moxtet_devices()
282 moxtet_register_devices_from_topology(struct moxtet *moxtet) in moxtet_register_devices_from_topology() argument
287 for (i = 0; i < moxtet->count; ++i) { in moxtet_register_devices_from_topology()
288 dev = moxtet_alloc_device(moxtet); in moxtet_register_devices_from_topology()
290 dev_err(moxtet->dev, "Moxtet device %u alloc error\n", in moxtet_register_devices_from_topology()
296 dev->id = moxtet->modules[i]; in moxtet_register_devices_from_topology()
301 dev_err(moxtet->dev, in moxtet_register_devices_from_topology()
311 static int moxtet_set_irq(struct moxtet *moxtet, int idx, int id, int nsame) in moxtet_set_irq() argument
323 pos = &moxtet->irq.position[first + i]; in moxtet_set_irq()
326 moxtet->irq.exists |= BIT(first + i); in moxtet_set_irq()
332 static int moxtet_find_topology(struct moxtet *moxtet) in moxtet_find_topology() argument
340 ret = spi_read(to_spi_device(moxtet->dev), buf, TURRIS_MOX_MAX_MODULES); in moxtet_find_topology()
345 dev_info(moxtet->dev, "Found MOX A (eMMC CPU) module\n"); in moxtet_find_topology()
347 dev_info(moxtet->dev, "Found MOX A (CPU) module\n"); in moxtet_find_topology()
349 dev_err(moxtet->dev, "Invalid Turris MOX A CPU module 0x%02x\n", in moxtet_find_topology()
354 moxtet->count = 0; in moxtet_find_topology()
364 moxtet->modules[i-1] = id; in moxtet_find_topology()
365 ++moxtet->count; in moxtet_find_topology()
368 dev_info(moxtet->dev, "Found %s module\n", in moxtet_find_topology()
371 if (moxtet_set_irq(moxtet, i-1, id, cnts[id]++) < 0) in moxtet_find_topology()
372 dev_err(moxtet->dev, in moxtet_find_topology()
376 dev_warn(moxtet->dev, in moxtet_find_topology()
385 static int moxtet_spi_read(struct moxtet *moxtet, u8 *buf) in moxtet_spi_read() argument
389 .tx_buf = moxtet->tx, in moxtet_spi_read()
390 .len = moxtet->count + 1 in moxtet_spi_read()
394 mutex_lock(&moxtet->lock); in moxtet_spi_read()
396 ret = spi_sync_transfer(to_spi_device(moxtet->dev), &xfer, 1); in moxtet_spi_read()
398 mutex_unlock(&moxtet->lock); in moxtet_spi_read()
406 struct moxtet *moxtet = mdev->moxtet; in moxtet_device_read() local
410 if (mdev->idx >= moxtet->count) in moxtet_device_read()
413 ret = moxtet_spi_read(moxtet, buf); in moxtet_device_read()
424 struct moxtet *moxtet = mdev->moxtet; in moxtet_device_write() local
427 if (mdev->idx >= moxtet->count) in moxtet_device_write()
430 mutex_lock(&moxtet->lock); in moxtet_device_write()
432 moxtet->tx[moxtet->count - mdev->idx] = val; in moxtet_device_write()
434 ret = spi_write(to_spi_device(moxtet->dev), moxtet->tx, in moxtet_device_write()
435 moxtet->count + 1); in moxtet_device_write()
437 mutex_unlock(&moxtet->lock); in moxtet_device_write()
446 struct moxtet *moxtet = mdev->moxtet; in moxtet_device_written() local
448 if (mdev->idx >= moxtet->count) in moxtet_device_written()
451 return moxtet->tx[moxtet->count - mdev->idx]; in moxtet_device_written()
466 struct moxtet *moxtet = file->private_data; in input_read() local
471 ret = moxtet_spi_read(moxtet, bin); in input_read()
475 n = moxtet->count + 1; in input_read()
493 struct moxtet *moxtet = file->private_data; in output_read() local
498 mutex_lock(&moxtet->lock); in output_read()
500 for (i = 0; i < moxtet->count; ++i) in output_read()
501 p = hex_byte_pack(p, moxtet->tx[moxtet->count - i]); in output_read()
503 mutex_unlock(&moxtet->lock); in output_read()
513 struct moxtet *moxtet = file->private_data; in output_write() local
520 if (len > 2 * moxtet->count + 1 || len < 2 * moxtet->count) in output_write()
530 err = hex2bin(bin, hex, moxtet->count); in output_write()
534 mutex_lock(&moxtet->lock); in output_write()
536 for (i = 0; i < moxtet->count; ++i) in output_write()
537 moxtet->tx[moxtet->count - i] = bin[i]; in output_write()
539 err = spi_write(to_spi_device(moxtet->dev), moxtet->tx, in output_write()
540 moxtet->count + 1); in output_write()
542 mutex_unlock(&moxtet->lock); in output_write()
555 static int moxtet_register_debugfs(struct moxtet *moxtet) in moxtet_register_debugfs() argument
564 entry = debugfs_create_file_unsafe("input", 0444, root, moxtet, in moxtet_register_debugfs()
569 entry = debugfs_create_file_unsafe("output", 0644, root, moxtet, in moxtet_register_debugfs()
574 moxtet->debugfs_root = root; in moxtet_register_debugfs()
582 static void moxtet_unregister_debugfs(struct moxtet *moxtet) in moxtet_unregister_debugfs() argument
584 debugfs_remove_recursive(moxtet->debugfs_root); in moxtet_unregister_debugfs()
587 static inline int moxtet_register_debugfs(struct moxtet *moxtet) in moxtet_register_debugfs() argument
592 static inline void moxtet_unregister_debugfs(struct moxtet *moxtet) in moxtet_unregister_debugfs() argument
600 struct moxtet *moxtet = d->host_data; in moxtet_irq_domain_map() local
602 if (hw >= MOXTET_NIRQS || !(moxtet->irq.exists & BIT(hw))) { in moxtet_irq_domain_map()
603 dev_err(moxtet->dev, "Invalid hw irq number\n"); in moxtet_irq_domain_map()
608 irq_set_chip_and_handler(irq, &moxtet->irq.chip, handle_level_irq); in moxtet_irq_domain_map()
619 struct moxtet *moxtet = d->host_data; in moxtet_irq_domain_xlate() local
627 if (irq >= MOXTET_NIRQS || !(moxtet->irq.exists & BIT(irq))) in moxtet_irq_domain_xlate()
642 struct moxtet *moxtet = irq_data_get_irq_chip_data(d); in moxtet_irq_mask() local
644 moxtet->irq.masked |= BIT(d->hwirq); in moxtet_irq_mask()
649 struct moxtet *moxtet = irq_data_get_irq_chip_data(d); in moxtet_irq_unmask() local
651 moxtet->irq.masked &= ~BIT(d->hwirq); in moxtet_irq_unmask()
656 struct moxtet *moxtet = irq_data_get_irq_chip_data(d); in moxtet_irq_print_chip() local
657 struct moxtet_irqpos *pos = &moxtet->irq.position[d->hwirq]; in moxtet_irq_print_chip()
660 id = moxtet->modules[pos->idx]; in moxtet_irq_print_chip()
673 static int moxtet_irq_read(struct moxtet *moxtet, unsigned long *map) in moxtet_irq_read() argument
675 struct moxtet_irqpos *pos = moxtet->irq.position; in moxtet_irq_read()
679 ret = moxtet_spi_read(moxtet, buf); in moxtet_irq_read()
685 for_each_set_bit(i, &moxtet->irq.exists, MOXTET_NIRQS) { in moxtet_irq_read()
695 struct moxtet *moxtet = data; in moxtet_irq_thread_fn() local
699 ret = moxtet_irq_read(moxtet, &set); in moxtet_irq_thread_fn()
703 set &= ~moxtet->irq.masked; in moxtet_irq_thread_fn()
707 sub_irq = irq_find_mapping(moxtet->irq.domain, i); in moxtet_irq_thread_fn()
709 dev_dbg(moxtet->dev, "%i irq\n", i); in moxtet_irq_thread_fn()
713 ret = moxtet_irq_read(moxtet, &set); in moxtet_irq_thread_fn()
717 set &= ~moxtet->irq.masked; in moxtet_irq_thread_fn()
724 static void moxtet_irq_free(struct moxtet *moxtet) in moxtet_irq_free() argument
729 if (moxtet->irq.exists & BIT(i)) { in moxtet_irq_free()
730 irq = irq_find_mapping(moxtet->irq.domain, i); in moxtet_irq_free()
735 irq_domain_remove(moxtet->irq.domain); in moxtet_irq_free()
738 static int moxtet_irq_setup(struct moxtet *moxtet) in moxtet_irq_setup() argument
742 moxtet->irq.domain = irq_domain_add_simple(moxtet->dev->of_node, in moxtet_irq_setup()
744 &moxtet_irq_domain, moxtet); in moxtet_irq_setup()
745 if (moxtet->irq.domain == NULL) { in moxtet_irq_setup()
746 dev_err(moxtet->dev, "Could not add IRQ domain\n"); in moxtet_irq_setup()
751 if (moxtet->irq.exists & BIT(i)) in moxtet_irq_setup()
752 irq_create_mapping(moxtet->irq.domain, i); in moxtet_irq_setup()
754 moxtet->irq.chip = moxtet_irq_chip; in moxtet_irq_setup()
755 moxtet->irq.masked = ~0; in moxtet_irq_setup()
757 ret = request_threaded_irq(moxtet->dev_irq, NULL, moxtet_irq_thread_fn, in moxtet_irq_setup()
758 IRQF_SHARED | IRQF_ONESHOT, "moxtet", moxtet); in moxtet_irq_setup()
765 moxtet_irq_free(moxtet); in moxtet_irq_setup()
771 struct moxtet *moxtet; in moxtet_probe() local
778 moxtet = devm_kzalloc(&spi->dev, sizeof(struct moxtet), in moxtet_probe()
780 if (!moxtet) in moxtet_probe()
783 moxtet->dev = &spi->dev; in moxtet_probe()
784 spi_set_drvdata(spi, moxtet); in moxtet_probe()
786 mutex_init(&moxtet->lock); in moxtet_probe()
788 moxtet->dev_irq = of_irq_get(moxtet->dev->of_node, 0); in moxtet_probe()
789 if (moxtet->dev_irq == -EPROBE_DEFER) in moxtet_probe()
792 if (moxtet->dev_irq <= 0) { in moxtet_probe()
793 dev_err(moxtet->dev, "No IRQ resource found\n"); in moxtet_probe()
797 ret = moxtet_find_topology(moxtet); in moxtet_probe()
801 if (moxtet->irq.exists) { in moxtet_probe()
802 ret = moxtet_irq_setup(moxtet); in moxtet_probe()
807 of_register_moxtet_devices(moxtet); in moxtet_probe()
808 moxtet_register_devices_from_topology(moxtet); in moxtet_probe()
810 ret = moxtet_register_debugfs(moxtet); in moxtet_probe()
812 dev_warn(moxtet->dev, "Failed creating debugfs entries: %i\n", in moxtet_probe()
820 struct moxtet *moxtet = spi_get_drvdata(spi); in moxtet_remove() local
822 free_irq(moxtet->dev_irq, moxtet); in moxtet_remove()
824 moxtet_irq_free(moxtet); in moxtet_remove()
826 moxtet_unregister_debugfs(moxtet); in moxtet_remove()
828 device_for_each_child(moxtet->dev, NULL, __unregister); in moxtet_remove()
830 mutex_destroy(&moxtet->lock); in moxtet_remove()