1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * vivid-cec.c - A Virtual Video Test Driver, cec emulation 4 * 5 * Copyright 2016 Cisco Systems, Inc. and/or its affiliates. All rights reserved. 6 */ 7 8 #include <media/cec.h> 9 10 #include "vivid-core.h" 11 #include "vivid-cec.h" 12 13 #define CEC_TIM_START_BIT_TOTAL 4500 14 #define CEC_TIM_START_BIT_LOW 3700 15 #define CEC_TIM_START_BIT_HIGH 800 16 #define CEC_TIM_DATA_BIT_TOTAL 2400 17 #define CEC_TIM_DATA_BIT_0_LOW 1500 18 #define CEC_TIM_DATA_BIT_0_HIGH 900 19 #define CEC_TIM_DATA_BIT_1_LOW 600 20 #define CEC_TIM_DATA_BIT_1_HIGH 1800 21 22 void vivid_cec_bus_free_work(struct vivid_dev *dev) 23 { 24 spin_lock(&dev->cec_slock); 25 while (!list_empty(&dev->cec_work_list)) { 26 struct vivid_cec_work *cw = 27 list_first_entry(&dev->cec_work_list, 28 struct vivid_cec_work, list); 29 30 spin_unlock(&dev->cec_slock); 31 cancel_delayed_work_sync(&cw->work); 32 spin_lock(&dev->cec_slock); 33 list_del(&cw->list); 34 cec_transmit_attempt_done(cw->adap, CEC_TX_STATUS_LOW_DRIVE); 35 kfree(cw); 36 } 37 spin_unlock(&dev->cec_slock); 38 } 39 40 static bool vivid_cec_find_dest_adap(struct vivid_dev *dev, 41 struct cec_adapter *adap, u8 dest) 42 { 43 unsigned int i; 44 45 if (dest >= 0xf) 46 return false; 47 48 if (adap != dev->cec_rx_adap && dev->cec_rx_adap && 49 dev->cec_rx_adap->is_configured && 50 cec_has_log_addr(dev->cec_rx_adap, dest)) 51 return true; 52 53 for (i = 0; i < MAX_OUTPUTS && dev->cec_tx_adap[i]; i++) { 54 if (adap == dev->cec_tx_adap[i]) 55 continue; 56 if (!dev->cec_tx_adap[i]->is_configured) 57 continue; 58 if (cec_has_log_addr(dev->cec_tx_adap[i], dest)) 59 return true; 60 } 61 return false; 62 } 63 64 static void vivid_cec_pin_adap_events(struct cec_adapter *adap, ktime_t ts, 65 const struct cec_msg *msg, bool nacked) 66 { 67 unsigned int len = nacked ? 1 : msg->len; 68 unsigned int i; 69 bool bit; 70 71 if (adap == NULL) 72 return; 73 74 /* 75 * Suffix ULL on constant 10 makes the expression 76 * CEC_TIM_START_BIT_TOTAL + 10ULL * len * CEC_TIM_DATA_BIT_TOTAL 77 * to be evaluated using 64-bit unsigned arithmetic (u64), which 78 * is what ktime_sub_us expects as second argument. 79 */ 80 ts = ktime_sub_us(ts, CEC_TIM_START_BIT_TOTAL + 81 10ULL * len * CEC_TIM_DATA_BIT_TOTAL); 82 cec_queue_pin_cec_event(adap, false, false, ts); 83 ts = ktime_add_us(ts, CEC_TIM_START_BIT_LOW); 84 cec_queue_pin_cec_event(adap, true, false, ts); 85 ts = ktime_add_us(ts, CEC_TIM_START_BIT_HIGH); 86 87 for (i = 0; i < 10 * len; i++) { 88 switch (i % 10) { 89 case 0 ... 7: 90 bit = msg->msg[i / 10] & (0x80 >> (i % 10)); 91 break; 92 case 8: /* EOM */ 93 bit = i / 10 == msg->len - 1; 94 break; 95 case 9: /* ACK */ 96 bit = cec_msg_is_broadcast(msg) ^ nacked; 97 break; 98 } 99 cec_queue_pin_cec_event(adap, false, false, ts); 100 if (bit) 101 ts = ktime_add_us(ts, CEC_TIM_DATA_BIT_1_LOW); 102 else 103 ts = ktime_add_us(ts, CEC_TIM_DATA_BIT_0_LOW); 104 cec_queue_pin_cec_event(adap, true, false, ts); 105 if (bit) 106 ts = ktime_add_us(ts, CEC_TIM_DATA_BIT_1_HIGH); 107 else 108 ts = ktime_add_us(ts, CEC_TIM_DATA_BIT_0_HIGH); 109 } 110 } 111 112 static void vivid_cec_pin_events(struct vivid_dev *dev, 113 const struct cec_msg *msg, bool nacked) 114 { 115 ktime_t ts = ktime_get(); 116 unsigned int i; 117 118 vivid_cec_pin_adap_events(dev->cec_rx_adap, ts, msg, nacked); 119 for (i = 0; i < MAX_OUTPUTS; i++) 120 vivid_cec_pin_adap_events(dev->cec_tx_adap[i], ts, msg, nacked); 121 } 122 123 static void vivid_cec_xfer_done_worker(struct work_struct *work) 124 { 125 struct vivid_cec_work *cw = 126 container_of(work, struct vivid_cec_work, work.work); 127 struct vivid_dev *dev = cw->dev; 128 struct cec_adapter *adap = cw->adap; 129 u8 dest = cec_msg_destination(&cw->msg); 130 bool valid_dest; 131 unsigned int i; 132 133 valid_dest = cec_msg_is_broadcast(&cw->msg); 134 if (!valid_dest) 135 valid_dest = vivid_cec_find_dest_adap(dev, adap, dest); 136 137 cw->tx_status = valid_dest ? CEC_TX_STATUS_OK : CEC_TX_STATUS_NACK; 138 spin_lock(&dev->cec_slock); 139 dev->cec_xfer_time_jiffies = 0; 140 dev->cec_xfer_start_jiffies = 0; 141 list_del(&cw->list); 142 spin_unlock(&dev->cec_slock); 143 vivid_cec_pin_events(dev, &cw->msg, !valid_dest); 144 cec_transmit_attempt_done(cw->adap, cw->tx_status); 145 146 /* Broadcast message */ 147 if (adap != dev->cec_rx_adap) 148 cec_received_msg(dev->cec_rx_adap, &cw->msg); 149 for (i = 0; i < MAX_OUTPUTS && dev->cec_tx_adap[i]; i++) 150 if (adap != dev->cec_tx_adap[i]) 151 cec_received_msg(dev->cec_tx_adap[i], &cw->msg); 152 kfree(cw); 153 } 154 155 static void vivid_cec_xfer_try_worker(struct work_struct *work) 156 { 157 struct vivid_cec_work *cw = 158 container_of(work, struct vivid_cec_work, work.work); 159 struct vivid_dev *dev = cw->dev; 160 161 spin_lock(&dev->cec_slock); 162 if (dev->cec_xfer_time_jiffies) { 163 list_del(&cw->list); 164 spin_unlock(&dev->cec_slock); 165 cec_transmit_attempt_done(cw->adap, CEC_TX_STATUS_ARB_LOST); 166 kfree(cw); 167 } else { 168 INIT_DELAYED_WORK(&cw->work, vivid_cec_xfer_done_worker); 169 dev->cec_xfer_start_jiffies = jiffies; 170 dev->cec_xfer_time_jiffies = usecs_to_jiffies(cw->usecs); 171 spin_unlock(&dev->cec_slock); 172 schedule_delayed_work(&cw->work, dev->cec_xfer_time_jiffies); 173 } 174 } 175 176 static int vivid_cec_adap_enable(struct cec_adapter *adap, bool enable) 177 { 178 adap->cec_pin_is_high = true; 179 return 0; 180 } 181 182 static int vivid_cec_adap_log_addr(struct cec_adapter *adap, u8 log_addr) 183 { 184 return 0; 185 } 186 187 /* 188 * One data bit takes 2400 us, each byte needs 10 bits so that's 24000 us 189 * per byte. 190 */ 191 #define USECS_PER_BYTE 24000 192 193 static int vivid_cec_adap_transmit(struct cec_adapter *adap, u8 attempts, 194 u32 signal_free_time, struct cec_msg *msg) 195 { 196 struct vivid_dev *dev = cec_get_drvdata(adap); 197 struct vivid_cec_work *cw = kzalloc(sizeof(*cw), GFP_KERNEL); 198 long delta_jiffies = 0; 199 200 if (cw == NULL) 201 return -ENOMEM; 202 cw->dev = dev; 203 cw->adap = adap; 204 cw->usecs = CEC_FREE_TIME_TO_USEC(signal_free_time) + 205 msg->len * USECS_PER_BYTE; 206 cw->msg = *msg; 207 208 spin_lock(&dev->cec_slock); 209 list_add(&cw->list, &dev->cec_work_list); 210 if (dev->cec_xfer_time_jiffies == 0) { 211 INIT_DELAYED_WORK(&cw->work, vivid_cec_xfer_done_worker); 212 dev->cec_xfer_start_jiffies = jiffies; 213 dev->cec_xfer_time_jiffies = usecs_to_jiffies(cw->usecs); 214 delta_jiffies = dev->cec_xfer_time_jiffies; 215 } else { 216 INIT_DELAYED_WORK(&cw->work, vivid_cec_xfer_try_worker); 217 delta_jiffies = dev->cec_xfer_start_jiffies + 218 dev->cec_xfer_time_jiffies - jiffies; 219 } 220 spin_unlock(&dev->cec_slock); 221 schedule_delayed_work(&cw->work, delta_jiffies < 0 ? 0 : delta_jiffies); 222 return 0; 223 } 224 225 static int vivid_received(struct cec_adapter *adap, struct cec_msg *msg) 226 { 227 struct vivid_dev *dev = cec_get_drvdata(adap); 228 struct cec_msg reply; 229 u8 dest = cec_msg_destination(msg); 230 u8 disp_ctl; 231 char osd[14]; 232 233 if (cec_msg_is_broadcast(msg)) 234 dest = adap->log_addrs.log_addr[0]; 235 cec_msg_init(&reply, dest, cec_msg_initiator(msg)); 236 237 switch (cec_msg_opcode(msg)) { 238 case CEC_MSG_SET_OSD_STRING: 239 if (!cec_is_sink(adap)) 240 return -ENOMSG; 241 cec_ops_set_osd_string(msg, &disp_ctl, osd); 242 switch (disp_ctl) { 243 case CEC_OP_DISP_CTL_DEFAULT: 244 strscpy(dev->osd, osd, sizeof(dev->osd)); 245 dev->osd_jiffies = jiffies; 246 break; 247 case CEC_OP_DISP_CTL_UNTIL_CLEARED: 248 strscpy(dev->osd, osd, sizeof(dev->osd)); 249 dev->osd_jiffies = 0; 250 break; 251 case CEC_OP_DISP_CTL_CLEAR: 252 dev->osd[0] = 0; 253 dev->osd_jiffies = 0; 254 break; 255 default: 256 cec_msg_feature_abort(&reply, cec_msg_opcode(msg), 257 CEC_OP_ABORT_INVALID_OP); 258 cec_transmit_msg(adap, &reply, false); 259 break; 260 } 261 break; 262 default: 263 return -ENOMSG; 264 } 265 return 0; 266 } 267 268 static const struct cec_adap_ops vivid_cec_adap_ops = { 269 .adap_enable = vivid_cec_adap_enable, 270 .adap_log_addr = vivid_cec_adap_log_addr, 271 .adap_transmit = vivid_cec_adap_transmit, 272 .received = vivid_received, 273 }; 274 275 struct cec_adapter *vivid_cec_alloc_adap(struct vivid_dev *dev, 276 unsigned int idx, 277 bool is_source) 278 { 279 u32 caps = CEC_CAP_DEFAULTS | CEC_CAP_MONITOR_ALL | CEC_CAP_MONITOR_PIN; 280 char name[32]; 281 282 snprintf(name, sizeof(name), "vivid-%03d-vid-%s%d", 283 dev->inst, is_source ? "out" : "cap", idx); 284 return cec_allocate_adapter(&vivid_cec_adap_ops, dev, 285 name, caps, CEC_MAX_LOG_ADDRS); 286 } 287