85 static int bcm_kp_get_keycode(struct bcm_kp *kp, int row, int col)  in bcm_kp_get_keycode()  argument
87 	unsigned int row_shift = get_count_order(kp->n_cols);  in bcm_kp_get_keycode()
88 	unsigned short *keymap = kp->input_dev->keycode;  in bcm_kp_get_keycode()
93 static void bcm_kp_report_keys(struct bcm_kp *kp, int reg_num, int pull_mode)  in bcm_kp_report_keys()  argument
102 	writel(0xFFFFFFFF, kp->base + KPICRN_OFFSET(reg_num));  in bcm_kp_report_keys()
104 	state = readl(kp->base + KPSSRN_OFFSET(reg_num));  in bcm_kp_report_keys()
105 	change = kp->last_state[reg_num] ^ state;  in bcm_kp_report_keys()
106 	kp->last_state[reg_num] = state;  in bcm_kp_report_keys()
114 		keycode = bcm_kp_get_keycode(kp, row, col);  in bcm_kp_report_keys()
115 		input_report_key(kp->input_dev, keycode, key_press);  in bcm_kp_report_keys()
121 	struct bcm_kp *kp = dev_id;  in bcm_kp_isr_thread()  local
122 	int pull_mode = (kp->kpcr >> KPCR_MODE_SHIFT) & KPCR_MODE_MASK;  in bcm_kp_isr_thread()
126 		bcm_kp_report_keys(kp, reg_num, pull_mode);  in bcm_kp_isr_thread()
128 	input_sync(kp->input_dev);  in bcm_kp_isr_thread()
133 static int bcm_kp_start(struct bcm_kp *kp)  in bcm_kp_start()  argument
137 	if (kp->clk) {  in bcm_kp_start()
138 		error = clk_prepare_enable(kp->clk);  in bcm_kp_start()
143 	writel(kp->kpior, kp->base + KPIOR_OFFSET);  in bcm_kp_start()
145 	writel(kp->imr0_val, kp->base + KPIMR0_OFFSET);  in bcm_kp_start()
146 	writel(kp->imr1_val, kp->base + KPIMR1_OFFSET);  in bcm_kp_start()
148 	writel(kp->kpemr, kp->base + KPEMR0_OFFSET);  in bcm_kp_start()
149 	writel(kp->kpemr, kp->base + KPEMR1_OFFSET);  in bcm_kp_start()
150 	writel(kp->kpemr, kp->base + KPEMR2_OFFSET);  in bcm_kp_start()
151 	writel(kp->kpemr, kp->base + KPEMR3_OFFSET);  in bcm_kp_start()
153 	writel(0xFFFFFFFF, kp->base + KPICR0_OFFSET);  in bcm_kp_start()
154 	writel(0xFFFFFFFF, kp->base + KPICR1_OFFSET);  in bcm_kp_start()
156 	kp->last_state[0] = readl(kp->base + KPSSR0_OFFSET);  in bcm_kp_start()
157 	kp->last_state[0] = readl(kp->base + KPSSR1_OFFSET);  in bcm_kp_start()
159 	writel(kp->kpcr | KPCR_ENABLE, kp->base + KPCR_OFFSET);  in bcm_kp_start()
164 static void bcm_kp_stop(const struct bcm_kp *kp)  in bcm_kp_stop()  argument
168 	val = readl(kp->base + KPCR_OFFSET);  in bcm_kp_stop()
170 	writel(0, kp->base + KPCR_OFFSET);  in bcm_kp_stop()
171 	writel(0, kp->base + KPIMR0_OFFSET);  in bcm_kp_stop()
172 	writel(0, kp->base + KPIMR1_OFFSET);  in bcm_kp_stop()
173 	writel(0xFFFFFFFF, kp->base + KPICR0_OFFSET);  in bcm_kp_stop()
174 	writel(0xFFFFFFFF, kp->base + KPICR1_OFFSET);  in bcm_kp_stop()
176 	clk_disable_unprepare(kp->clk);  in bcm_kp_stop()
181 	struct bcm_kp *kp = input_get_drvdata(dev);  in bcm_kp_open()  local
183 	return bcm_kp_start(kp);  in bcm_kp_open()
188 	struct bcm_kp *kp = input_get_drvdata(dev);  in bcm_kp_close()  local
190 	bcm_kp_stop(kp);  in bcm_kp_close()
193 static int bcm_kp_matrix_key_parse_dt(struct bcm_kp *kp)  in bcm_kp_matrix_key_parse_dt()  argument
195 	struct device *dev = kp->input_dev->dev.parent;  in bcm_kp_matrix_key_parse_dt()
203 	kp->kpcr = KPCR_STATUSFILTERENABLE | KPCR_COLFILTERENABLE;  in bcm_kp_matrix_key_parse_dt()
205 	error = matrix_keypad_parse_properties(dev, &kp->n_rows, &kp->n_cols);  in bcm_kp_matrix_key_parse_dt()
212 	kp->kpcr |= (kp->n_rows - 1) << KPCR_ROWWIDTH_SHIFT;  in bcm_kp_matrix_key_parse_dt()
215 	kp->kpcr |= (kp->n_cols - 1) << KPCR_COLUMNWIDTH_SHIFT;  in bcm_kp_matrix_key_parse_dt()
224 	col_mask = (1 << (kp->n_cols)) - 1;  in bcm_kp_matrix_key_parse_dt()
225 	num_rows = kp->n_rows;  in bcm_kp_matrix_key_parse_dt()
228 	kp->imr0_val = col_mask;  in bcm_kp_matrix_key_parse_dt()
232 		kp->imr0_val |= kp->imr0_val << MAX_COLS;  in bcm_kp_matrix_key_parse_dt()
235 	kp->imr1_val = 0;  in bcm_kp_matrix_key_parse_dt()
237 		kp->imr1_val = col_mask;  in bcm_kp_matrix_key_parse_dt()
239 			kp->imr1_val |= kp->imr1_val << MAX_COLS;  in bcm_kp_matrix_key_parse_dt()
244 	kp->kpemr = 0;  in bcm_kp_matrix_key_parse_dt()
246 		kp->kpemr |= (KPEMR_EDGETYPE_BOTH << i);  in bcm_kp_matrix_key_parse_dt()
260 	kp->kpcr |= dt_val << KPCR_STATUSFILTERTYPE_SHIFT;  in bcm_kp_matrix_key_parse_dt()
274 	kp->kpcr |= dt_val << KPCR_COLFILTERTYPE_SHIFT;  in bcm_kp_matrix_key_parse_dt()
285 		kp->kpior = ((1 << kp->n_rows) - 1) <<  in bcm_kp_matrix_key_parse_dt()
288 		kp->kpior = ((1 << kp->n_cols) - 1) <<  in bcm_kp_matrix_key_parse_dt()
296 		kp->kpcr |= KPCR_MODE;  in bcm_kp_matrix_key_parse_dt()
299 		kp->n_rows, kp->n_cols,  in bcm_kp_matrix_key_parse_dt()
300 		kp->kpcr, kp->kpior, kp->kpemr);  in bcm_kp_matrix_key_parse_dt()
308 	struct bcm_kp *kp;  in bcm_kp_probe()  local
312 	kp = devm_kzalloc(&pdev->dev, sizeof(*kp), GFP_KERNEL);  in bcm_kp_probe()
313 	if (!kp)  in bcm_kp_probe()
339 	input_set_drvdata(input_dev, kp);  in bcm_kp_probe()
341 	kp->input_dev = input_dev;  in bcm_kp_probe()
343 	error = bcm_kp_matrix_key_parse_dt(kp);  in bcm_kp_probe()
348 					   kp->n_rows, kp->n_cols,  in bcm_kp_probe()
355 	kp->base = devm_platform_ioremap_resource(pdev, 0);  in bcm_kp_probe()
356 	if (IS_ERR(kp->base))  in bcm_kp_probe()
357 		return PTR_ERR(kp->base);  in bcm_kp_probe()
360 	kp->clk = devm_clk_get_optional(&pdev->dev, "peri_clk");  in bcm_kp_probe()
361 	if (IS_ERR(kp->clk)) {  in bcm_kp_probe()
362 		return dev_err_probe(&pdev->dev, PTR_ERR(kp->clk), "Failed to get clock\n");  in bcm_kp_probe()
363 	} else if (!kp->clk) {  in bcm_kp_probe()
374 		actual_rate = clk_round_rate(kp->clk, desired_rate);  in bcm_kp_probe()
378 		error = clk_set_rate(kp->clk, actual_rate);  in bcm_kp_probe()
382 		error = clk_prepare_enable(kp->clk);  in bcm_kp_probe()
388 	bcm_kp_stop(kp);  in bcm_kp_probe()
390 	kp->irq = platform_get_irq(pdev, 0);  in bcm_kp_probe()
391 	if (kp->irq < 0)  in bcm_kp_probe()
394 	error = devm_request_threaded_irq(&pdev->dev, kp->irq,  in bcm_kp_probe()
396 					  IRQF_ONESHOT, pdev->name, kp);  in bcm_kp_probe()