hc
2023-12-11 d2ccde1c8e90d38cee87a1b0309ad2827f3fd30d
kernel/drivers/staging/most/dim2/hal.c
....@@ -13,6 +13,7 @@
1313 #include "reg.h"
1414 #include <linux/stddef.h>
1515 #include <linux/kernel.h>
16
+#include <linux/io.h>
1617
1718 /*
1819 * Size factor for isochronous DBR buffer.
....@@ -143,13 +144,13 @@
143144
144145 static void dim2_transfer_madr(u32 val)
145146 {
146
- dimcb_io_write(&g.dim2->MADR, val);
147
+ writel(val, &g.dim2->MADR);
147148
148149 /* wait for transfer completion */
149
- while ((dimcb_io_read(&g.dim2->MCTL) & 1) != 1)
150
+ while ((readl(&g.dim2->MCTL) & 1) != 1)
150151 continue;
151152
152
- dimcb_io_write(&g.dim2->MCTL, 0); /* clear transfer complete */
153
+ writel(0, &g.dim2->MCTL); /* clear transfer complete */
153154 }
154155
155156 static void dim2_clear_dbr(u16 addr, u16 size)
....@@ -159,8 +160,8 @@
159160 u16 const end_addr = addr + size;
160161 u32 const cmd = bit_mask(MADR_WNR_BIT) | bit_mask(MADR_TB_BIT);
161162
162
- dimcb_io_write(&g.dim2->MCTL, 0); /* clear transfer complete */
163
- dimcb_io_write(&g.dim2->MDAT0, 0);
163
+ writel(0, &g.dim2->MCTL); /* clear transfer complete */
164
+ writel(0, &g.dim2->MDAT0);
164165
165166 for (; addr < end_addr; addr++)
166167 dim2_transfer_madr(cmd | addr);
....@@ -170,28 +171,28 @@
170171 {
171172 dim2_transfer_madr(ctr_addr);
172173
173
- return dimcb_io_read((&g.dim2->MDAT0) + mdat_idx);
174
+ return readl((&g.dim2->MDAT0) + mdat_idx);
174175 }
175176
176177 static void dim2_write_ctr_mask(u32 ctr_addr, const u32 *mask, const u32 *value)
177178 {
178179 enum { MADR_WNR_BIT = 31 };
179180
180
- dimcb_io_write(&g.dim2->MCTL, 0); /* clear transfer complete */
181
+ writel(0, &g.dim2->MCTL); /* clear transfer complete */
181182
182183 if (mask[0] != 0)
183
- dimcb_io_write(&g.dim2->MDAT0, value[0]);
184
+ writel(value[0], &g.dim2->MDAT0);
184185 if (mask[1] != 0)
185
- dimcb_io_write(&g.dim2->MDAT1, value[1]);
186
+ writel(value[1], &g.dim2->MDAT1);
186187 if (mask[2] != 0)
187
- dimcb_io_write(&g.dim2->MDAT2, value[2]);
188
+ writel(value[2], &g.dim2->MDAT2);
188189 if (mask[3] != 0)
189
- dimcb_io_write(&g.dim2->MDAT3, value[3]);
190
+ writel(value[3], &g.dim2->MDAT3);
190191
191
- dimcb_io_write(&g.dim2->MDWE0, mask[0]);
192
- dimcb_io_write(&g.dim2->MDWE1, mask[1]);
193
- dimcb_io_write(&g.dim2->MDWE2, mask[2]);
194
- dimcb_io_write(&g.dim2->MDWE3, mask[3]);
192
+ writel(mask[0], &g.dim2->MDWE0);
193
+ writel(mask[1], &g.dim2->MDWE1);
194
+ writel(mask[2], &g.dim2->MDWE2);
195
+ writel(mask[3], &g.dim2->MDWE3);
195196
196197 dim2_transfer_madr(bit_mask(MADR_WNR_BIT) | ctr_addr);
197198 }
....@@ -356,15 +357,13 @@
356357 dim2_configure_cat(AHB_CAT, ch_addr, type, is_tx ? 0 : 1);
357358
358359 /* unmask interrupt for used channel, enable mlb_sys_int[0] interrupt */
359
- dimcb_io_write(&g.dim2->ACMR0,
360
- dimcb_io_read(&g.dim2->ACMR0) | bit_mask(ch_addr));
360
+ writel(readl(&g.dim2->ACMR0) | bit_mask(ch_addr), &g.dim2->ACMR0);
361361 }
362362
363363 static void dim2_clear_channel(u8 ch_addr)
364364 {
365365 /* mask interrupt for used channel, disable mlb_sys_int[0] interrupt */
366
- dimcb_io_write(&g.dim2->ACMR0,
367
- dimcb_io_read(&g.dim2->ACMR0) & ~bit_mask(ch_addr));
366
+ writel(readl(&g.dim2->ACMR0) & ~bit_mask(ch_addr), &g.dim2->ACMR0);
368367
369368 dim2_clear_cat(AHB_CAT, ch_addr);
370369 dim2_clear_adt(ch_addr);
....@@ -373,7 +372,7 @@
373372 dim2_clear_cdt(ch_addr);
374373
375374 /* clear channel status bit */
376
- dimcb_io_write(&g.dim2->ACSR0, bit_mask(ch_addr));
375
+ writel(bit_mask(ch_addr), &g.dim2->ACSR0);
377376 }
378377
379378 /* -------------------------------------------------------------------------- */
....@@ -471,7 +470,7 @@
471470 return true;
472471 }
473472
474
-static inline u16 norm_ctrl_async_buffer_size(u16 buf_size)
473
+u16 dim_norm_ctrl_async_buffer_size(u16 buf_size)
475474 {
476475 u16 const max_size = (u16)ADT1_CTRL_ASYNC_BD_MASK + 1u;
477476
....@@ -517,20 +516,20 @@
517516 static void dim2_cleanup(void)
518517 {
519518 /* disable MediaLB */
520
- dimcb_io_write(&g.dim2->MLBC0, false << MLBC0_MLBEN_BIT);
519
+ writel(false << MLBC0_MLBEN_BIT, &g.dim2->MLBC0);
521520
522521 dim2_clear_ctram();
523522
524523 /* disable mlb_int interrupt */
525
- dimcb_io_write(&g.dim2->MIEN, 0);
524
+ writel(0, &g.dim2->MIEN);
526525
527526 /* clear status for all dma channels */
528
- dimcb_io_write(&g.dim2->ACSR0, 0xFFFFFFFF);
529
- dimcb_io_write(&g.dim2->ACSR1, 0xFFFFFFFF);
527
+ writel(0xFFFFFFFF, &g.dim2->ACSR0);
528
+ writel(0xFFFFFFFF, &g.dim2->ACSR1);
530529
531530 /* mask interrupts for all channels */
532
- dimcb_io_write(&g.dim2->ACMR0, 0);
533
- dimcb_io_write(&g.dim2->ACMR1, 0);
531
+ writel(0, &g.dim2->ACMR0);
532
+ writel(0, &g.dim2->ACMR1);
534533 }
535534
536535 static void dim2_initialize(bool enable_6pin, u8 mlb_clock)
....@@ -538,23 +537,22 @@
538537 dim2_cleanup();
539538
540539 /* configure and enable MediaLB */
541
- dimcb_io_write(&g.dim2->MLBC0,
542
- enable_6pin << MLBC0_MLBPEN_BIT |
543
- mlb_clock << MLBC0_MLBCLK_SHIFT |
544
- g.fcnt << MLBC0_FCNT_SHIFT |
545
- true << MLBC0_MLBEN_BIT);
540
+ writel(enable_6pin << MLBC0_MLBPEN_BIT |
541
+ mlb_clock << MLBC0_MLBCLK_SHIFT |
542
+ g.fcnt << MLBC0_FCNT_SHIFT |
543
+ true << MLBC0_MLBEN_BIT,
544
+ &g.dim2->MLBC0);
546545
547546 /* activate all HBI channels */
548
- dimcb_io_write(&g.dim2->HCMR0, 0xFFFFFFFF);
549
- dimcb_io_write(&g.dim2->HCMR1, 0xFFFFFFFF);
547
+ writel(0xFFFFFFFF, &g.dim2->HCMR0);
548
+ writel(0xFFFFFFFF, &g.dim2->HCMR1);
550549
551550 /* enable HBI */
552
- dimcb_io_write(&g.dim2->HCTL, bit_mask(HCTL_EN_BIT));
551
+ writel(bit_mask(HCTL_EN_BIT), &g.dim2->HCTL);
553552
554553 /* configure DMA */
555
- dimcb_io_write(&g.dim2->ACTL,
556
- ACTL_DMA_MODE_VAL_DMA_MODE_1 << ACTL_DMA_MODE_BIT |
557
- true << ACTL_SCE_BIT);
554
+ writel(ACTL_DMA_MODE_VAL_DMA_MODE_1 << ACTL_DMA_MODE_BIT |
555
+ true << ACTL_SCE_BIT, &g.dim2->ACTL);
558556 }
559557
560558 static bool dim2_is_mlb_locked(void)
....@@ -562,12 +560,12 @@
562560 u32 const mask0 = bit_mask(MLBC0_MLBLK_BIT);
563561 u32 const mask1 = bit_mask(MLBC1_CLKMERR_BIT) |
564562 bit_mask(MLBC1_LOCKERR_BIT);
565
- u32 const c1 = dimcb_io_read(&g.dim2->MLBC1);
563
+ u32 const c1 = readl(&g.dim2->MLBC1);
566564 u32 const nda_mask = (u32)MLBC1_NDA_MASK << MLBC1_NDA_SHIFT;
567565
568
- dimcb_io_write(&g.dim2->MLBC1, c1 & nda_mask);
569
- return (dimcb_io_read(&g.dim2->MLBC1) & mask1) == 0 &&
570
- (dimcb_io_read(&g.dim2->MLBC0) & mask0) != 0;
566
+ writel(c1 & nda_mask, &g.dim2->MLBC1);
567
+ return (readl(&g.dim2->MLBC1) & mask1) == 0 &&
568
+ (readl(&g.dim2->MLBC0) & mask0) != 0;
571569 }
572570
573571 /* -------------------------------------------------------------------------- */
....@@ -590,7 +588,7 @@
590588 dim2_write_ctr_mask(ADT + ch_addr, mask, adt_w);
591589
592590 /* clear channel status bit */
593
- dimcb_io_write(&g.dim2->ACSR0, bit_mask(ch_addr));
591
+ writel(bit_mask(ch_addr), &g.dim2->ACSR0);
594592
595593 return true;
596594 }
....@@ -652,7 +650,7 @@
652650 return dim_on_error(DIM_ERR_BAD_BUFFER_SIZE, "Bad buffer size");
653651
654652 if (ch->packet_length == 0 && ch->bytes_per_frame == 0 &&
655
- buf_size != norm_ctrl_async_buffer_size(buf_size))
653
+ buf_size != dim_norm_ctrl_async_buffer_size(buf_size))
656654 return dim_on_error(DIM_ERR_BAD_BUFFER_SIZE,
657655 "Bad control/async buffer size");
658656
....@@ -776,13 +774,8 @@
776774
777775 void dim_service_mlb_int_irq(void)
778776 {
779
- dimcb_io_write(&g.dim2->MS0, 0);
780
- dimcb_io_write(&g.dim2->MS1, 0);
781
-}
782
-
783
-u16 dim_norm_ctrl_async_buffer_size(u16 buf_size)
784
-{
785
- return norm_ctrl_async_buffer_size(buf_size);
777
+ writel(0, &g.dim2->MS0);
778
+ writel(0, &g.dim2->MS1);
786779 }
787780
788781 /**
....@@ -829,7 +822,7 @@
829822 if (is_tx && !g.atx_dbr.ch_addr) {
830823 g.atx_dbr.ch_addr = ch->addr;
831824 dbrcnt_init(ch->addr, ch->dbr_size);
832
- dimcb_io_write(&g.dim2->MIEN, bit_mask(20));
825
+ writel(bit_mask(20), &g.dim2->MIEN);
833826 }
834827
835828 return ret;
....@@ -896,7 +889,7 @@
896889 return DIM_ERR_DRIVER_NOT_INITIALIZED;
897890
898891 if (ch->addr == g.atx_dbr.ch_addr) {
899
- dimcb_io_write(&g.dim2->MIEN, 0);
892
+ writel(0, &g.dim2->MIEN);
900893 g.atx_dbr.ch_addr = 0;
901894 }
902895