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()
191 		ckdev->old_kb_state[col] = kb_state[col];  in cros_ec_keyb_process()
193 	input_sync(ckdev->idev);  in cros_ec_keyb_process()
206 static void cros_ec_keyb_report_bs(struct cros_ec_keyb *ckdev,  in cros_ec_keyb_report_bs()  argument
210 	struct input_dev *idev = ckdev->bs_idev;  in cros_ec_keyb_report_bs()
228 	struct cros_ec_keyb *ckdev = container_of(nb, struct cros_ec_keyb,  in cros_ec_keyb_work()  local
238 	if (queued_during_suspend && !device_may_wakeup(ckdev->dev))  in cros_ec_keyb_work()
241 	switch (ckdev->ec->event_data.event_type) {  in cros_ec_keyb_work()
243 		pm_wakeup_event(ckdev->dev, 0);  in cros_ec_keyb_work()
245 		if (ckdev->ec->event_size != ckdev->cols) {  in cros_ec_keyb_work()
246 			dev_err(ckdev->dev,  in cros_ec_keyb_work()
251 		cros_ec_keyb_process(ckdev,  in cros_ec_keyb_work()
252 				     ckdev->ec->event_data.data.key_matrix,  in cros_ec_keyb_work()
253 				     ckdev->ec->event_size);  in cros_ec_keyb_work()
257 		pm_wakeup_event(ckdev->dev, 0);  in cros_ec_keyb_work()
259 		val = get_unaligned_le32(&ckdev->ec->event_data.data.sysrq);  in cros_ec_keyb_work()
260 		dev_dbg(ckdev->dev, "sysrq code from EC: %#x\n", val);  in cros_ec_keyb_work()
266 		pm_wakeup_event(ckdev->dev, 0);  in cros_ec_keyb_work()
268 		if (ckdev->ec->event_data.event_type == EC_MKBP_EVENT_BUTTON) {  in cros_ec_keyb_work()
270 					&ckdev->ec->event_data.data.buttons);  in cros_ec_keyb_work()
274 					&ckdev->ec->event_data.data.switches);  in cros_ec_keyb_work()
277 		cros_ec_keyb_report_bs(ckdev, ev_type, val);  in cros_ec_keyb_work()
291 static void cros_ec_keyb_compute_valid_keys(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_compute_valid_keys()  argument
294 	int row_shift = ckdev->row_shift;  in cros_ec_keyb_compute_valid_keys()
295 	unsigned short *keymap = ckdev->idev->keycode;  in cros_ec_keyb_compute_valid_keys()
298 	BUG_ON(ckdev->idev->keycodesize != sizeof(*keymap));  in cros_ec_keyb_compute_valid_keys()
300 	for (col = 0; col < ckdev->cols; col++) {  in cros_ec_keyb_compute_valid_keys()
301 		for (row = 0; row < ckdev->rows; row++) {  in cros_ec_keyb_compute_valid_keys()
304 				ckdev->valid_keys[col] |= 1 << row;  in cros_ec_keyb_compute_valid_keys()
306 		dev_dbg(ckdev->dev, "valid_keys[%02d] = 0x%02x\n",  in cros_ec_keyb_compute_valid_keys()
307 			col, ckdev->valid_keys[col]);  in cros_ec_keyb_compute_valid_keys()
385 static int cros_ec_keyb_query_switches(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_query_switches()  argument
387 	struct cros_ec_device *ec_dev = ckdev->ec;  in cros_ec_keyb_query_switches()
397 	cros_ec_keyb_report_bs(ckdev, EV_SW,  in cros_ec_keyb_query_switches()
414 	struct cros_ec_keyb *ckdev = dev_get_drvdata(dev);  in cros_ec_keyb_resume()  local
416 	if (ckdev->bs_idev)  in cros_ec_keyb_resume()
417 		return cros_ec_keyb_query_switches(ckdev);  in cros_ec_keyb_resume()
436 static int cros_ec_keyb_register_bs(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_register_bs()  argument
438 	struct cros_ec_device *ec_dev = ckdev->ec;  in cros_ec_keyb_register_bs()
439 	struct device *dev = ckdev->dev;  in cros_ec_keyb_register_bs()
487 	input_set_drvdata(idev, ckdev);  in cros_ec_keyb_register_bs()
488 	ckdev->bs_idev = idev;  in cros_ec_keyb_register_bs()
498 	ret = cros_ec_keyb_query_switches(ckdev);  in cros_ec_keyb_register_bs()
504 	ret = input_register_device(ckdev->bs_idev);  in cros_ec_keyb_register_bs()
522 static int cros_ec_keyb_register_matrix(struct cros_ec_keyb *ckdev)  in cros_ec_keyb_register_matrix()  argument
524 	struct cros_ec_device *ec_dev = ckdev->ec;  in cros_ec_keyb_register_matrix()
525 	struct device *dev = ckdev->dev;  in cros_ec_keyb_register_matrix()
530 	err = matrix_keypad_parse_properties(dev, &ckdev->rows, &ckdev->cols);  in cros_ec_keyb_register_matrix()
534 	ckdev->valid_keys = devm_kzalloc(dev, ckdev->cols, GFP_KERNEL);  in cros_ec_keyb_register_matrix()
535 	if (!ckdev->valid_keys)  in cros_ec_keyb_register_matrix()
538 	ckdev->old_kb_state = devm_kzalloc(dev, ckdev->cols, GFP_KERNEL);  in cros_ec_keyb_register_matrix()
539 	if (!ckdev->old_kb_state)  in cros_ec_keyb_register_matrix()
563 	ckdev->ghost_filter = of_property_read_bool(dev->of_node,  in cros_ec_keyb_register_matrix()
566 	err = matrix_keypad_build_keymap(NULL, NULL, ckdev->rows, ckdev->cols,  in cros_ec_keyb_register_matrix()
573 	ckdev->row_shift = get_count_order(ckdev->cols);  in cros_ec_keyb_register_matrix()
576 	input_set_drvdata(idev, ckdev);  in cros_ec_keyb_register_matrix()
577 	ckdev->idev = idev;  in cros_ec_keyb_register_matrix()
578 	cros_ec_keyb_compute_valid_keys(ckdev);  in cros_ec_keyb_register_matrix()
580 	err = input_register_device(ckdev->idev);  in cros_ec_keyb_register_matrix()
593 	struct cros_ec_keyb *ckdev;  in cros_ec_keyb_probe()  local
599 	ckdev = devm_kzalloc(dev, sizeof(*ckdev), GFP_KERNEL);  in cros_ec_keyb_probe()
600 	if (!ckdev)  in cros_ec_keyb_probe()
603 	ckdev->ec = ec;  in cros_ec_keyb_probe()
604 	ckdev->dev = dev;  in cros_ec_keyb_probe()
605 	dev_set_drvdata(dev, ckdev);  in cros_ec_keyb_probe()
607 	err = cros_ec_keyb_register_matrix(ckdev);  in cros_ec_keyb_probe()
613 	err = cros_ec_keyb_register_bs(ckdev);  in cros_ec_keyb_probe()
619 	ckdev->notifier.notifier_call = cros_ec_keyb_work;  in cros_ec_keyb_probe()
620 	err = blocking_notifier_chain_register(&ckdev->ec->event_notifier,  in cros_ec_keyb_probe()
621 					       &ckdev->notifier);  in cros_ec_keyb_probe()
627 	device_init_wakeup(ckdev->dev, true);  in cros_ec_keyb_probe()
633 	struct cros_ec_keyb *ckdev = dev_get_drvdata(&pdev->dev);  in cros_ec_keyb_remove()  local
635 	blocking_notifier_chain_unregister(&ckdev->ec->event_notifier,  in cros_ec_keyb_remove()
636 					   &ckdev->notifier);  in cros_ec_keyb_remove()