116 static bool cros_ec_keyb_has_ghosting(struct cros_ec_keyb *ckdev, uint8_t *buf)  in cros_ec_keyb_has_ghosting()  argument
119 	struct device *dev = ckdev->dev;  in cros_ec_keyb_has_ghosting()
120 	uint8_t *valid_keys = ckdev->valid_keys;  in cros_ec_keyb_has_ghosting()
135 	for (col1 = 0; col1 < ckdev->cols; col1++) {  in cros_ec_keyb_has_ghosting()
137 		for (col2 = col1 + 1; col2 < ckdev->cols; col2++) {  in cros_ec_keyb_has_ghosting()
156 static void cros_ec_keyb_process(struct cros_ec_keyb *ckdev,  in cros_ec_keyb_process()  argument
159 	struct input_dev *idev = ckdev->idev;  in cros_ec_keyb_process()
164 	if (ckdev->ghost_filter && cros_ec_keyb_has_ghosting(ckdev, kb_state)) {  in cros_ec_keyb_process()
170 		dev_dbg(ckdev->dev, "ghosting found\n");  in cros_ec_keyb_process()
174 	for (col = 0; col < ckdev->cols; col++) {  in cros_ec_keyb_process()
175 		for (row = 0; row < ckdev->rows; row++) {  in cros_ec_keyb_process()
176 			int pos = MATRIX_SCAN_CODE(row, col, ckdev->row_shift);  in cros_ec_keyb_process()
180 			old_state = ckdev->old_kb_state[col] & (1 << row);  in cros_ec_keyb_process()
182 				dev_dbg(ckdev->dev,  in cros_ec_keyb_process()
190 		ckdev->old_kb_state[col] = kb_state[col];  in cros_ec_keyb_process()
192 	input_sync(ckdev->idev);  in cros_ec_keyb_process()
205 static void cros_ec_keyb_report_bs(struct cros_ec_keyb *ckdev,  in cros_ec_keyb_report_bs()  argument
209 	struct input_dev *idev = ckdev->bs_idev;  in cros_ec_keyb_report_bs()
227 	struct cros_ec_keyb *ckdev = container_of(nb, struct cros_ec_keyb,  in cros_ec_keyb_work()  local
237 	if (queued_during_suspend && !device_may_wakeup(ckdev->dev))  in cros_ec_keyb_work()
240 	switch (ckdev->ec->event_data.event_type) {  in cros_ec_keyb_work()
242 		pm_wakeup_event(ckdev->dev, 0);  in cros_ec_keyb_work()
244 		if (ckdev->ec->event_size != ckdev->cols) {  in cros_ec_keyb_work()
245 			dev_err(ckdev->dev,  in cros_ec_keyb_work()
250 		cros_ec_keyb_process(ckdev,  in cros_ec_keyb_work()
251 				     ckdev->ec->event_data.data.key_matrix,  in cros_ec_keyb_work()
252 				     ckdev->ec->event_size);  in cros_ec_keyb_work()
256 		pm_wakeup_event(ckdev->dev, 0);  in cros_ec_keyb_work()
258 		val = get_unaligned_le32(&ckdev->ec->event_data.data.sysrq);  in cros_ec_keyb_work()
259 		dev_dbg(ckdev->dev, "sysrq code from EC: %#x\n", val);  in cros_ec_keyb_work()
265 		pm_wakeup_event(ckdev->dev, 0);  in cros_ec_keyb_work()
267 		if (ckdev->ec->event_data.event_type == EC_MKBP_EVENT_BUTTON) {  in cros_ec_keyb_work()
269 					&ckdev->ec->event_data.data.buttons);  in cros_ec_keyb_work()
273 					&ckdev->ec->event_data.data.switches);  in cros_ec_keyb_work()
276 		cros_ec_keyb_report_bs(ckdev, ev_type, val);  in cros_ec_keyb_work()
290 static void cros_ec_keyb_compute_valid_keys(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_compute_valid_keys()  argument
293 	int row_shift = ckdev->row_shift;  in cros_ec_keyb_compute_valid_keys()
294 	unsigned short *keymap = ckdev->idev->keycode;  in cros_ec_keyb_compute_valid_keys()
297 	BUG_ON(ckdev->idev->keycodesize != sizeof(*keymap));  in cros_ec_keyb_compute_valid_keys()
299 	for (col = 0; col < ckdev->cols; col++) {  in cros_ec_keyb_compute_valid_keys()
300 		for (row = 0; row < ckdev->rows; row++) {  in cros_ec_keyb_compute_valid_keys()
303 				ckdev->valid_keys[col] |= 1 << row;  in cros_ec_keyb_compute_valid_keys()
305 		dev_dbg(ckdev->dev, "valid_keys[%02d] = 0x%02x\n",  in cros_ec_keyb_compute_valid_keys()
306 			col, ckdev->valid_keys[col]);  in cros_ec_keyb_compute_valid_keys()
388 static int cros_ec_keyb_query_switches(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_query_switches()  argument
390 	struct cros_ec_device *ec_dev = ckdev->ec;  in cros_ec_keyb_query_switches()
400 	cros_ec_keyb_report_bs(ckdev, EV_SW,  in cros_ec_keyb_query_switches()
417 	struct cros_ec_keyb *ckdev = dev_get_drvdata(dev);  in cros_ec_keyb_resume()  local
419 	if (ckdev->bs_idev)  in cros_ec_keyb_resume()
420 		return cros_ec_keyb_query_switches(ckdev);  in cros_ec_keyb_resume()
439 static int cros_ec_keyb_register_bs(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_register_bs()  argument
441 	struct cros_ec_device *ec_dev = ckdev->ec;  in cros_ec_keyb_register_bs()
442 	struct device *dev = ckdev->dev;  in cros_ec_keyb_register_bs()
490 	input_set_drvdata(idev, ckdev);  in cros_ec_keyb_register_bs()
491 	ckdev->bs_idev = idev;  in cros_ec_keyb_register_bs()
500 	ret = cros_ec_keyb_query_switches(ckdev);  in cros_ec_keyb_register_bs()
506 	ret = input_register_device(ckdev->bs_idev);  in cros_ec_keyb_register_bs()
524 static int cros_ec_keyb_register_matrix(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_register_matrix()  argument
526 	struct cros_ec_device *ec_dev = ckdev->ec;  in cros_ec_keyb_register_matrix()
527 	struct device *dev = ckdev->dev;  in cros_ec_keyb_register_matrix()
532 	err = matrix_keypad_parse_properties(dev, &ckdev->rows, &ckdev->cols);  in cros_ec_keyb_register_matrix()
536 	ckdev->valid_keys = devm_kzalloc(dev, ckdev->cols, GFP_KERNEL);  in cros_ec_keyb_register_matrix()
537 	if (!ckdev->valid_keys)  in cros_ec_keyb_register_matrix()
540 	ckdev->old_kb_state = devm_kzalloc(dev, ckdev->cols, GFP_KERNEL);  in cros_ec_keyb_register_matrix()
541 	if (!ckdev->old_kb_state)  in cros_ec_keyb_register_matrix()
565 	ckdev->ghost_filter = of_property_read_bool(dev->of_node,  in cros_ec_keyb_register_matrix()
568 	err = matrix_keypad_build_keymap(NULL, NULL, ckdev->rows, ckdev->cols,  in cros_ec_keyb_register_matrix()
575 	ckdev->row_shift = get_count_order(ckdev->cols);  in cros_ec_keyb_register_matrix()
578 	input_set_drvdata(idev, ckdev);  in cros_ec_keyb_register_matrix()
579 	ckdev->idev = idev;  in cros_ec_keyb_register_matrix()
580 	cros_ec_keyb_compute_valid_keys(ckdev);  in cros_ec_keyb_register_matrix()
582 	err = input_register_device(ckdev->idev);  in cros_ec_keyb_register_matrix()
595 	struct cros_ec_keyb *ckdev;  in cros_ec_keyb_probe()  local
601 	ckdev = devm_kzalloc(dev, sizeof(*ckdev), GFP_KERNEL);  in cros_ec_keyb_probe()
602 	if (!ckdev)  in cros_ec_keyb_probe()
605 	ckdev->ec = ec;  in cros_ec_keyb_probe()
606 	ckdev->dev = dev;  in cros_ec_keyb_probe()
607 	dev_set_drvdata(dev, ckdev);  in cros_ec_keyb_probe()
609 	err = cros_ec_keyb_register_matrix(ckdev);  in cros_ec_keyb_probe()
615 	err = cros_ec_keyb_register_bs(ckdev);  in cros_ec_keyb_probe()
621 	ckdev->notifier.notifier_call = cros_ec_keyb_work;  in cros_ec_keyb_probe()
622 	err = blocking_notifier_chain_register(&ckdev->ec->event_notifier,  in cros_ec_keyb_probe()
623 					       &ckdev->notifier);  in cros_ec_keyb_probe()
629 	device_init_wakeup(ckdev->dev, true);  in cros_ec_keyb_probe()
635 	struct cros_ec_keyb *ckdev = dev_get_drvdata(&pdev->dev);  in cros_ec_keyb_remove()  local
637 	blocking_notifier_chain_unregister(&ckdev->ec->event_notifier,  in cros_ec_keyb_remove()
638 					   &ckdev->notifier);  in cros_ec_keyb_remove()