18 #define FTM_FIELD_UPDATE(ftm, offset, mask, val)			\  argument
21 		ftm_read(ftm, offset, &flags);				\
24 		ftm_write(ftm, offset, flags);				\
35 static void ftm_read(struct ftm_quaddec *ftm, uint32_t offset, uint32_t *data)  in ftm_read()  argument
37 	if (ftm->big_endian)  in ftm_read()
38 		*data = ioread32be(ftm->ftm_base + offset);  in ftm_read()
40 		*data = ioread32(ftm->ftm_base + offset);  in ftm_read()
43 static void ftm_write(struct ftm_quaddec *ftm, uint32_t offset, uint32_t data)  in ftm_write()  argument
45 	if (ftm->big_endian)  in ftm_write()
46 		iowrite32be(data, ftm->ftm_base + offset);  in ftm_write()
48 		iowrite32(data, ftm->ftm_base + offset);  in ftm_write()
52 static void ftm_clear_write_protection(struct ftm_quaddec *ftm)  in ftm_clear_write_protection()  argument
57 	ftm_read(ftm, FTM_FMS, &flag);  in ftm_clear_write_protection()
60 		FTM_FIELD_UPDATE(ftm, FTM_MODE, FTM_MODE_WPDIS, 1);  in ftm_clear_write_protection()
63 static void ftm_set_write_protection(struct ftm_quaddec *ftm)  in ftm_set_write_protection()  argument
65 	FTM_FIELD_UPDATE(ftm, FTM_FMS, FTM_FMS_WPEN, 1);  in ftm_set_write_protection()
68 static void ftm_reset_counter(struct ftm_quaddec *ftm)  in ftm_reset_counter()  argument
71 	ftm_write(ftm, FTM_CNT, 0x0);  in ftm_reset_counter()
74 static void ftm_quaddec_init(struct ftm_quaddec *ftm)  in ftm_quaddec_init()  argument
76 	ftm_clear_write_protection(ftm);  in ftm_quaddec_init()
83 	ftm_write(ftm, FTM_MODE, FTM_MODE_FTMEN);  in ftm_quaddec_init()
84 	ftm_write(ftm, FTM_CNTIN, 0x0000);  in ftm_quaddec_init()
85 	ftm_write(ftm, FTM_MOD, 0xffff);  in ftm_quaddec_init()
86 	ftm_write(ftm, FTM_CNT, 0x0);  in ftm_quaddec_init()
88 	ftm_write(ftm, FTM_SC, FTM_SC_PS_1);  in ftm_quaddec_init()
91 	ftm_write(ftm, FTM_QDCTRL, FTM_QDCTRL_QUADEN);  in ftm_quaddec_init()
94 	ftm_write(ftm, FTM_POL, 0x0);  in ftm_quaddec_init()
95 	ftm_write(ftm, FTM_FLTCTRL, 0x0);  in ftm_quaddec_init()
96 	ftm_write(ftm, FTM_SYNCONF, 0x0);  in ftm_quaddec_init()
97 	ftm_write(ftm, FTM_SYNC, 0xffff);  in ftm_quaddec_init()
100 	ftm_set_write_protection(ftm);  in ftm_quaddec_init()
103 static void ftm_quaddec_disable(void *ftm)  in ftm_quaddec_disable()  argument
105 	struct ftm_quaddec *ftm_qua = ftm;  in ftm_quaddec_disable()
121 	struct ftm_quaddec *ftm = counter->priv;  in ftm_quaddec_get_prescaler()  local
124 	ftm_read(ftm, FTM_SC, &scflags);  in ftm_quaddec_get_prescaler()
135 	struct ftm_quaddec *ftm = counter->priv;  in ftm_quaddec_set_prescaler()  local
137 	mutex_lock(&ftm->ftm_quaddec_mutex);  in ftm_quaddec_set_prescaler()
139 	ftm_clear_write_protection(ftm);  in ftm_quaddec_set_prescaler()
140 	FTM_FIELD_UPDATE(ftm, FTM_SC, FTM_SC_PS_MASK, cnt_mode);  in ftm_quaddec_set_prescaler()
141 	ftm_set_write_protection(ftm);  in ftm_quaddec_set_prescaler()
144 	ftm_reset_counter(ftm);  in ftm_quaddec_set_prescaler()
146 	mutex_unlock(&ftm->ftm_quaddec_mutex);  in ftm_quaddec_set_prescaler()
183 	struct ftm_quaddec *const ftm = counter->priv;  in ftm_quaddec_count_read()  local
186 	ftm_read(ftm, FTM_CNT, &cntval);  in ftm_quaddec_count_read()
197 	struct ftm_quaddec *const ftm = counter->priv;  in ftm_quaddec_count_write()  local
200 		dev_warn(&ftm->pdev->dev, "Can only accept '0' as new counter value\n");  in ftm_quaddec_count_write()
204 	ftm_reset_counter(ftm);  in ftm_quaddec_count_write()
277 	struct ftm_quaddec *ftm;  in ftm_quaddec_probe()  local
283 	ftm = devm_kzalloc(&pdev->dev, sizeof(*ftm), GFP_KERNEL);  in ftm_quaddec_probe()
284 	if (!ftm)  in ftm_quaddec_probe()
287 	platform_set_drvdata(pdev, ftm);  in ftm_quaddec_probe()
295 	ftm->pdev = pdev;  in ftm_quaddec_probe()
296 	ftm->big_endian = of_property_read_bool(node, "big-endian");  in ftm_quaddec_probe()
297 	ftm->ftm_base = devm_ioremap(&pdev->dev, io->start, resource_size(io));  in ftm_quaddec_probe()
299 	if (!ftm->ftm_base) {  in ftm_quaddec_probe()
303 	ftm->counter.name = dev_name(&pdev->dev);  in ftm_quaddec_probe()
304 	ftm->counter.parent = &pdev->dev;  in ftm_quaddec_probe()
305 	ftm->counter.ops = &ftm_quaddec_cnt_ops;  in ftm_quaddec_probe()
306 	ftm->counter.counts = &ftm_quaddec_counts;  in ftm_quaddec_probe()
307 	ftm->counter.num_counts = 1;  in ftm_quaddec_probe()
308 	ftm->counter.signals = ftm_quaddec_signals;  in ftm_quaddec_probe()
309 	ftm->counter.num_signals = ARRAY_SIZE(ftm_quaddec_signals);  in ftm_quaddec_probe()
310 	ftm->counter.priv = ftm;  in ftm_quaddec_probe()
312 	mutex_init(&ftm->ftm_quaddec_mutex);  in ftm_quaddec_probe()
314 	ftm_quaddec_init(ftm);  in ftm_quaddec_probe()
316 	ret = devm_add_action_or_reset(&pdev->dev, ftm_quaddec_disable, ftm);  in ftm_quaddec_probe()
320 	ret = devm_counter_register(&pdev->dev, &ftm->counter);  in ftm_quaddec_probe()