| /* SPDX-License-Identifier: GPL-2.0-only */ | 
 | /* | 
 |  * cec - HDMI Consumer Electronics Control support header | 
 |  * | 
 |  * Copyright 2016 Cisco Systems, Inc. and/or its affiliates. All rights reserved. | 
 |  */ | 
 |  | 
 | #ifndef _MEDIA_CEC_H | 
 | #define _MEDIA_CEC_H | 
 |  | 
 | #include <linux/poll.h> | 
 | #include <linux/fs.h> | 
 | #include <linux/device.h> | 
 | #include <linux/cdev.h> | 
 | #include <linux/kthread.h> | 
 | #include <linux/timer.h> | 
 | #include <linux/cec-funcs.h> | 
 | #include <media/rc-core.h> | 
 |  | 
 | #define CEC_CAP_DEFAULTS (CEC_CAP_LOG_ADDRS | CEC_CAP_TRANSMIT | \ | 
 | 			  CEC_CAP_PASSTHROUGH | CEC_CAP_RC) | 
 |  | 
 | /** | 
 |  * struct cec_devnode - cec device node | 
 |  * @dev:	cec device | 
 |  * @cdev:	cec character device | 
 |  * @minor:	device node minor number | 
 |  * @lock:	lock to serialize open/release and registration | 
 |  * @registered:	the device was correctly registered | 
 |  * @unregistered: the device was unregistered | 
 |  * @lock_fhs:	lock to control access to @fhs | 
 |  * @fhs:	the list of open filehandles (cec_fh) | 
 |  * | 
 |  * This structure represents a cec-related device node. | 
 |  * | 
 |  * To add or remove filehandles from @fhs the @lock must be taken first, | 
 |  * followed by @lock_fhs. It is safe to access @fhs if either lock is held. | 
 |  * | 
 |  * The @parent is a physical device. It must be set by core or device drivers | 
 |  * before registering the node. | 
 |  */ | 
 | struct cec_devnode { | 
 | 	/* sysfs */ | 
 | 	struct device dev; | 
 | 	struct cdev cdev; | 
 |  | 
 | 	/* device info */ | 
 | 	int minor; | 
 | 	/* serialize open/release and registration */ | 
 | 	struct mutex lock; | 
 | 	bool registered; | 
 | 	bool unregistered; | 
 | 	/* protect access to fhs */ | 
 | 	struct mutex lock_fhs; | 
 | 	struct list_head fhs; | 
 | }; | 
 |  | 
 | struct cec_adapter; | 
 | struct cec_data; | 
 | struct cec_pin; | 
 | struct cec_notifier; | 
 |  | 
 | struct cec_data { | 
 | 	struct list_head list; | 
 | 	struct list_head xfer_list; | 
 | 	struct cec_adapter *adap; | 
 | 	struct cec_msg msg; | 
 | 	u8 match_len; | 
 | 	u8 match_reply[5]; | 
 | 	struct cec_fh *fh; | 
 | 	struct delayed_work work; | 
 | 	struct completion c; | 
 | 	u8 attempts; | 
 | 	bool blocking; | 
 | 	bool completed; | 
 | }; | 
 |  | 
 | struct cec_msg_entry { | 
 | 	struct list_head	list; | 
 | 	struct cec_msg		msg; | 
 | }; | 
 |  | 
 | struct cec_event_entry { | 
 | 	struct list_head	list; | 
 | 	struct cec_event	ev; | 
 | }; | 
 |  | 
 | #define CEC_NUM_CORE_EVENTS 2 | 
 | #define CEC_NUM_EVENTS CEC_EVENT_PIN_5V_HIGH | 
 |  | 
 | struct cec_fh { | 
 | 	struct list_head	list; | 
 | 	struct list_head	xfer_list; | 
 | 	struct cec_adapter	*adap; | 
 | 	u8			mode_initiator; | 
 | 	u8			mode_follower; | 
 |  | 
 | 	/* Events */ | 
 | 	wait_queue_head_t	wait; | 
 | 	struct mutex		lock; | 
 | 	struct list_head	events[CEC_NUM_EVENTS]; /* queued events */ | 
 | 	u16			queued_events[CEC_NUM_EVENTS]; | 
 | 	unsigned int		total_queued_events; | 
 | 	struct cec_event_entry	core_events[CEC_NUM_CORE_EVENTS]; | 
 | 	struct list_head	msgs; /* queued messages */ | 
 | 	unsigned int		queued_msgs; | 
 | }; | 
 |  | 
 | #define CEC_SIGNAL_FREE_TIME_RETRY		3 | 
 | #define CEC_SIGNAL_FREE_TIME_NEW_INITIATOR	5 | 
 | #define CEC_SIGNAL_FREE_TIME_NEXT_XFER		7 | 
 |  | 
 | /* The nominal data bit period is 2.4 ms */ | 
 | #define CEC_FREE_TIME_TO_USEC(ft)		((ft) * 2400) | 
 |  | 
 | struct cec_adap_ops { | 
 | 	/* Low-level callbacks, called with adap->lock held */ | 
 | 	int (*adap_enable)(struct cec_adapter *adap, bool enable); | 
 | 	int (*adap_monitor_all_enable)(struct cec_adapter *adap, bool enable); | 
 | 	int (*adap_monitor_pin_enable)(struct cec_adapter *adap, bool enable); | 
 | 	int (*adap_log_addr)(struct cec_adapter *adap, u8 logical_addr); | 
 | 	void (*adap_unconfigured)(struct cec_adapter *adap); | 
 | 	int (*adap_transmit)(struct cec_adapter *adap, u8 attempts, | 
 | 			     u32 signal_free_time, struct cec_msg *msg); | 
 | 	void (*adap_nb_transmit_canceled)(struct cec_adapter *adap, | 
 | 					  const struct cec_msg *msg); | 
 | 	void (*adap_status)(struct cec_adapter *adap, struct seq_file *file); | 
 | 	void (*adap_free)(struct cec_adapter *adap); | 
 |  | 
 | 	/* Error injection callbacks, called without adap->lock held */ | 
 | 	int (*error_inj_show)(struct cec_adapter *adap, struct seq_file *sf); | 
 | 	bool (*error_inj_parse_line)(struct cec_adapter *adap, char *line); | 
 |  | 
 | 	/* High-level CEC message callback, called without adap->lock held */ | 
 | 	void (*configured)(struct cec_adapter *adap); | 
 | 	int (*received)(struct cec_adapter *adap, struct cec_msg *msg); | 
 | }; | 
 |  | 
 | /* | 
 |  * The minimum message length you can receive (excepting poll messages) is 2. | 
 |  * With a transfer rate of at most 36 bytes per second this makes 18 messages | 
 |  * per second worst case. | 
 |  * | 
 |  * We queue at most 3 seconds worth of received messages. The CEC specification | 
 |  * requires that messages are replied to within a second, so 3 seconds should | 
 |  * give more than enough margin. Since most messages are actually more than 2 | 
 |  * bytes, this is in practice a lot more than 3 seconds. | 
 |  */ | 
 | #define CEC_MAX_MSG_RX_QUEUE_SZ		(18 * 3) | 
 |  | 
 | /* | 
 |  * The transmit queue is limited to 1 second worth of messages (worst case). | 
 |  * Messages can be transmitted by userspace and kernel space. But for both it | 
 |  * makes no sense to have a lot of messages queued up. One second seems | 
 |  * reasonable. | 
 |  */ | 
 | #define CEC_MAX_MSG_TX_QUEUE_SZ		(18 * 1) | 
 |  | 
 | /** | 
 |  * struct cec_adapter - cec adapter structure | 
 |  * @owner:		module owner | 
 |  * @name:		name of the CEC adapter | 
 |  * @devnode:		device node for the /dev/cecX device | 
 |  * @lock:		mutex controlling access to this structure | 
 |  * @rc:			remote control device | 
 |  * @transmit_queue:	queue of pending transmits | 
 |  * @transmit_queue_sz:	number of pending transmits | 
 |  * @wait_queue:		queue of transmits waiting for a reply | 
 |  * @transmitting:	CEC messages currently being transmitted | 
 |  * @transmit_in_progress: true if a transmit is in progress | 
 |  * @transmit_in_progress_aborted: true if a transmit is in progress is to be | 
 |  *			aborted. This happens if the logical address is | 
 |  *			invalidated while the transmit is ongoing. In that | 
 |  *			case the transmit will finish, but will not retransmit | 
 |  *			and be marked as ABORTED. | 
 |  * @xfer_timeout_ms:	the transfer timeout in ms. | 
 |  *			If 0, then timeout after 2100 ms. | 
 |  * @kthread_config:	kthread used to configure a CEC adapter | 
 |  * @config_completion:	used to signal completion of the config kthread | 
 |  * @kthread:		main CEC processing thread | 
 |  * @kthread_waitq:	main CEC processing wait_queue | 
 |  * @ops:		cec adapter ops | 
 |  * @priv:		cec driver's private data | 
 |  * @capabilities:	cec adapter capabilities | 
 |  * @available_log_addrs: maximum number of available logical addresses | 
 |  * @phys_addr:		the current physical address | 
 |  * @needs_hpd:		if true, then the HDMI HotPlug Detect pin must be high | 
 |  *	in order to transmit or receive CEC messages. This is usually a HW | 
 |  *	limitation. | 
 |  * @is_enabled:		the CEC adapter is enabled | 
 |  * @is_claiming_log_addrs:  true if cec_claim_log_addrs() is running | 
 |  * @is_configuring:	the CEC adapter is configuring (i.e. claiming LAs) | 
 |  * @must_reconfigure:	while configuring, the PA changed, so reclaim LAs | 
 |  * @is_configured:	the CEC adapter is configured (i.e. has claimed LAs) | 
 |  * @cec_pin_is_high:	if true then the CEC pin is high. Only used with the | 
 |  *	CEC pin framework. | 
 |  * @adap_controls_phys_addr: if true, then the CEC adapter controls the | 
 |  *	physical address, i.e. the CEC hardware can detect HPD changes and | 
 |  *	read the EDID and is not dependent on an external HDMI driver. | 
 |  *	Drivers that need this can set this field to true after the | 
 |  *	cec_allocate_adapter() call. | 
 |  * @last_initiator:	the initiator of the last transmitted message. | 
 |  * @monitor_all_cnt:	number of filehandles monitoring all msgs | 
 |  * @monitor_pin_cnt:	number of filehandles monitoring pin changes | 
 |  * @follower_cnt:	number of filehandles in follower mode | 
 |  * @cec_follower:	filehandle of the exclusive follower | 
 |  * @cec_initiator:	filehandle of the exclusive initiator | 
 |  * @passthrough:	if true, then the exclusive follower is in | 
 |  *	passthrough mode. | 
 |  * @log_addrs:		current logical addresses | 
 |  * @conn_info:		current connector info | 
 |  * @tx_timeout_cnt:	count the number of Timed Out transmits. | 
 |  *			Reset to 0 when this is reported in cec_adap_status(). | 
 |  * @tx_low_drive_cnt:	count the number of Low Drive transmits. | 
 |  *			Reset to 0 when this is reported in cec_adap_status(). | 
 |  * @tx_error_cnt:	count the number of Error transmits. | 
 |  *			Reset to 0 when this is reported in cec_adap_status(). | 
 |  * @tx_arb_lost_cnt:	count the number of Arb Lost transmits. | 
 |  *			Reset to 0 when this is reported in cec_adap_status(). | 
 |  * @tx_low_drive_log_cnt: number of logged Low Drive transmits since the | 
 |  *			adapter was enabled. Used to avoid flooding the kernel | 
 |  *			log if this happens a lot. | 
 |  * @tx_error_log_cnt:	number of logged Error transmits since the adapter was | 
 |  *                      enabled. Used to avoid flooding the kernel log if this | 
 |  *                      happens a lot. | 
 |  * @notifier:		CEC notifier | 
 |  * @pin:		CEC pin status struct | 
 |  * @cec_dir:		debugfs cec directory | 
 |  * @sequence:		transmit sequence counter | 
 |  * @input_phys:		remote control input_phys name | 
 |  * | 
 |  * This structure represents a cec adapter. | 
 |  */ | 
 | struct cec_adapter { | 
 | 	struct module *owner; | 
 | 	char name[32]; | 
 | 	struct cec_devnode devnode; | 
 | 	struct mutex lock; | 
 | 	struct rc_dev *rc; | 
 |  | 
 | 	struct list_head transmit_queue; | 
 | 	unsigned int transmit_queue_sz; | 
 | 	struct list_head wait_queue; | 
 | 	struct cec_data *transmitting; | 
 | 	bool transmit_in_progress; | 
 | 	bool transmit_in_progress_aborted; | 
 | 	unsigned int xfer_timeout_ms; | 
 |  | 
 | 	struct task_struct *kthread_config; | 
 | 	struct completion config_completion; | 
 |  | 
 | 	struct task_struct *kthread; | 
 | 	wait_queue_head_t kthread_waitq; | 
 |  | 
 | 	const struct cec_adap_ops *ops; | 
 | 	void *priv; | 
 | 	u32 capabilities; | 
 | 	u8 available_log_addrs; | 
 |  | 
 | 	u16 phys_addr; | 
 | 	bool needs_hpd; | 
 | 	bool is_enabled; | 
 | 	bool is_claiming_log_addrs; | 
 | 	bool is_configuring; | 
 | 	bool must_reconfigure; | 
 | 	bool is_configured; | 
 | 	bool cec_pin_is_high; | 
 | 	bool adap_controls_phys_addr; | 
 | 	u8 last_initiator; | 
 | 	u32 monitor_all_cnt; | 
 | 	u32 monitor_pin_cnt; | 
 | 	u32 follower_cnt; | 
 | 	struct cec_fh *cec_follower; | 
 | 	struct cec_fh *cec_initiator; | 
 | 	bool passthrough; | 
 | 	struct cec_log_addrs log_addrs; | 
 | 	struct cec_connector_info conn_info; | 
 |  | 
 | 	u32 tx_timeout_cnt; | 
 | 	u32 tx_low_drive_cnt; | 
 | 	u32 tx_error_cnt; | 
 | 	u32 tx_arb_lost_cnt; | 
 | 	u32 tx_low_drive_log_cnt; | 
 | 	u32 tx_error_log_cnt; | 
 |  | 
 | #ifdef CONFIG_CEC_NOTIFIER | 
 | 	struct cec_notifier *notifier; | 
 | #endif | 
 | #ifdef CONFIG_CEC_PIN | 
 | 	struct cec_pin *pin; | 
 | #endif | 
 |  | 
 | 	struct dentry *cec_dir; | 
 |  | 
 | 	u32 sequence; | 
 |  | 
 | 	char input_phys[40]; | 
 | }; | 
 |  | 
 | static inline int cec_get_device(struct cec_adapter *adap) | 
 | { | 
 | 	struct cec_devnode *devnode = &adap->devnode; | 
 |  | 
 | 	/* | 
 | 	 * Check if the cec device is available. This needs to be done with | 
 | 	 * the devnode->lock held to prevent an open/unregister race: | 
 | 	 * without the lock, the device could be unregistered and freed between | 
 | 	 * the devnode->registered check and get_device() calls, leading to | 
 | 	 * a crash. | 
 | 	 */ | 
 | 	mutex_lock(&devnode->lock); | 
 | 	/* | 
 | 	 * return ENODEV if the cec device has been removed | 
 | 	 * already or if it is not registered anymore. | 
 | 	 */ | 
 | 	if (!devnode->registered) { | 
 | 		mutex_unlock(&devnode->lock); | 
 | 		return -ENODEV; | 
 | 	} | 
 | 	/* and increase the device refcount */ | 
 | 	get_device(&devnode->dev); | 
 | 	mutex_unlock(&devnode->lock); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static inline void cec_put_device(struct cec_adapter *adap) | 
 | { | 
 | 	put_device(&adap->devnode.dev); | 
 | } | 
 |  | 
 | static inline void *cec_get_drvdata(const struct cec_adapter *adap) | 
 | { | 
 | 	return adap->priv; | 
 | } | 
 |  | 
 | static inline bool cec_has_log_addr(const struct cec_adapter *adap, u8 log_addr) | 
 | { | 
 | 	return adap->log_addrs.log_addr_mask & (1 << log_addr); | 
 | } | 
 |  | 
 | static inline bool cec_is_sink(const struct cec_adapter *adap) | 
 | { | 
 | 	return adap->phys_addr == 0; | 
 | } | 
 |  | 
 | /** | 
 |  * cec_is_registered() - is the CEC adapter registered? | 
 |  * | 
 |  * @adap:	the CEC adapter, may be NULL. | 
 |  * | 
 |  * Return: true if the adapter is registered, false otherwise. | 
 |  */ | 
 | static inline bool cec_is_registered(const struct cec_adapter *adap) | 
 | { | 
 | 	return adap && adap->devnode.registered; | 
 | } | 
 |  | 
 | #define cec_phys_addr_exp(pa) \ | 
 | 	((pa) >> 12), ((pa) >> 8) & 0xf, ((pa) >> 4) & 0xf, (pa) & 0xf | 
 |  | 
 | struct edid; | 
 | struct drm_connector; | 
 |  | 
 | #if IS_REACHABLE(CONFIG_CEC_CORE) | 
 | struct cec_adapter *cec_allocate_adapter(const struct cec_adap_ops *ops, | 
 | 		void *priv, const char *name, u32 caps, u8 available_las); | 
 | int cec_register_adapter(struct cec_adapter *adap, struct device *parent); | 
 | void cec_unregister_adapter(struct cec_adapter *adap); | 
 | void cec_delete_adapter(struct cec_adapter *adap); | 
 |  | 
 | int cec_s_log_addrs(struct cec_adapter *adap, struct cec_log_addrs *log_addrs, | 
 | 		    bool block); | 
 | void cec_s_phys_addr(struct cec_adapter *adap, u16 phys_addr, | 
 | 		     bool block); | 
 | void cec_s_phys_addr_from_edid(struct cec_adapter *adap, | 
 | 			       const struct edid *edid); | 
 | void cec_s_conn_info(struct cec_adapter *adap, | 
 | 		     const struct cec_connector_info *conn_info); | 
 | int cec_transmit_msg(struct cec_adapter *adap, struct cec_msg *msg, | 
 | 		     bool block); | 
 |  | 
 | /* Called by the adapter */ | 
 | void cec_transmit_done_ts(struct cec_adapter *adap, u8 status, | 
 | 			  u8 arb_lost_cnt, u8 nack_cnt, u8 low_drive_cnt, | 
 | 			  u8 error_cnt, ktime_t ts); | 
 |  | 
 | static inline void cec_transmit_done(struct cec_adapter *adap, u8 status, | 
 | 				     u8 arb_lost_cnt, u8 nack_cnt, | 
 | 				     u8 low_drive_cnt, u8 error_cnt) | 
 | { | 
 | 	cec_transmit_done_ts(adap, status, arb_lost_cnt, nack_cnt, | 
 | 			     low_drive_cnt, error_cnt, ktime_get()); | 
 | } | 
 | /* | 
 |  * Simplified version of cec_transmit_done for hardware that doesn't retry | 
 |  * failed transmits. So this is always just one attempt in which case | 
 |  * the status is sufficient. | 
 |  */ | 
 | void cec_transmit_attempt_done_ts(struct cec_adapter *adap, | 
 | 				  u8 status, ktime_t ts); | 
 |  | 
 | static inline void cec_transmit_attempt_done(struct cec_adapter *adap, | 
 | 					     u8 status) | 
 | { | 
 | 	cec_transmit_attempt_done_ts(adap, status, ktime_get()); | 
 | } | 
 |  | 
 | void cec_received_msg_ts(struct cec_adapter *adap, | 
 | 			 struct cec_msg *msg, ktime_t ts); | 
 |  | 
 | static inline void cec_received_msg(struct cec_adapter *adap, | 
 | 				    struct cec_msg *msg) | 
 | { | 
 | 	cec_received_msg_ts(adap, msg, ktime_get()); | 
 | } | 
 |  | 
 | /** | 
 |  * cec_queue_pin_cec_event() - queue a CEC pin event with a given timestamp. | 
 |  * | 
 |  * @adap:	pointer to the cec adapter | 
 |  * @is_high:	when true the CEC pin is high, otherwise it is low | 
 |  * @dropped_events: when true some events were dropped | 
 |  * @ts:		the timestamp for this event | 
 |  * | 
 |  */ | 
 | void cec_queue_pin_cec_event(struct cec_adapter *adap, bool is_high, | 
 | 			     bool dropped_events, ktime_t ts); | 
 |  | 
 | /** | 
 |  * cec_queue_pin_hpd_event() - queue a pin event with a given timestamp. | 
 |  * | 
 |  * @adap:	pointer to the cec adapter | 
 |  * @is_high:	when true the HPD pin is high, otherwise it is low | 
 |  * @ts:		the timestamp for this event | 
 |  * | 
 |  */ | 
 | void cec_queue_pin_hpd_event(struct cec_adapter *adap, bool is_high, ktime_t ts); | 
 |  | 
 | /** | 
 |  * cec_queue_pin_5v_event() - queue a pin event with a given timestamp. | 
 |  * | 
 |  * @adap:	pointer to the cec adapter | 
 |  * @is_high:	when true the 5V pin is high, otherwise it is low | 
 |  * @ts:		the timestamp for this event | 
 |  * | 
 |  */ | 
 | void cec_queue_pin_5v_event(struct cec_adapter *adap, bool is_high, ktime_t ts); | 
 |  | 
 | /** | 
 |  * cec_get_edid_phys_addr() - find and return the physical address | 
 |  * | 
 |  * @edid:	pointer to the EDID data | 
 |  * @size:	size in bytes of the EDID data | 
 |  * @offset:	If not %NULL then the location of the physical address | 
 |  *		bytes in the EDID will be returned here. This is set to 0 | 
 |  *		if there is no physical address found. | 
 |  * | 
 |  * Return: the physical address or CEC_PHYS_ADDR_INVALID if there is none. | 
 |  */ | 
 | u16 cec_get_edid_phys_addr(const u8 *edid, unsigned int size, | 
 | 			   unsigned int *offset); | 
 |  | 
 | void cec_fill_conn_info_from_drm(struct cec_connector_info *conn_info, | 
 | 				 const struct drm_connector *connector); | 
 |  | 
 | #else | 
 |  | 
 | static inline int cec_register_adapter(struct cec_adapter *adap, | 
 | 				       struct device *parent) | 
 | { | 
 | 	return 0; | 
 | } | 
 |  | 
 | static inline void cec_unregister_adapter(struct cec_adapter *adap) | 
 | { | 
 | } | 
 |  | 
 | static inline void cec_delete_adapter(struct cec_adapter *adap) | 
 | { | 
 | } | 
 |  | 
 | static inline void cec_s_phys_addr(struct cec_adapter *adap, u16 phys_addr, | 
 | 				   bool block) | 
 | { | 
 | } | 
 |  | 
 | static inline void cec_s_phys_addr_from_edid(struct cec_adapter *adap, | 
 | 					     const struct edid *edid) | 
 | { | 
 | } | 
 |  | 
 | static inline u16 cec_get_edid_phys_addr(const u8 *edid, unsigned int size, | 
 | 					 unsigned int *offset) | 
 | { | 
 | 	if (offset) | 
 | 		*offset = 0; | 
 | 	return CEC_PHYS_ADDR_INVALID; | 
 | } | 
 |  | 
 | static inline void cec_s_conn_info(struct cec_adapter *adap, | 
 | 				   const struct cec_connector_info *conn_info) | 
 | { | 
 | } | 
 |  | 
 | static inline void | 
 | cec_fill_conn_info_from_drm(struct cec_connector_info *conn_info, | 
 | 			    const struct drm_connector *connector) | 
 | { | 
 | 	memset(conn_info, 0, sizeof(*conn_info)); | 
 | } | 
 |  | 
 | #endif | 
 |  | 
 | /** | 
 |  * cec_phys_addr_invalidate() - set the physical address to INVALID | 
 |  * | 
 |  * @adap:	the CEC adapter | 
 |  * | 
 |  * This is a simple helper function to invalidate the physical | 
 |  * address. | 
 |  */ | 
 | static inline void cec_phys_addr_invalidate(struct cec_adapter *adap) | 
 | { | 
 | 	cec_s_phys_addr(adap, CEC_PHYS_ADDR_INVALID, false); | 
 | } | 
 |  | 
 | /** | 
 |  * cec_get_edid_spa_location() - find location of the Source Physical Address | 
 |  * | 
 |  * @edid: the EDID | 
 |  * @size: the size of the EDID | 
 |  * | 
 |  * This EDID is expected to be a CEA-861 compliant, which means that there are | 
 |  * at least two blocks and one or more of the extensions blocks are CEA-861 | 
 |  * blocks. | 
 |  * | 
 |  * The returned location is guaranteed to be <= size-2. | 
 |  * | 
 |  * This is an inline function since it is used by both CEC and V4L2. | 
 |  * Ideally this would go in a module shared by both, but it is overkill to do | 
 |  * that for just a single function. | 
 |  */ | 
 | static inline unsigned int cec_get_edid_spa_location(const u8 *edid, | 
 | 						     unsigned int size) | 
 | { | 
 | 	unsigned int blocks = size / 128; | 
 | 	unsigned int block; | 
 | 	u8 d; | 
 |  | 
 | 	/* Sanity check: at least 2 blocks and a multiple of the block size */ | 
 | 	if (blocks < 2 || size % 128) | 
 | 		return 0; | 
 |  | 
 | 	/* | 
 | 	 * If there are fewer extension blocks than the size, then update | 
 | 	 * 'blocks'. It is allowed to have more extension blocks than the size, | 
 | 	 * since some hardware can only read e.g. 256 bytes of the EDID, even | 
 | 	 * though more blocks are present. The first CEA-861 extension block | 
 | 	 * should normally be in block 1 anyway. | 
 | 	 */ | 
 | 	if (edid[0x7e] + 1 < blocks) | 
 | 		blocks = edid[0x7e] + 1; | 
 |  | 
 | 	for (block = 1; block < blocks; block++) { | 
 | 		unsigned int offset = block * 128; | 
 |  | 
 | 		/* Skip any non-CEA-861 extension blocks */ | 
 | 		if (edid[offset] != 0x02 || edid[offset + 1] != 0x03) | 
 | 			continue; | 
 |  | 
 | 		/* search Vendor Specific Data Block (tag 3) */ | 
 | 		d = edid[offset + 2] & 0x7f; | 
 | 		/* Check if there are Data Blocks */ | 
 | 		if (d <= 4) | 
 | 			continue; | 
 | 		if (d > 4) { | 
 | 			unsigned int i = offset + 4; | 
 | 			unsigned int end = offset + d; | 
 |  | 
 | 			/* Note: 'end' is always < 'size' */ | 
 | 			do { | 
 | 				u8 tag = edid[i] >> 5; | 
 | 				u8 len = edid[i] & 0x1f; | 
 |  | 
 | 				if (tag == 3 && len >= 5 && i + len <= end && | 
 | 				    edid[i + 1] == 0x03 && | 
 | 				    edid[i + 2] == 0x0c && | 
 | 				    edid[i + 3] == 0x00) | 
 | 					return i + 4; | 
 | 				i += len + 1; | 
 | 			} while (i < end); | 
 | 		} | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | #endif /* _MEDIA_CEC_H */ |