Lines Matching refs:mhdp
18 static int cdns_mhdp_secure_mailbox_read(struct cdns_mhdp_device *mhdp) in cdns_mhdp_secure_mailbox_read() argument
22 WARN_ON(!mutex_is_locked(&mhdp->mbox_mutex)); in cdns_mhdp_secure_mailbox_read()
24 ret = readx_poll_timeout(readl, mhdp->sapb_regs + CDNS_MAILBOX_EMPTY, in cdns_mhdp_secure_mailbox_read()
30 return readl(mhdp->sapb_regs + CDNS_MAILBOX_RX_DATA) & 0xff; in cdns_mhdp_secure_mailbox_read()
33 static int cdns_mhdp_secure_mailbox_write(struct cdns_mhdp_device *mhdp, in cdns_mhdp_secure_mailbox_write() argument
38 WARN_ON(!mutex_is_locked(&mhdp->mbox_mutex)); in cdns_mhdp_secure_mailbox_write()
40 ret = readx_poll_timeout(readl, mhdp->sapb_regs + CDNS_MAILBOX_FULL, in cdns_mhdp_secure_mailbox_write()
46 writel(val, mhdp->sapb_regs + CDNS_MAILBOX_TX_DATA); in cdns_mhdp_secure_mailbox_write()
51 static int cdns_mhdp_secure_mailbox_recv_header(struct cdns_mhdp_device *mhdp, in cdns_mhdp_secure_mailbox_recv_header() argument
62 ret = cdns_mhdp_secure_mailbox_read(mhdp); in cdns_mhdp_secure_mailbox_recv_header()
74 if (cdns_mhdp_secure_mailbox_read(mhdp) < 0) in cdns_mhdp_secure_mailbox_recv_header()
82 static int cdns_mhdp_secure_mailbox_recv_data(struct cdns_mhdp_device *mhdp, in cdns_mhdp_secure_mailbox_recv_data() argument
89 ret = cdns_mhdp_secure_mailbox_read(mhdp); in cdns_mhdp_secure_mailbox_recv_data()
99 static int cdns_mhdp_secure_mailbox_send(struct cdns_mhdp_device *mhdp, in cdns_mhdp_secure_mailbox_send() argument
114 ret = cdns_mhdp_secure_mailbox_write(mhdp, header[i]); in cdns_mhdp_secure_mailbox_send()
120 ret = cdns_mhdp_secure_mailbox_write(mhdp, message[i]); in cdns_mhdp_secure_mailbox_send()
128 static int cdns_mhdp_hdcp_get_status(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_get_status() argument
134 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_get_status()
135 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_get_status()
140 ret = cdns_mhdp_secure_mailbox_recv_header(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_get_status()
146 ret = cdns_mhdp_secure_mailbox_recv_data(mhdp, hdcp_status, in cdns_mhdp_hdcp_get_status()
154 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_get_status()
159 static u8 cdns_mhdp_hdcp_handle_status(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_handle_status() argument
165 dev_dbg(mhdp->dev, "HDCP Error = %d", err); in cdns_mhdp_hdcp_handle_status()
170 static int cdns_mhdp_hdcp_rx_id_valid_response(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_rx_id_valid_response() argument
175 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_rx_id_valid_response()
176 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_rx_id_valid_response()
179 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_rx_id_valid_response()
184 static int cdns_mhdp_hdcp_rx_id_valid(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_rx_id_valid() argument
191 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_rx_id_valid()
192 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_rx_id_valid()
197 ret = cdns_mhdp_secure_mailbox_recv_header(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_rx_id_valid()
203 ret = cdns_mhdp_secure_mailbox_recv_data(mhdp, rec_id_hdr, 2); in cdns_mhdp_hdcp_rx_id_valid()
209 ret = cdns_mhdp_secure_mailbox_recv_data(mhdp, hdcp_rx_id, 5 * *recv_num); in cdns_mhdp_hdcp_rx_id_valid()
212 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_rx_id_valid()
217 static int cdns_mhdp_hdcp_km_stored_resp(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_km_stored_resp() argument
222 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_km_stored_resp()
223 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_km_stored_resp()
225 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_km_stored_resp()
230 static int cdns_mhdp_hdcp_tx_is_km_stored(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_tx_is_km_stored() argument
235 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_tx_is_km_stored()
236 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_tx_is_km_stored()
241 ret = cdns_mhdp_secure_mailbox_recv_header(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_tx_is_km_stored()
247 ret = cdns_mhdp_secure_mailbox_recv_data(mhdp, resp, size); in cdns_mhdp_hdcp_tx_is_km_stored()
249 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_tx_is_km_stored()
254 static int cdns_mhdp_hdcp_tx_config(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_tx_config() argument
259 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_tx_config()
260 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_tx_config()
262 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_tx_config()
267 static int cdns_mhdp_hdcp_set_config(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_set_config() argument
277 cdns_mhdp_hdcp_tx_config(mhdp, hdcp_cfg); in cdns_mhdp_hdcp_set_config()
278 ret_event = cdns_mhdp_wait_for_sw_event(mhdp, CDNS_HDCP_TX_STATUS); in cdns_mhdp_hdcp_set_config()
282 ret = cdns_mhdp_hdcp_get_status(mhdp, &hdcp_port_status); in cdns_mhdp_hdcp_set_config()
283 if (ret || cdns_mhdp_hdcp_handle_status(mhdp, hdcp_port_status)) in cdns_mhdp_hdcp_set_config()
289 static int cdns_mhdp_hdcp_auth_check(struct cdns_mhdp_device *mhdp) in cdns_mhdp_hdcp_auth_check() argument
295 ret_event = cdns_mhdp_wait_for_sw_event(mhdp, CDNS_HDCP_TX_STATUS); in cdns_mhdp_hdcp_auth_check()
299 ret = cdns_mhdp_hdcp_get_status(mhdp, &hdcp_port_status); in cdns_mhdp_hdcp_auth_check()
300 if (ret || cdns_mhdp_hdcp_handle_status(mhdp, hdcp_port_status)) in cdns_mhdp_hdcp_auth_check()
304 dev_dbg(mhdp->dev, "Authentication completed successfully!\n"); in cdns_mhdp_hdcp_auth_check()
308 dev_dbg(mhdp->dev, "Authentication failed\n"); in cdns_mhdp_hdcp_auth_check()
313 static int cdns_mhdp_hdcp_check_receviers(struct cdns_mhdp_device *mhdp) in cdns_mhdp_hdcp_check_receviers() argument
319 ret_event = cdns_mhdp_wait_for_sw_event(mhdp, in cdns_mhdp_hdcp_check_receviers()
326 cdns_mhdp_hdcp_rx_id_valid(mhdp, &hdcp_num_rec, (u8 *)hdcp_rec_id); in cdns_mhdp_hdcp_check_receviers()
327 cdns_mhdp_hdcp_rx_id_valid_response(mhdp, 1); in cdns_mhdp_hdcp_check_receviers()
332 static int cdns_mhdp_hdcp_auth_22(struct cdns_mhdp_device *mhdp) in cdns_mhdp_hdcp_auth_22() argument
339 dev_dbg(mhdp->dev, "HDCP: Start 2.2 Authentication\n"); in cdns_mhdp_hdcp_auth_22()
340 ret_event = cdns_mhdp_wait_for_sw_event(mhdp, in cdns_mhdp_hdcp_auth_22()
346 mhdp->sw_events &= ~CDNS_HDCP_TX_STATUS; in cdns_mhdp_hdcp_auth_22()
347 ret = cdns_mhdp_hdcp_get_status(mhdp, &hdcp_port_status); in cdns_mhdp_hdcp_auth_22()
348 if (ret || cdns_mhdp_hdcp_handle_status(mhdp, hdcp_port_status)) in cdns_mhdp_hdcp_auth_22()
352 cdns_mhdp_hdcp_tx_is_km_stored(mhdp, resp, sizeof(resp)); in cdns_mhdp_hdcp_auth_22()
353 cdns_mhdp_hdcp_km_stored_resp(mhdp, 0, NULL); in cdns_mhdp_hdcp_auth_22()
355 if (cdns_mhdp_hdcp_check_receviers(mhdp)) in cdns_mhdp_hdcp_auth_22()
361 static inline int cdns_mhdp_hdcp_auth_14(struct cdns_mhdp_device *mhdp) in cdns_mhdp_hdcp_auth_14() argument
363 dev_dbg(mhdp->dev, "HDCP: Starting 1.4 Authentication\n"); in cdns_mhdp_hdcp_auth_14()
364 return cdns_mhdp_hdcp_check_receviers(mhdp); in cdns_mhdp_hdcp_auth_14()
367 static int cdns_mhdp_hdcp_auth(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_auth() argument
372 ret = cdns_mhdp_hdcp_set_config(mhdp, hdcp_config, true); in cdns_mhdp_hdcp_auth()
377 ret = cdns_mhdp_hdcp_auth_14(mhdp); in cdns_mhdp_hdcp_auth()
379 ret = cdns_mhdp_hdcp_auth_22(mhdp); in cdns_mhdp_hdcp_auth()
384 ret = cdns_mhdp_hdcp_auth_check(mhdp); in cdns_mhdp_hdcp_auth()
386 ret = cdns_mhdp_hdcp_auth_check(mhdp); in cdns_mhdp_hdcp_auth()
392 static int _cdns_mhdp_hdcp_disable(struct cdns_mhdp_device *mhdp) in _cdns_mhdp_hdcp_disable() argument
396 dev_dbg(mhdp->dev, "[%s:%d] HDCP is being disabled...\n", in _cdns_mhdp_hdcp_disable()
397 mhdp->connector.name, mhdp->connector.base.id); in _cdns_mhdp_hdcp_disable()
399 ret = cdns_mhdp_hdcp_set_config(mhdp, 0, false); in _cdns_mhdp_hdcp_disable()
404 static int _cdns_mhdp_hdcp_enable(struct cdns_mhdp_device *mhdp, u8 content_type) in _cdns_mhdp_hdcp_enable() argument
412 ret = cdns_mhdp_hdcp_auth(mhdp, HDCP_TX_2); in _cdns_mhdp_hdcp_enable()
415 _cdns_mhdp_hdcp_disable(mhdp); in _cdns_mhdp_hdcp_enable()
419 ret = cdns_mhdp_hdcp_auth(mhdp, HDCP_TX_1); in _cdns_mhdp_hdcp_enable()
422 _cdns_mhdp_hdcp_disable(mhdp); in _cdns_mhdp_hdcp_enable()
426 dev_err(mhdp->dev, "HDCP authentication failed (%d tries/%d)\n", in _cdns_mhdp_hdcp_enable()
432 static int cdns_mhdp_hdcp_check_link(struct cdns_mhdp_device *mhdp) in cdns_mhdp_hdcp_check_link() argument
437 mutex_lock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_check_link()
438 if (mhdp->hdcp.value == DRM_MODE_CONTENT_PROTECTION_UNDESIRED) in cdns_mhdp_hdcp_check_link()
441 ret = cdns_mhdp_hdcp_get_status(mhdp, &hdcp_port_status); in cdns_mhdp_hdcp_check_link()
445 dev_err(mhdp->dev, in cdns_mhdp_hdcp_check_link()
447 mhdp->connector.name, mhdp->connector.base.id); in cdns_mhdp_hdcp_check_link()
449 ret = _cdns_mhdp_hdcp_disable(mhdp); in cdns_mhdp_hdcp_check_link()
451 mhdp->hdcp.value = DRM_MODE_CONTENT_PROTECTION_DESIRED; in cdns_mhdp_hdcp_check_link()
452 schedule_work(&mhdp->hdcp.prop_work); in cdns_mhdp_hdcp_check_link()
456 ret = _cdns_mhdp_hdcp_enable(mhdp, mhdp->hdcp.hdcp_content_type); in cdns_mhdp_hdcp_check_link()
458 mhdp->hdcp.value = DRM_MODE_CONTENT_PROTECTION_DESIRED; in cdns_mhdp_hdcp_check_link()
459 schedule_work(&mhdp->hdcp.prop_work); in cdns_mhdp_hdcp_check_link()
462 mutex_unlock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_check_link()
472 struct cdns_mhdp_device *mhdp = container_of(hdcp, in cdns_mhdp_hdcp_check_work() local
476 if (!cdns_mhdp_hdcp_check_link(mhdp)) in cdns_mhdp_hdcp_check_work()
486 struct cdns_mhdp_device *mhdp = container_of(hdcp, in cdns_mhdp_hdcp_prop_work() local
489 struct drm_device *dev = mhdp->connector.dev; in cdns_mhdp_hdcp_prop_work()
493 mutex_lock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_prop_work()
494 if (mhdp->hdcp.value != DRM_MODE_CONTENT_PROTECTION_UNDESIRED) { in cdns_mhdp_hdcp_prop_work()
495 state = mhdp->connector.state; in cdns_mhdp_hdcp_prop_work()
496 state->content_protection = mhdp->hdcp.value; in cdns_mhdp_hdcp_prop_work()
498 mutex_unlock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_prop_work()
502 int cdns_mhdp_hdcp_set_lc(struct cdns_mhdp_device *mhdp, u8 *val) in cdns_mhdp_hdcp_set_lc() argument
506 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_set_lc()
507 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_GENERAL, in cdns_mhdp_hdcp_set_lc()
510 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_set_lc()
516 cdns_mhdp_hdcp_set_public_key_param(struct cdns_mhdp_device *mhdp, in cdns_mhdp_hdcp_set_public_key_param() argument
521 mutex_lock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_set_public_key_param()
522 ret = cdns_mhdp_secure_mailbox_send(mhdp, MB_MODULE_ID_HDCP_TX, in cdns_mhdp_hdcp_set_public_key_param()
525 mutex_unlock(&mhdp->mbox_mutex); in cdns_mhdp_hdcp_set_public_key_param()
530 int cdns_mhdp_hdcp_enable(struct cdns_mhdp_device *mhdp, u8 content_type) in cdns_mhdp_hdcp_enable() argument
534 mutex_lock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_enable()
535 ret = _cdns_mhdp_hdcp_enable(mhdp, content_type); in cdns_mhdp_hdcp_enable()
539 mhdp->hdcp.hdcp_content_type = content_type; in cdns_mhdp_hdcp_enable()
540 mhdp->hdcp.value = DRM_MODE_CONTENT_PROTECTION_ENABLED; in cdns_mhdp_hdcp_enable()
541 schedule_work(&mhdp->hdcp.prop_work); in cdns_mhdp_hdcp_enable()
542 schedule_delayed_work(&mhdp->hdcp.check_work, in cdns_mhdp_hdcp_enable()
545 mutex_unlock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_enable()
549 int cdns_mhdp_hdcp_disable(struct cdns_mhdp_device *mhdp) in cdns_mhdp_hdcp_disable() argument
553 mutex_lock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_disable()
554 if (mhdp->hdcp.value != DRM_MODE_CONTENT_PROTECTION_UNDESIRED) { in cdns_mhdp_hdcp_disable()
555 mhdp->hdcp.value = DRM_MODE_CONTENT_PROTECTION_UNDESIRED; in cdns_mhdp_hdcp_disable()
556 schedule_work(&mhdp->hdcp.prop_work); in cdns_mhdp_hdcp_disable()
557 ret = _cdns_mhdp_hdcp_disable(mhdp); in cdns_mhdp_hdcp_disable()
559 mutex_unlock(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_disable()
560 cancel_delayed_work_sync(&mhdp->hdcp.check_work); in cdns_mhdp_hdcp_disable()
565 void cdns_mhdp_hdcp_init(struct cdns_mhdp_device *mhdp) in cdns_mhdp_hdcp_init() argument
567 INIT_DELAYED_WORK(&mhdp->hdcp.check_work, cdns_mhdp_hdcp_check_work); in cdns_mhdp_hdcp_init()
568 INIT_WORK(&mhdp->hdcp.prop_work, cdns_mhdp_hdcp_prop_work); in cdns_mhdp_hdcp_init()
569 mutex_init(&mhdp->hdcp.mutex); in cdns_mhdp_hdcp_init()