Lines Matching refs:moxtet
126 if (mdev->moxtet == new_dev->moxtet && mdev->id == new_dev->id && in moxtet_dev_check()
136 put_device(mdev->moxtet->dev); in moxtet_dev_release()
141 moxtet_alloc_device(struct moxtet *moxtet) in moxtet_alloc_device() argument
145 if (!get_device(moxtet->dev)) in moxtet_alloc_device()
150 put_device(moxtet->dev); in moxtet_alloc_device()
154 dev->moxtet = moxtet; in moxtet_alloc_device()
155 dev->dev.parent = moxtet->dev; in moxtet_alloc_device()
184 dev_err(dev->moxtet->dev, "can't add %s, status %d\n", in moxtet_add_device()
185 dev_name(dev->moxtet->dev), ret); in moxtet_add_device()
205 of_register_moxtet_device(struct moxtet *moxtet, struct device_node *nc) in of_register_moxtet_device() argument
211 dev = moxtet_alloc_device(moxtet); in of_register_moxtet_device()
213 dev_err(moxtet->dev, in of_register_moxtet_device()
220 dev_err(moxtet->dev, "%pOF has no valid 'reg' property (%d)\n", in of_register_moxtet_device()
228 dev_err(moxtet->dev, "%pOF Moxtet address 0x%x out of range\n", in of_register_moxtet_device()
234 dev->id = moxtet->modules[dev->idx]; in of_register_moxtet_device()
237 dev_err(moxtet->dev, "%pOF Moxtet address 0x%x is empty\n", nc, in of_register_moxtet_device()
248 dev_err(moxtet->dev, in of_register_moxtet_device()
261 static void of_register_moxtet_devices(struct moxtet *moxtet) in of_register_moxtet_devices() argument
266 if (!moxtet->dev->of_node) in of_register_moxtet_devices()
269 for_each_available_child_of_node(moxtet->dev->of_node, nc) { in of_register_moxtet_devices()
272 dev = of_register_moxtet_device(moxtet, nc); in of_register_moxtet_devices()
274 dev_warn(moxtet->dev, in of_register_moxtet_devices()
283 moxtet_register_devices_from_topology(struct moxtet *moxtet) in moxtet_register_devices_from_topology() argument
288 for (i = 0; i < moxtet->count; ++i) { in moxtet_register_devices_from_topology()
289 dev = moxtet_alloc_device(moxtet); in moxtet_register_devices_from_topology()
291 dev_err(moxtet->dev, "Moxtet device %u alloc error\n", in moxtet_register_devices_from_topology()
297 dev->id = moxtet->modules[i]; in moxtet_register_devices_from_topology()
302 dev_err(moxtet->dev, in moxtet_register_devices_from_topology()
312 static int moxtet_set_irq(struct moxtet *moxtet, int idx, int id, int nsame) in moxtet_set_irq() argument
324 pos = &moxtet->irq.position[first + i]; in moxtet_set_irq()
327 moxtet->irq.exists |= BIT(first + i); in moxtet_set_irq()
333 static int moxtet_find_topology(struct moxtet *moxtet) in moxtet_find_topology() argument
341 ret = spi_read(to_spi_device(moxtet->dev), buf, TURRIS_MOX_MAX_MODULES); in moxtet_find_topology()
346 dev_info(moxtet->dev, "Found MOX A (eMMC CPU) module\n"); in moxtet_find_topology()
348 dev_info(moxtet->dev, "Found MOX A (CPU) module\n"); in moxtet_find_topology()
350 dev_err(moxtet->dev, "Invalid Turris MOX A CPU module 0x%02x\n", in moxtet_find_topology()
355 moxtet->count = 0; in moxtet_find_topology()
365 moxtet->modules[i-1] = id; in moxtet_find_topology()
366 ++moxtet->count; in moxtet_find_topology()
369 dev_info(moxtet->dev, "Found %s module\n", in moxtet_find_topology()
372 if (moxtet_set_irq(moxtet, i-1, id, cnts[id]++) < 0) in moxtet_find_topology()
373 dev_err(moxtet->dev, in moxtet_find_topology()
377 dev_warn(moxtet->dev, in moxtet_find_topology()
386 static int moxtet_spi_read(struct moxtet *moxtet, u8 *buf) in moxtet_spi_read() argument
390 .tx_buf = moxtet->tx, in moxtet_spi_read()
391 .len = moxtet->count + 1 in moxtet_spi_read()
395 mutex_lock(&moxtet->lock); in moxtet_spi_read()
397 ret = spi_sync_transfer(to_spi_device(moxtet->dev), &xfer, 1); in moxtet_spi_read()
399 mutex_unlock(&moxtet->lock); in moxtet_spi_read()
407 struct moxtet *moxtet = mdev->moxtet; in moxtet_device_read() local
411 if (mdev->idx >= moxtet->count) in moxtet_device_read()
414 ret = moxtet_spi_read(moxtet, buf); in moxtet_device_read()
425 struct moxtet *moxtet = mdev->moxtet; in moxtet_device_write() local
428 if (mdev->idx >= moxtet->count) in moxtet_device_write()
431 mutex_lock(&moxtet->lock); in moxtet_device_write()
433 moxtet->tx[moxtet->count - mdev->idx] = val; in moxtet_device_write()
435 ret = spi_write(to_spi_device(moxtet->dev), moxtet->tx, in moxtet_device_write()
436 moxtet->count + 1); in moxtet_device_write()
438 mutex_unlock(&moxtet->lock); in moxtet_device_write()
447 struct moxtet *moxtet = mdev->moxtet; in moxtet_device_written() local
449 if (mdev->idx >= moxtet->count) in moxtet_device_written()
452 return moxtet->tx[moxtet->count - mdev->idx]; in moxtet_device_written()
467 struct moxtet *moxtet = file->private_data; in input_read() local
472 ret = moxtet_spi_read(moxtet, bin); in input_read()
476 n = moxtet->count + 1; in input_read()
494 struct moxtet *moxtet = file->private_data; in output_read() local
499 mutex_lock(&moxtet->lock); in output_read()
501 for (i = 0; i < moxtet->count; ++i) in output_read()
502 p = hex_byte_pack(p, moxtet->tx[moxtet->count - i]); in output_read()
504 mutex_unlock(&moxtet->lock); in output_read()
514 struct moxtet *moxtet = file->private_data; in output_write() local
521 if (len > 2 * moxtet->count + 1 || len < 2 * moxtet->count) in output_write()
531 err = hex2bin(bin, hex, moxtet->count); in output_write()
535 mutex_lock(&moxtet->lock); in output_write()
537 for (i = 0; i < moxtet->count; ++i) in output_write()
538 moxtet->tx[moxtet->count - i] = bin[i]; in output_write()
540 err = spi_write(to_spi_device(moxtet->dev), moxtet->tx, in output_write()
541 moxtet->count + 1); in output_write()
543 mutex_unlock(&moxtet->lock); in output_write()
556 static int moxtet_register_debugfs(struct moxtet *moxtet) in moxtet_register_debugfs() argument
565 entry = debugfs_create_file_unsafe("input", 0444, root, moxtet, in moxtet_register_debugfs()
570 entry = debugfs_create_file_unsafe("output", 0644, root, moxtet, in moxtet_register_debugfs()
575 moxtet->debugfs_root = root; in moxtet_register_debugfs()
583 static void moxtet_unregister_debugfs(struct moxtet *moxtet) in moxtet_unregister_debugfs() argument
585 debugfs_remove_recursive(moxtet->debugfs_root); in moxtet_unregister_debugfs()
588 static inline int moxtet_register_debugfs(struct moxtet *moxtet) in moxtet_register_debugfs() argument
593 static inline void moxtet_unregister_debugfs(struct moxtet *moxtet) in moxtet_unregister_debugfs() argument
601 struct moxtet *moxtet = d->host_data; in moxtet_irq_domain_map() local
603 if (hw >= MOXTET_NIRQS || !(moxtet->irq.exists & BIT(hw))) { in moxtet_irq_domain_map()
604 dev_err(moxtet->dev, "Invalid hw irq number\n"); in moxtet_irq_domain_map()
609 irq_set_chip_and_handler(irq, &moxtet->irq.chip, handle_level_irq); in moxtet_irq_domain_map()
620 struct moxtet *moxtet = d->host_data; in moxtet_irq_domain_xlate() local
628 if (irq >= MOXTET_NIRQS || !(moxtet->irq.exists & BIT(irq))) in moxtet_irq_domain_xlate()
643 struct moxtet *moxtet = irq_data_get_irq_chip_data(d); in moxtet_irq_mask() local
645 moxtet->irq.masked |= BIT(d->hwirq); in moxtet_irq_mask()
650 struct moxtet *moxtet = irq_data_get_irq_chip_data(d); in moxtet_irq_unmask() local
652 moxtet->irq.masked &= ~BIT(d->hwirq); in moxtet_irq_unmask()
657 struct moxtet *moxtet = irq_data_get_irq_chip_data(d); in moxtet_irq_print_chip() local
658 struct moxtet_irqpos *pos = &moxtet->irq.position[d->hwirq]; in moxtet_irq_print_chip()
661 id = moxtet->modules[pos->idx]; in moxtet_irq_print_chip()
674 static int moxtet_irq_read(struct moxtet *moxtet, unsigned long *map) in moxtet_irq_read() argument
676 struct moxtet_irqpos *pos = moxtet->irq.position; in moxtet_irq_read()
680 ret = moxtet_spi_read(moxtet, buf); in moxtet_irq_read()
686 for_each_set_bit(i, &moxtet->irq.exists, MOXTET_NIRQS) { in moxtet_irq_read()
696 struct moxtet *moxtet = data; in moxtet_irq_thread_fn() local
700 ret = moxtet_irq_read(moxtet, &set); in moxtet_irq_thread_fn()
704 set &= ~moxtet->irq.masked; in moxtet_irq_thread_fn()
708 sub_irq = irq_find_mapping(moxtet->irq.domain, i); in moxtet_irq_thread_fn()
710 dev_dbg(moxtet->dev, "%i irq\n", i); in moxtet_irq_thread_fn()
714 ret = moxtet_irq_read(moxtet, &set); in moxtet_irq_thread_fn()
718 set &= ~moxtet->irq.masked; in moxtet_irq_thread_fn()
725 static void moxtet_irq_free(struct moxtet *moxtet) in moxtet_irq_free() argument
730 if (moxtet->irq.exists & BIT(i)) { in moxtet_irq_free()
731 irq = irq_find_mapping(moxtet->irq.domain, i); in moxtet_irq_free()
736 irq_domain_remove(moxtet->irq.domain); in moxtet_irq_free()
739 static int moxtet_irq_setup(struct moxtet *moxtet) in moxtet_irq_setup() argument
743 moxtet->irq.domain = irq_domain_add_simple(moxtet->dev->of_node, in moxtet_irq_setup()
745 &moxtet_irq_domain, moxtet); in moxtet_irq_setup()
746 if (moxtet->irq.domain == NULL) { in moxtet_irq_setup()
747 dev_err(moxtet->dev, "Could not add IRQ domain\n"); in moxtet_irq_setup()
752 if (moxtet->irq.exists & BIT(i)) in moxtet_irq_setup()
753 irq_create_mapping(moxtet->irq.domain, i); in moxtet_irq_setup()
755 moxtet->irq.chip = moxtet_irq_chip; in moxtet_irq_setup()
756 moxtet->irq.masked = ~0; in moxtet_irq_setup()
758 ret = request_threaded_irq(moxtet->dev_irq, NULL, moxtet_irq_thread_fn, in moxtet_irq_setup()
759 IRQF_ONESHOT, "moxtet", moxtet); in moxtet_irq_setup()
766 moxtet_irq_free(moxtet); in moxtet_irq_setup()
772 struct moxtet *moxtet; in moxtet_probe() local
779 moxtet = devm_kzalloc(&spi->dev, sizeof(struct moxtet), in moxtet_probe()
781 if (!moxtet) in moxtet_probe()
784 moxtet->dev = &spi->dev; in moxtet_probe()
785 spi_set_drvdata(spi, moxtet); in moxtet_probe()
787 mutex_init(&moxtet->lock); in moxtet_probe()
789 moxtet->dev_irq = of_irq_get(moxtet->dev->of_node, 0); in moxtet_probe()
790 if (moxtet->dev_irq == -EPROBE_DEFER) in moxtet_probe()
793 if (moxtet->dev_irq <= 0) { in moxtet_probe()
794 dev_err(moxtet->dev, "No IRQ resource found\n"); in moxtet_probe()
798 ret = moxtet_find_topology(moxtet); in moxtet_probe()
802 if (moxtet->irq.exists) { in moxtet_probe()
803 ret = moxtet_irq_setup(moxtet); in moxtet_probe()
808 of_register_moxtet_devices(moxtet); in moxtet_probe()
809 moxtet_register_devices_from_topology(moxtet); in moxtet_probe()
811 ret = moxtet_register_debugfs(moxtet); in moxtet_probe()
813 dev_warn(moxtet->dev, "Failed creating debugfs entries: %i\n", in moxtet_probe()
821 struct moxtet *moxtet = spi_get_drvdata(spi); in moxtet_remove() local
823 free_irq(moxtet->dev_irq, moxtet); in moxtet_remove()
825 moxtet_irq_free(moxtet); in moxtet_remove()
827 moxtet_unregister_debugfs(moxtet); in moxtet_remove()
829 device_for_each_child(moxtet->dev, NULL, __unregister); in moxtet_remove()
831 mutex_destroy(&moxtet->lock); in moxtet_remove()