File Index
Files and directories
Sign in
FILE

huawei-gaokun-ec.c

File preview with syntax highlighting.

linux-6.19.14/drivers/platform/arm64/huawei-gaokun-ec.c C
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * huawei-gaokun-ec - An EC driver for HUAWEI Matebook E Go
  4 *
  5 * Copyright (C) 2024-2025 Pengyu Luo <mitltlatltl@gmail.com>
  6 */
  7
  8#include <linux/auxiliary_bus.h>
  9#include <linux/cleanup.h>
 10#include <linux/delay.h>
 11#include <linux/device.h>
 12#include <linux/hwmon.h>
 13#include <linux/hwmon-sysfs.h>
 14#include <linux/i2c.h>
 15#include <linux/input.h>
 16#include <linux/notifier.h>
 17#include <linux/module.h>
 18#include <linux/mutex.h>
 19#include <linux/platform_data/huawei-gaokun-ec.h>
 20
 21#define EC_EVENT		0x06
 22
 23/* Also can be found in ACPI specification 12.3 */
 24#define EC_READ			0x80
 25#define EC_WRITE		0x81
 26#define EC_BURST		0x82
 27#define EC_QUERY		0x84
 28
 29#define EC_FN_LOCK_ON		0x5A
 30#define EC_FN_LOCK_OFF		0x55
 31#define EC_FN_LOCK_READ		0x6B
 32#define EC_FN_LOCK_WRITE	0x6C
 33
 34#define EC_EVENT_LID		0x81
 35
 36#define EC_LID_STATE		0x80
 37#define EC_LID_OPEN		BIT(1)
 38
 39#define EC_TEMP_REG		0x61
 40
 41#define EC_STANDBY_REG		0xB2
 42#define EC_STANDBY_ENTER	0xDB
 43#define EC_STANDBY_EXIT		0xEB
 44
 45enum gaokun_ec_smart_charge_cmd {
 46	SMART_CHARGE_DATA_WRITE = 0xE3,
 47	SMART_CHARGE_DATA_READ,
 48	SMART_CHARGE_ENABLE_WRITE,
 49	SMART_CHARGE_ENABLE_READ,
 50};
 51
 52enum gaokun_ec_ucsi_cmd {
 53	UCSI_REG_WRITE = 0xD2,
 54	UCSI_REG_READ,
 55	UCSI_DATA_WRITE,
 56	UCSI_DATA_READ,
 57};
 58
 59#define UCSI_REG_SIZE		7
 60
 61/*
 62 * For tx, command sequences are arranged as
 63 * {master_cmd, slave_cmd, data_len, data_seq}
 64 */
 65#define REQ_HDR_SIZE		3
 66#define INPUT_SIZE_OFFSET	2
 67#define REQ_LEN(req) (REQ_HDR_SIZE + (req)[INPUT_SIZE_OFFSET])
 68
 69/*
 70 * For rx, data sequences are arranged as
 71 * {status, data_len(unreliable), data_seq}
 72 */
 73#define RESP_HDR_SIZE		2
 74
 75#define MKREQ(REG0, REG1, SIZE, ...)			\
 76{							\
 77	REG0, REG1, SIZE,				\
 78	/* ## will remove comma when SIZE is 0 */	\
 79	## __VA_ARGS__,					\
 80	/* make sure len(pkt[3:]) >= SIZE */		\
 81	[3 + (SIZE)] = 0,				\
 82}
 83
 84#define MKRESP(SIZE)				\
 85{						\
 86	[RESP_HDR_SIZE + (SIZE) - 1] = 0,	\
 87}
 88
 89/* Possible size 1, 4, 20, 24. Most of the time, the size is 1. */
 90static inline void refill_req(u8 *dest, const u8 *src, size_t size)
 91{
 92	memcpy(dest + REQ_HDR_SIZE, src, size);
 93}
 94
 95static inline void refill_req_byte(u8 *dest, const u8 *src)
 96{
 97	dest[REQ_HDR_SIZE] = *src;
 98}
 99
