Lines Matching full:tsa
3 * TSA driver
10 #include "tsa.h"
11 #include <dt-bindings/soc/cpm1-fsl,tsa.h>
21 /* TSA SI RAM routing tables entry */
118 struct tsa { struct
132 static inline struct tsa *tsa_serial_get_tsa(struct tsa_serial *tsa_serial) in tsa_serial_get_tsa() argument
135 return container_of(tsa_serial, struct tsa, serials[tsa_serial->id]); in tsa_serial_get_tsa()
165 struct tsa *tsa = tsa_serial_get_tsa(tsa_serial); in tsa_serial_connect() local
184 dev_err(tsa->dev, "Unsupported serial id %u\n", tsa_serial->id); in tsa_serial_connect()
188 spin_lock_irqsave(&tsa->lock, flags); in tsa_serial_connect()
189 tsa_clrsetbits32(tsa->si_regs + TSA_SICR, clear, set); in tsa_serial_connect()
190 spin_unlock_irqrestore(&tsa->lock, flags); in tsa_serial_connect()
198 struct tsa *tsa = tsa_serial_get_tsa(tsa_serial); in tsa_serial_disconnect() local
213 dev_err(tsa->dev, "Unsupported serial id %u\n", tsa_serial->id); in tsa_serial_disconnect()
217 spin_lock_irqsave(&tsa->lock, flags); in tsa_serial_disconnect()
218 tsa_clrsetbits32(tsa->si_regs + TSA_SICR, clear, 0); in tsa_serial_disconnect()
219 spin_unlock_irqrestore(&tsa->lock, flags); in tsa_serial_disconnect()
232 static void tsa_init_entries_area(struct tsa *tsa, struct tsa_entries_area *area, in tsa_init_entries_area() argument
238 quarter = tsa->si_ram_sz/4; in tsa_init_entries_area()
239 half = tsa->si_ram_sz/2; in tsa_init_entries_area()
245 area->entries_start = tsa->si_ram; in tsa_init_entries_area()
250 area->entries_start = tsa->si_ram + half; in tsa_init_entries_area()
259 area->entries_start = tsa->si_ram; in tsa_init_entries_area()
264 area->entries_start = tsa->si_ram + (2 * quarter); in tsa_init_entries_area()
271 area->entries_start = tsa->si_ram + quarter; in tsa_init_entries_area()
276 area->entries_start = tsa->si_ram + (3 * quarter); in tsa_init_entries_area()
284 static const char *tsa_serial_id2name(struct tsa *tsa, u32 serial_id) in tsa_serial_id2name() argument
299 static u32 tsa_serial_id2csel(struct tsa *tsa, u32 serial_id) in tsa_serial_id2csel() argument
313 static int tsa_add_entry(struct tsa *tsa, struct tsa_entries_area *area, in tsa_add_entry() argument
326 dev_err(tsa->dev, "si ram area full\n"); in tsa_add_entry()
337 val = TSA_SIRAM_ENTRY_BYTE | tsa_serial_id2csel(tsa, serial_id); in tsa_add_entry()
356 static int tsa_of_parse_tdm_route(struct tsa *tsa, struct device_node *tdm_np, in tsa_of_parse_tdm_route() argument
374 dev_err(tsa->dev, "%pOF: failed to read %s\n", tdm_np, route_name); in tsa_of_parse_tdm_route()
378 dev_err(tsa->dev, "%pOF: wrong %s format\n", tdm_np, route_name); in tsa_of_parse_tdm_route()
382 tsa_init_entries_area(tsa, &area, tdms, tdm_id, is_rx); in tsa_of_parse_tdm_route()
388 if (serial_id >= ARRAY_SIZE(tsa->serials)) { in tsa_of_parse_tdm_route()
389 dev_err(tsa->dev, "%pOF: invalid serial id (%u)\n", in tsa_of_parse_tdm_route()
394 serial_name = tsa_serial_id2name(tsa, serial_id); in tsa_of_parse_tdm_route()
396 dev_err(tsa->dev, "%pOF: unsupported serial id (%u)\n", in tsa_of_parse_tdm_route()
401 dev_dbg(tsa->dev, "tdm_id=%u, %s ts %u..%u -> %s\n", in tsa_of_parse_tdm_route()
405 ret = tsa_add_entry(tsa, &area, count, serial_id); in tsa_of_parse_tdm_route()
409 serial_info = &tsa->serials[serial_id].info; in tsa_of_parse_tdm_route()
410 tdm = &tsa->tdm[tdm_id]; in tsa_of_parse_tdm_route()
428 static inline int tsa_of_parse_tdm_rx_route(struct tsa *tsa, in tsa_of_parse_tdm_rx_route() argument
432 return tsa_of_parse_tdm_route(tsa, tdm_np, tdms, tdm_id, true); in tsa_of_parse_tdm_rx_route()
435 static inline int tsa_of_parse_tdm_tx_route(struct tsa *tsa, in tsa_of_parse_tdm_tx_route() argument
439 return tsa_of_parse_tdm_route(tsa, tdm_np, tdms, tdm_id, false); in tsa_of_parse_tdm_tx_route()
442 static int tsa_of_parse_tdms(struct tsa *tsa, struct device_node *np) in tsa_of_parse_tdms() argument
451 tsa->tdms = 0; in tsa_of_parse_tdms()
452 tsa->tdm[0].is_enable = false; in tsa_of_parse_tdms()
453 tsa->tdm[1].is_enable = false; in tsa_of_parse_tdms()
458 dev_err(tsa->dev, "%pOF: failed to read reg\n", tdm_np); in tsa_of_parse_tdms()
464 tsa->tdms |= BIT(TSA_TDMA); in tsa_of_parse_tdms()
467 tsa->tdms |= BIT(TSA_TDMB); in tsa_of_parse_tdms()
470 dev_err(tsa->dev, "%pOF: Invalid tdm_id (%u)\n", tdm_np, in tsa_of_parse_tdms()
480 dev_err(tsa->dev, "%pOF: failed to read reg\n", tdm_np); in tsa_of_parse_tdms()
485 tdm = &tsa->tdm[tdm_id]; in tsa_of_parse_tdms()
492 dev_err(tsa->dev, in tsa_of_parse_tdms()
499 dev_err(tsa->dev, in tsa_of_parse_tdms()
511 dev_err(tsa->dev, in tsa_of_parse_tdms()
518 dev_err(tsa->dev, in tsa_of_parse_tdms()
596 ret = tsa_of_parse_tdm_rx_route(tsa, tdm_np, tsa->tdms, tdm_id); in tsa_of_parse_tdms()
602 ret = tsa_of_parse_tdm_tx_route(tsa, tdm_np, tsa->tdms, tdm_id); in tsa_of_parse_tdms()
614 if (tsa->tdm[i].l1rsync_clk) { in tsa_of_parse_tdms()
615 clk_disable_unprepare(tsa->tdm[i].l1rsync_clk); in tsa_of_parse_tdms()
616 clk_put(tsa->tdm[i].l1rsync_clk); in tsa_of_parse_tdms()
618 if (tsa->tdm[i].l1rclk_clk) { in tsa_of_parse_tdms()
619 clk_disable_unprepare(tsa->tdm[i].l1rclk_clk); in tsa_of_parse_tdms()
620 clk_put(tsa->tdm[i].l1rclk_clk); in tsa_of_parse_tdms()
622 if (tsa->tdm[i].l1tsync_clk) { in tsa_of_parse_tdms()
623 clk_disable_unprepare(tsa->tdm[i].l1rsync_clk); in tsa_of_parse_tdms()
624 clk_put(tsa->tdm[i].l1rsync_clk); in tsa_of_parse_tdms()
626 if (tsa->tdm[i].l1tclk_clk) { in tsa_of_parse_tdms()
627 clk_disable_unprepare(tsa->tdm[i].l1rclk_clk); in tsa_of_parse_tdms()
628 clk_put(tsa->tdm[i].l1rclk_clk); in tsa_of_parse_tdms()
634 static void tsa_init_si_ram(struct tsa *tsa) in tsa_init_si_ram() argument
639 for (i = 0; i < tsa->si_ram_sz; i += 4) in tsa_init_si_ram()
640 tsa_write32(tsa->si_ram + i, TSA_SIRAM_ENTRY_LAST); in tsa_init_si_ram()
647 struct tsa *tsa; in tsa_probe() local
652 tsa = devm_kzalloc(&pdev->dev, sizeof(*tsa), GFP_KERNEL); in tsa_probe()
653 if (!tsa) in tsa_probe()
656 tsa->dev = &pdev->dev; in tsa_probe()
658 for (i = 0; i < ARRAY_SIZE(tsa->serials); i++) in tsa_probe()
659 tsa->serials[i].id = i; in tsa_probe()
661 spin_lock_init(&tsa->lock); in tsa_probe()
663 tsa->si_regs = devm_platform_ioremap_resource_byname(pdev, "si_regs"); in tsa_probe()
664 if (IS_ERR(tsa->si_regs)) in tsa_probe()
665 return PTR_ERR(tsa->si_regs); in tsa_probe()
669 dev_err(tsa->dev, "si_ram resource missing\n"); in tsa_probe()
672 tsa->si_ram_sz = resource_size(res); in tsa_probe()
673 tsa->si_ram = devm_ioremap_resource(&pdev->dev, res); in tsa_probe()
674 if (IS_ERR(tsa->si_ram)) in tsa_probe()
675 return PTR_ERR(tsa->si_ram); in tsa_probe()
677 tsa_init_si_ram(tsa); in tsa_probe()
679 ret = tsa_of_parse_tdms(tsa, np); in tsa_probe()
685 if (tsa->tdm[0].is_enable) in tsa_probe()
686 val |= TSA_SIMODE_TDMA(tsa->tdm[0].simode_tdm); in tsa_probe()
687 if (tsa->tdm[1].is_enable) in tsa_probe()
688 val |= TSA_SIMODE_TDMB(tsa->tdm[1].simode_tdm); in tsa_probe()
690 tsa_clrsetbits32(tsa->si_regs + TSA_SIMODE, in tsa_probe()
696 val = (tsa->tdms == BIT(TSA_TDMA)) ? in tsa_probe()
698 if (tsa->tdms & BIT(TSA_TDMA)) in tsa_probe()
700 if (tsa->tdms & BIT(TSA_TDMB)) in tsa_probe()
702 tsa_write8(tsa->si_regs + TSA_SIGMR, val); in tsa_probe()
704 platform_set_drvdata(pdev, tsa); in tsa_probe()
711 struct tsa *tsa = platform_get_drvdata(pdev); in tsa_remove() local
715 if (tsa->tdm[i].l1rsync_clk) { in tsa_remove()
716 clk_disable_unprepare(tsa->tdm[i].l1rsync_clk); in tsa_remove()
717 clk_put(tsa->tdm[i].l1rsync_clk); in tsa_remove()
719 if (tsa->tdm[i].l1rclk_clk) { in tsa_remove()
720 clk_disable_unprepare(tsa->tdm[i].l1rclk_clk); in tsa_remove()
721 clk_put(tsa->tdm[i].l1rclk_clk); in tsa_remove()
723 if (tsa->tdm[i].l1tsync_clk) { in tsa_remove()
724 clk_disable_unprepare(tsa->tdm[i].l1rsync_clk); in tsa_remove()
725 clk_put(tsa->tdm[i].l1rsync_clk); in tsa_remove()
727 if (tsa->tdm[i].l1tclk_clk) { in tsa_remove()
728 clk_disable_unprepare(tsa->tdm[i].l1rclk_clk); in tsa_remove()
729 clk_put(tsa->tdm[i].l1rclk_clk); in tsa_remove()
736 { .compatible = "fsl,cpm1-tsa" },
743 .name = "fsl-tsa",
757 struct tsa *tsa; in tsa_serial_get_byphandle() local
774 tsa = platform_get_drvdata(pdev); in tsa_serial_get_byphandle()
775 if (!tsa) { in tsa_serial_get_byphandle()
785 if (out_args.args[0] >= ARRAY_SIZE(tsa->serials)) { in tsa_serial_get_byphandle()
790 tsa_serial = &tsa->serials[out_args.args[0]]; in tsa_serial_get_byphandle()
808 struct tsa *tsa = tsa_serial_get_tsa(tsa_serial); in tsa_serial_put() local
810 put_device(tsa->dev); in tsa_serial_put()
845 MODULE_DESCRIPTION("CPM TSA driver");