100/* Possible size 1, 2, 4, 7, 20. Most of the time, the size is 1. */
101static inline void extr_resp(u8 *dest, const u8 *src, size_t size)
102{
103	memcpy(dest, src + RESP_HDR_SIZE, size);
104}
105
106static inline void extr_resp_byte(u8 *dest, const u8 *src)
107{
108	*dest = src[RESP_HDR_SIZE];
109}
110
111static inline void *extr_resp_shallow(const u8 *src)
112{
113	return (void *)(src + RESP_HDR_SIZE);
114}
115
116struct gaokun_ec {
117	struct i2c_client *client;
118	struct mutex lock; /* EC transaction lock */
119	struct blocking_notifier_head notifier_list;
120	struct device *hwmon_dev;
121	struct input_dev *idev;
122	bool suspended;
123};
124
125static int gaokun_ec_request(struct gaokun_ec *ec, const u8 *req,
126			     size_t resp_len, u8 *resp)
127{
128	struct i2c_client *client = ec->client;
129	struct i2c_msg msgs[] = {
130		{
131			.addr = client->addr,
132			.flags = client->flags,
133			.len = REQ_LEN(req),
134			.buf = (void *)req,
135		}, {
136			.addr = client->addr,
137			.flags = client->flags | I2C_M_RD,
138			.len = resp_len,
139			.buf = resp,
140		},
141	};
142	int ret;
143
144	guard(mutex)(&ec->lock);
145	ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
146	if (ret != ARRAY_SIZE(msgs)) {
147		dev_err(&client->dev, "I2C transfer error %d\n", ret);
148		goto out_after_break;
149	}
150
151	ret = *resp;
152	if (ret)
153		dev_err(&client->dev, "EC transaction error %d\n", ret);
154
155out_after_break:
156	usleep_range(2000, 2500); /* have a break, ACPI did this */
157
158	return ret;
159}
160
161/* -------------------------------------------------------------------------- */
162/* Common API */
163
164/**
165 * gaokun_ec_read - Read from EC
166 * @ec: The gaokun_ec structure
167 * @req: The sequence to request
168 * @resp_len: The size to read
169 * @resp: The buffer to store response sequence
170 *
171 * This function is used to read data after writing a magic sequence to EC.
172 * All EC operations depend on this function.
173 *
174 * Huawei uses magic sequences everywhere to complete various functions, all
175 * these sequences are passed to ECCD(a ACPI method which is quiet similar
176 * to gaokun_ec_request), there is no good abstraction to generalize these
177 * sequences, so just wrap it for now. Almost all magic sequences are kept
178 * in this file.
179 *
180 * Return: 0 on success or negative error code.
181 */
182int gaokun_ec_read(struct gaokun_ec *ec, const u8 *req,
183		   size_t resp_len, u8 *resp)
184{
185	return gaokun_ec_request(ec, req, resp_len, resp);
186}
187EXPORT_SYMBOL_GPL(gaokun_ec_read);
188
189/**
190 * gaokun_ec_write - Write to EC
191 * @ec: The gaokun_ec structure
192 * @req: The sequence to request
193 *
194 * This function has no big difference from gaokun_ec_read. When caller care
195 * only write status and no actual data are returned, then use it.
196 *
197 * Return: 0 on success or negative error code.
198 */
199int gaokun_ec_write(struct gaokun_ec *ec, const u8 *req)
200{
201	u8 ec_resp[] = MKRESP(0);
202
203	return gaokun_ec_request(ec, req, sizeof(ec_resp), ec_resp);
204}
205EXPORT_SYMBOL_GPL(gaokun_ec_write);
206
207int gaokun_ec_read_byte(struct gaokun_ec *ec, const u8 *req, u8 *byte)
208{
209	int ret;
210	u8 ec_resp[] = MKRESP(sizeof(*byte));
211
212	ret = gaokun_ec_read(ec, req, sizeof(ec_resp), ec_resp);
213	extr_resp_byte(byte, ec_resp);
214
215	return ret;
216}
217EXPORT_SYMBOL_GPL(gaokun_ec_read_byte);
218
219/**
220 * gaokun_ec_register_notify - Register a notifier callback for EC events.
221 * @ec: The gaokun_ec structure
222 * @nb: Notifier block pointer to register
223 *
224 * Return: 0 on success or negative error code.
225 */
226int gaokun_ec_register_notify(struct gaokun_ec *ec, struct notifier_block *nb)
227{
228	return blocking_notifier_chain_register(&ec->notifier_list, nb);
229}
230EXPORT_SYMBOL_GPL(gaokun_ec_register_notify);
231
232/**
233 * gaokun_ec_unregister_notify - Unregister notifier callback for EC events.
234 * @ec: The gaokun_ec structure
235 * @nb: Notifier block pointer to unregister
236 *
237 * Unregister a notifier callback that was previously registered with
238 * gaokun_ec_register_notify().
239 */
240void gaokun_ec_unregister_notify(struct gaokun_ec *ec, struct notifier_block *nb)
241{
242	blocking_notifier_chain_unregister(&ec->notifier_list, nb);
243}
244EXPORT_SYMBOL_GPL(gaokun_ec_unregister_notify);
245
246/* -------------------------------------------------------------------------- */
247/* API for PSY */
248
249/**
250 * gaokun_ec_psy_multi_read - Read contiguous registers
251 * @ec: The gaokun_ec structure
252 * @reg: The start register
253 * @resp_len: The number of registers to be read
254 * @resp: The buffer to store response sequence
255 *
256 * Return: 0 on success or negative error code.
257 */
258int gaokun_ec_psy_multi_read(struct gaokun_ec *ec, u8 reg,
259			     size_t resp_len, u8 *resp)
260{
261	u8 ec_req[] = MKREQ(0x02, EC_READ, 1, 0);
262	u8 ec_resp[] = MKRESP(1);
263	int i, ret;
264
265	for (i = 0; i < resp_len; ++i, reg++) {
266		refill_req_byte(ec_req, &reg);
267		ret = gaokun_ec_read(ec, ec_req, sizeof(ec_resp), ec_resp);
268		if (ret)
269			return ret;
270		extr_resp_byte(&resp[i], ec_resp);
271	}
272
273	return 0;
274}
275EXPORT_SYMBOL_GPL(gaokun_ec_psy_multi_read);
276
277/* Smart charge */
278
279/**
280 * gaokun_ec_psy_get_smart_charge - Get smart charge data from EC
281 * @ec: The gaokun_ec structure
282 * @resp: The buffer to store response sequence (mode, delay, start, end)
283 *
284 * Return: 0 on success or negative error code.
285 */
286int gaokun_ec_psy_get_smart_charge(struct gaokun_ec *ec,
287				   u8 resp[GAOKUN_SMART_CHARGE_DATA_SIZE])
288{
289	/* GBCM */
290	u8 ec_req[] = MKREQ(0x02, SMART_CHARGE_DATA_READ, 0);
291	u8 ec_resp[] = MKRESP(GAOKUN_SMART_CHARGE_DATA_SIZE);
292	int ret;
293
294	ret = gaokun_ec_read(ec, ec_req, sizeof(ec_resp), ec_resp);
295	if (ret)
296		return ret;
297
298	extr_resp(resp, ec_resp, GAOKUN_SMART_CHARGE_DATA_SIZE);
299
300	return 0;
301}
302EXPORT_SYMBOL_GPL(gaokun_ec_psy_get_smart_charge);
303
304static inline bool validate_battery_threshold_range(u8 start, u8 end)
305{
306	return end != 0 && start <= end && end <= 100;
307}
308
309/**
310 * gaokun_ec_psy_set_smart_charge - Set smart charge data
311 * @ec: The gaokun_ec structure
312 * @req: The sequence to request (mode, delay, start, end)
313 *
314 * Return: 0 on success or negative error code.
315 */
316int gaokun_ec_psy_set_smart_charge(struct gaokun_ec *ec,
317				   const u8 req[GAOKUN_SMART_CHARGE_DATA_SIZE])
318{
319	/* SBCM */
320	u8 ec_req[] = MKREQ(0x02, SMART_CHARGE_DATA_WRITE,
321			    GAOKUN_SMART_CHARGE_DATA_SIZE);
322
323	if (!validate_battery_threshold_range(req[2], req[3]))
324		return -EINVAL;
325
326	refill_req(ec_req, req, GAOKUN_SMART_CHARGE_DATA_SIZE);
327
328	return gaokun_ec_write(ec, ec_req);
329}
330EXPORT_SYMBOL_GPL(gaokun_ec_psy_set_smart_charge);
331
332/* Smart charge enable */
333
334/**
335 * gaokun_ec_psy_get_smart_charge_enable - Get smart charge state
336 * @ec: The gaokun_ec structure
337 * @on: The state
338 *
339 * Return: 0 on success or negative error code.
340 */
341int gaokun_ec_psy_get_smart_charge_enable(struct gaokun_ec *ec, bool *on)
342{
343	/* GBAC */
344	u8 ec_req[] = MKREQ(0x02, SMART_CHARGE_ENABLE_READ, 0);
345	u8 state;
346	int ret;
347
348	ret = gaokun_ec_read_byte(ec, ec_req, &state);
349	if (ret)
350		return ret;
351
352	*on = !!state;
353
354	return 0;
355}
356EXPORT_SYMBOL_GPL(gaokun_ec_psy_get_smart_charge_enable);
357
358/**
359 * gaokun_ec_psy_set_smart_charge_enable - Set smart charge state
360 * @ec: The gaokun_ec structure
361 * @on: The state
362 *
363 * Return: 0 on success or negative error code.
364 */
365int gaokun_ec_psy_set_smart_charge_enable(struct gaokun_ec *ec, bool on)
366{
367	/* SBAC */
368	u8 ec_req[] = MKREQ(0x02, SMART_CHARGE_ENABLE_WRITE, 1, on);
369
370	return gaokun_ec_write(ec, ec_req);
371}
372EXPORT_SYMBOL_GPL(gaokun_ec_psy_set_smart_charge_enable);
373
374/* -------------------------------------------------------------------------- */
375/* API for UCSI */
376
377/**
378 * gaokun_ec_ucsi_read - Read UCSI data from EC
379 * @ec: The gaokun_ec structure
380 * @resp: The buffer to store response sequence
381 *
382 * Read CCI and MSGI (used by UCSI subdriver).
383 *
384 * Return: 0 on success or negative error code.
385 */
386int gaokun_ec_ucsi_read(struct gaokun_ec *ec,
387			u8 resp[GAOKUN_UCSI_READ_SIZE])
388{
389	u8 ec_req[] = MKREQ(0x03, UCSI_DATA_READ, 0);
390	u8 ec_resp[] = MKRESP(GAOKUN_UCSI_READ_SIZE);
391	int ret;
392
393	ret = gaokun_ec_read(ec, ec_req, sizeof(ec_resp), ec_resp);
394	if (ret)
395		return ret;
396
397	extr_resp(resp, ec_resp, GAOKUN_UCSI_READ_SIZE);
398	return 0;
399}
400EXPORT_SYMBOL_GPL(gaokun_ec_ucsi_read);
401
402/**
403 * gaokun_ec_ucsi_write - Write UCSI data to EC
404 * @ec: The gaokun_ec structure
405 * @req: The sequence to request
406 *
407 * Write CTRL and MSGO (used by UCSI subdriver).
408 *
409 * Return: 0 on success or negative error code.
410 */
411int gaokun_ec_ucsi_write(struct gaokun_ec *ec,
412			 const u8 req[GAOKUN_UCSI_WRITE_SIZE])
413{
414	u8 ec_req[] = MKREQ(0x03, UCSI_DATA_WRITE, GAOKUN_UCSI_WRITE_SIZE);
415
416	refill_req(ec_req, req, GAOKUN_UCSI_WRITE_SIZE);
417
418	return gaokun_ec_write(ec, ec_req);
419}
420EXPORT_SYMBOL_GPL(gaokun_ec_ucsi_write);
421
422/**
423 * gaokun_ec_ucsi_get_reg - Get UCSI register from EC
424 * @ec: The gaokun_ec structure
425 * @ureg: The gaokun ucsi register
426 *
427 * Get UCSI register data (used by UCSI subdriver).
428 *
429 * Return: 0 on success or negative error code.
430 */
431int gaokun_ec_ucsi_get_reg(struct gaokun_ec *ec, struct gaokun_ucsi_reg *ureg)
432{
433	u8 ec_req[] = MKREQ(0x03, UCSI_REG_READ, 0);
434	u8 ec_resp[] = MKRESP(UCSI_REG_SIZE);
435	int ret;
436
437	ret = gaokun_ec_read(ec, ec_req, sizeof(ec_resp), ec_resp);
438	if (ret)
439		return ret;
440
441	extr_resp((u8 *)ureg, ec_resp, UCSI_REG_SIZE);
442
443	return 0;
444}
445EXPORT_SYMBOL_GPL(gaokun_ec_ucsi_get_reg);
446
447/**
448 * gaokun_ec_ucsi_pan_ack - Ack pin assignment notifications from EC
449 * @ec: The gaokun_ec structure
450 * @port_id: The port id receiving and handling the notifications
451 *
452 * Ack pin assignment notifications (used by UCSI subdriver).
453 *
454 * Return: 0 on success or negative error code.
455 */
456int gaokun_ec_ucsi_pan_ack(struct gaokun_ec *ec, int port_id)
457{
458	u8 ec_req[] = MKREQ(0x03, UCSI_REG_WRITE, 1);
459	u8 data = 1 << port_id;
460
461	if (port_id == GAOKUN_UCSI_NO_PORT_UPDATE)
462		data = 0;
463
464	refill_req_byte(ec_req, &data);
465
466	return gaokun_ec_write(ec, ec_req);
467}
468EXPORT_SYMBOL_GPL(gaokun_ec_ucsi_pan_ack);
469
470/* -------------------------------------------------------------------------- */
471/* EC Sysfs */
472
473/* Fn lock */
474static int gaokun_ec_get_fn_lock(struct gaokun_ec *ec, bool *on)
475{
476	/* GFRS */
477	u8 ec_req[] = MKREQ(0x02, EC_FN_LOCK_READ, 0);
478	int ret;
479	u8 state;
480
481	ret = gaokun_ec_read_byte(ec, ec_req, &state);
482	if (ret)
483		return ret;
484
485	if (state == EC_FN_LOCK_ON)
486		*on = true;
487	else if (state == EC_FN_LOCK_OFF)
488		*on = false;
489	else
490		return -EIO;
491
492	return 0;
493}
494
495static int gaokun_ec_set_fn_lock(struct gaokun_ec *ec, bool on)
496{
497	/* SFRS */
498	u8 ec_req[] = MKREQ(0x02, EC_FN_LOCK_WRITE, 1,
499			    on ? EC_FN_LOCK_ON : EC_FN_LOCK_OFF);
500
501	return gaokun_ec_write(ec, ec_req);
502}
503
504static ssize_t fn_lock_show(struct device *dev,
505			    struct device_attribute *attr,
506			    char *buf)
507{
508	struct gaokun_ec *ec = dev_get_drvdata(dev);
509	bool on;
510	int ret;
511
512	ret = gaokun_ec_get_fn_lock(ec, &on);
513	if (ret)
514		return ret;
515
516	return sysfs_emit(buf, "%d\n", on);
517}
518
519static ssize_t fn_lock_store(struct device *dev,
520			     struct device_attribute *attr,
521			     const char *buf, size_t size)
522{
523	struct gaokun_ec *ec = dev_get_drvdata(dev);
524	bool on;
525	int ret;
526
527	if (kstrtobool(buf, &on))
528		return -EINVAL;
529
530	ret = gaokun_ec_set_fn_lock(ec, on);
531	if (ret)
532		return ret;
533
534	return size;
535}
536
537static DEVICE_ATTR_RW(fn_lock);
538
539static struct attribute *gaokun_ec_attrs[] = {
540	&dev_attr_fn_lock.attr,
541	NULL,
542};
543ATTRIBUTE_GROUPS(gaokun_ec);
544
545/* -------------------------------------------------------------------------- */
546/* Thermal Zone HwMon */
547
548/* Range from 0 to 0x2C, partially valid */
549static const u8 temp_reg[] = {
550	0x05, 0x07, 0x08, 0x0E, 0x0F, 0x12, 0x15, 0x1E,
551	0x1F, 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26,
552	0x27, 0x28, 0x29, 0x2A
553};
554
555static int gaokun_ec_get_temp(struct gaokun_ec *ec, u8 idx, long *temp)
556{
557	/* GTMP */
558	u8 ec_req[] = MKREQ(0x02, EC_TEMP_REG, 1, temp_reg[idx]);
559	u8 ec_resp[] = MKRESP(sizeof(__le16));
560	__le16 *tmp;
561	int ret;
562
563	ret = gaokun_ec_read(ec, ec_req, sizeof(ec_resp), ec_resp);
564	if (ret)
565		return ret;
566
567	tmp = (__le16 *)extr_resp_shallow(ec_resp);
568	*temp = le16_to_cpu(*tmp) * 100; /* convert to HwMon's unit */
569
570	return 0;
571}
572
573static umode_t
574gaokun_ec_hwmon_is_visible(const void *data, enum hwmon_sensor_types type,
575			   u32 attr, int channel)
576{
577	return type == hwmon_temp ? 0444 : 0;
578}
579
580static int
581gaokun_ec_hwmon_read(struct device *dev, enum hwmon_sensor_types type,
582		     u32 attr, int channel, long *val)
583{
584	struct gaokun_ec *ec = dev_get_drvdata(dev);
585
586	if (type == hwmon_temp)
587		return gaokun_ec_get_temp(ec, channel, val);
588
589	return -EINVAL;
590}
591
592static const struct hwmon_ops gaokun_ec_hwmon_ops = {
593	.is_visible = gaokun_ec_hwmon_is_visible,
594	.read = gaokun_ec_hwmon_read,
595};
596
597static u32 gaokun_ec_temp_config[] = {
598	[0 ... ARRAY_SIZE(temp_reg) - 1] = HWMON_T_INPUT,
599	0
600};
601
602static const struct hwmon_channel_info gaokun_ec_temp = {
603	.type = hwmon_temp,
604	.config = gaokun_ec_temp_config,
605};
606
607static const struct hwmon_channel_info * const gaokun_ec_hwmon_info[] = {
608	&gaokun_ec_temp,
609	NULL
610};
611
612static const struct hwmon_chip_info gaokun_ec_hwmon_chip_info = {
613	.ops = &gaokun_ec_hwmon_ops,
614	.info = gaokun_ec_hwmon_info,
615};
616
617/* -------------------------------------------------------------------------- */
618/* Modern Standby */
619
620static int gaokun_ec_suspend(struct device *dev)
621{
622	struct gaokun_ec *ec = dev_get_drvdata(dev);
623	u8 ec_req[] = MKREQ(0x02, EC_STANDBY_REG, 1, EC_STANDBY_ENTER);
624	int ret;
625
626	if (ec->suspended)
627		return 0;
628
629	ret = gaokun_ec_write(ec, ec_req);
630	if (ret)
631		return ret;
632
633	ec->suspended = true;
634
635	return 0;
636}
637
638static int gaokun_ec_resume(struct device *dev)
639{
640	struct gaokun_ec *ec = dev_get_drvdata(dev);
641	u8 ec_req[] = MKREQ(0x02, EC_STANDBY_REG, 1, EC_STANDBY_EXIT);
642	int ret;
643	int i;
644
645	if (!ec->suspended)
646		return 0;
647
648	for (i = 0; i < 3; ++i) {
649		ret = gaokun_ec_write(ec, ec_req);
650		if (ret == 0)
651			break;
652
653		msleep(100); /* EC need time to resume */
654	}
655
656	ec->suspended = false;
657
658	return 0;
659}
660
661static void gaokun_aux_release(struct device *dev)
662{
663	struct auxiliary_device *adev = to_auxiliary_dev(dev);
664
665	of_node_put(dev->of_node);
666	kfree(adev);
667}
668
669static void gaokun_aux_remove(void *data)
670{
671	struct auxiliary_device *adev = data;
672
673	auxiliary_device_delete(adev);
674	auxiliary_device_uninit(adev);
675}
676
677static int gaokun_aux_init(struct device *parent, const char *name,
678			   struct gaokun_ec *ec)
679{
680	struct auxiliary_device *adev;
681	int ret;
682
683	adev = kzalloc(sizeof(*adev), GFP_KERNEL);
684	if (!adev)
685		return -ENOMEM;
686
687	adev->name = name;
688	adev->id = 0;
689	adev->dev.parent = parent;
690	adev->dev.release = gaokun_aux_release;
691	adev->dev.platform_data = ec;
692	/* Allow aux devices to access parent's DT nodes directly */
693	device_set_of_node_from_dev(&adev->dev, parent);
694
695	ret = auxiliary_device_init(adev);
696	if (ret) {
697		of_node_put(adev->dev.of_node);
698		kfree(adev);
699		return ret;
700	}
701
702	ret = auxiliary_device_add(adev);
703	if (ret) {
704		auxiliary_device_uninit(adev);
705		return ret;
706	}
707
708	return devm_add_action_or_reset(parent, gaokun_aux_remove, adev);
709}
710
711/* -------------------------------------------------------------------------- */
712/* EC */
713
714static irqreturn_t gaokun_ec_irq_handler(int irq, void *data)
715{
716	struct gaokun_ec *ec = data;
717	u8 ec_req[] = MKREQ(EC_EVENT, EC_QUERY, 0);
718	u8 status, id;
719	int ret;
720
721	ret = gaokun_ec_read_byte(ec, ec_req, &id);
722	if (ret)
723		return IRQ_HANDLED;
724
725	switch (id) {
726	case 0x0: /* No event */
727		break;
728
729	case EC_EVENT_LID:
730		gaokun_ec_psy_read_byte(ec, EC_LID_STATE, &status);
731		status &= EC_LID_OPEN;
732		input_report_switch(ec->idev, SW_LID, !status);
733		input_sync(ec->idev);
734		break;
735
736	default:
737		blocking_notifier_call_chain(&ec->notifier_list, id, ec);
738	}
739
740	return IRQ_HANDLED;
741}
742
743static int gaokun_ec_probe(struct i2c_client *client)
744{
745	struct device *dev = &client->dev;
746	struct gaokun_ec *ec;
747	int ret;
748
749	ec = devm_kzalloc(dev, sizeof(*ec), GFP_KERNEL);
750	if (!ec)
751		return -ENOMEM;
752
753	ret = devm_mutex_init(dev, &ec->lock);
754	if (ret)
755		return ret;
756
757	ec->client = client;
758	i2c_set_clientdata(client, ec);
759	BLOCKING_INIT_NOTIFIER_HEAD(&ec->notifier_list);
760
761	/* Lid switch */
762	ec->idev = devm_input_allocate_device(dev);
763	if (!ec->idev)
764		return -ENOMEM;
765
766	ec->idev->name = "LID";
767	ec->idev->phys = "gaokun-ec/input0";
768	input_set_capability(ec->idev, EV_SW, SW_LID);
769
770	ret = input_register_device(ec->idev);
771	if (ret)
772		return dev_err_probe(dev, ret, "Failed to register input device\n");
773
774	ret = gaokun_aux_init(dev, GAOKUN_DEV_PSY, ec);
775	if (ret)
776		return ret;
777
778	ret = gaokun_aux_init(dev, GAOKUN_DEV_UCSI, ec);
779	if (ret)
780		return ret;
781
782	ret = devm_request_threaded_irq(dev, client->irq, NULL,
783					gaokun_ec_irq_handler, IRQF_ONESHOT,
784					dev_name(dev), ec);
785	if (ret)
786		return dev_err_probe(dev, ret, "Failed to request IRQ\n");
787
788	ec->hwmon_dev = devm_hwmon_device_register_with_info(dev, "gaokun_ec_hwmon",
789							     ec, &gaokun_ec_hwmon_chip_info, NULL);
790	if (IS_ERR(ec->hwmon_dev))
791		return dev_err_probe(dev, PTR_ERR(ec->hwmon_dev),
792				     "Failed to register hwmon device\n");
793
794	return 0;
795}
796
797static const struct i2c_device_id gaokun_ec_id[] = {
798	{ "gaokun-ec", },
799	{ }
800};
801MODULE_DEVICE_TABLE(i2c, gaokun_ec_id);
802
803static const struct of_device_id gaokun_ec_of_match[] = {
804	{ .compatible = "huawei,gaokun3-ec", },
805	{ }
806};
807MODULE_DEVICE_TABLE(of, gaokun_ec_of_match);
808
809static const struct dev_pm_ops gaokun_ec_pm_ops = {
810	NOIRQ_SYSTEM_SLEEP_PM_OPS(gaokun_ec_suspend, gaokun_ec_resume)
811};
812
813static struct i2c_driver gaokun_ec_driver = {
814	.driver = {
815		.name = "gaokun-ec",
816		.of_match_table = gaokun_ec_of_match,
817		.pm = &gaokun_ec_pm_ops,
818		.dev_groups = gaokun_ec_groups,
819	},
820	.probe = gaokun_ec_probe,
821	.id_table = gaokun_ec_id,
822};
823module_i2c_driver(gaokun_ec_driver);
824
825MODULE_DESCRIPTION("HUAWEI Matebook E Go EC driver");
826MODULE_AUTHOR("Pengyu Luo <mitltlatltl@gmail.com>");
827MODULE_LICENSE("GPL");
~/ Read-only file preview.