1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (C) 2018-2019, Intel Corporation 4 */ 5 6 #include <linux/arm-smccc.h> 7 #include <linux/bitfield.h> 8 #include <linux/completion.h> 9 #include <linux/kobject.h> 10 #include <linux/module.h> 11 #include <linux/mutex.h> 12 #include <linux/of.h> 13 #include <linux/of_platform.h> 14 #include <linux/platform_device.h> 15 #include <linux/firmware/intel/stratix10-svc-client.h> 16 #include <linux/string.h> 17 #include <linux/sysfs.h> 18 19 #define RSU_STATE_MASK GENMASK_ULL(31, 0) 20 #define RSU_VERSION_MASK GENMASK_ULL(63, 32) 21 #define RSU_ERROR_LOCATION_MASK GENMASK_ULL(31, 0) 22 #define RSU_ERROR_DETAIL_MASK GENMASK_ULL(63, 32) 23 #define RSU_DCMF0_MASK GENMASK_ULL(31, 0) 24 #define RSU_DCMF1_MASK GENMASK_ULL(63, 32) 25 #define RSU_DCMF2_MASK GENMASK_ULL(31, 0) 26 #define RSU_DCMF3_MASK GENMASK_ULL(63, 32) 27 28 #define RSU_TIMEOUT (msecs_to_jiffies(SVC_RSU_REQUEST_TIMEOUT_MS)) 29 30 #define INVALID_RETRY_COUNTER 0xFF 31 #define INVALID_DCMF_VERSION 0xFF 32 33 34 typedef void (*rsu_callback)(struct stratix10_svc_client *client, 35 struct stratix10_svc_cb_data *data); 36 /** 37 * struct stratix10_rsu_priv - rsu data structure 38 * @chan: pointer to the allocated service channel 39 * @client: active service client 40 * @completion: state for callback completion 41 * @lock: a mutex to protect callback completion state 42 * @status.current_image: address of image currently running in flash 43 * @status.fail_image: address of failed image in flash 44 * @status.version: the interface version number of RSU firmware 45 * @status.state: the state of RSU system 46 * @status.error_details: error code 47 * @status.error_location: the error offset inside the image that failed 48 * @dcmf_version.dcmf0: Quartus dcmf0 version 49 * @dcmf_version.dcmf1: Quartus dcmf1 version 50 * @dcmf_version.dcmf2: Quartus dcmf2 version 51 * @dcmf_version.dcmf3: Quartus dcmf3 version 52 * @retry_counter: the current image's retry counter 53 * @max_retry: the preset max retry value 54 */ 55 struct stratix10_rsu_priv { 56 struct stratix10_svc_chan *chan; 57 struct stratix10_svc_client client; 58 struct completion completion; 59 struct mutex lock; 60 struct { 61 unsigned long current_image; 62 unsigned long fail_image; 63 unsigned int version; 64 unsigned int state; 65 unsigned int error_details; 66 unsigned int error_location; 67 } status; 68 69 struct { 70 unsigned int dcmf0; 71 unsigned int dcmf1; 72 unsigned int dcmf2; 73 unsigned int dcmf3; 74 } dcmf_version; 75 76 unsigned int retry_counter; 77 unsigned int max_retry; 78 }; 79 80 /** 81 * rsu_status_callback() - Status callback from Intel Service Layer 82 * @client: pointer to service client 83 * @data: pointer to callback data structure 84 * 85 * Callback from Intel service layer for RSU status request. Status is 86 * only updated after a system reboot, so a get updated status call is 87 * made during driver probe. 88 */ 89 static void rsu_status_callback(struct stratix10_svc_client *client, 90 struct stratix10_svc_cb_data *data) 91 { 92 struct stratix10_rsu_priv *priv = client->priv; 93 struct arm_smccc_res *res = (struct arm_smccc_res *)data->kaddr1; 94 95 if (data->status == BIT(SVC_STATUS_OK)) { 96 priv->status.version = FIELD_GET(RSU_VERSION_MASK, 97 res->a2); 98 priv->status.state = FIELD_GET(RSU_STATE_MASK, res->a2); 99 priv->status.fail_image = res->a1; 100 priv->status.current_image = res->a0; 101 priv->status.error_location = 102 FIELD_GET(RSU_ERROR_LOCATION_MASK, res->a3); 103 priv->status.error_details = 104 FIELD_GET(RSU_ERROR_DETAIL_MASK, res->a3); 105 } else { 106 dev_err(client->dev, "COMMAND_RSU_STATUS returned 0x%lX\n", 107 res->a0); 108 priv->status.version = 0; 109 priv->status.state = 0; 110 priv->status.fail_image = 0; 111 priv->status.current_image = 0; 112 priv->status.error_location = 0; 113 priv->status.error_details = 0; 114 } 115 116 complete(&priv->completion); 117 } 118 119 /** 120 * rsu_command_callback() - Update callback from Intel Service Layer 121 * @client: pointer to client 122 * @data: pointer to callback data structure 123 * 124 * Callback from Intel service layer for RSU commands. 125 */ 126 static void rsu_command_callback(struct stratix10_svc_client *client, 127 struct stratix10_svc_cb_data *data) 128 { 129 struct stratix10_rsu_priv *priv = client->priv; 130 131 if (data->status == BIT(SVC_STATUS_NO_SUPPORT)) 132 dev_warn(client->dev, "FW doesn't support notify\n"); 133 else if (data->status == BIT(SVC_STATUS_ERROR)) 134 dev_err(client->dev, "Failure, returned status is %lu\n", 135 BIT(data->status)); 136 137 complete(&priv->completion); 138 } 139 140 /** 141 * rsu_retry_callback() - Callback from Intel service layer for getting 142 * the current image's retry counter from the firmware 143 * @client: pointer to client 144 * @data: pointer to callback data structure 145 * 146 * Callback from Intel service layer for retry counter, which is used by 147 * user to know how many times the images is still allowed to reload 148 * itself before giving up and starting RSU fail-over flow. 149 */ 150 static void rsu_retry_callback(struct stratix10_svc_client *client, 151 struct stratix10_svc_cb_data *data) 152 { 153 struct stratix10_rsu_priv *priv = client->priv; 154 unsigned int *counter = (unsigned int *)data->kaddr1; 155 156 if (data->status == BIT(SVC_STATUS_OK)) 157 priv->retry_counter = *counter; 158 else if (data->status == BIT(SVC_STATUS_NO_SUPPORT)) 159 dev_warn(client->dev, "FW doesn't support retry\n"); 160 else 161 dev_err(client->dev, "Failed to get retry counter %lu\n", 162 BIT(data->status)); 163 164 complete(&priv->completion); 165 } 166 167 /** 168 * rsu_max_retry_callback() - Callback from Intel service layer for getting 169 * the max retry value from the firmware 170 * @client: pointer to client 171 * @data: pointer to callback data structure 172 * 173 * Callback from Intel service layer for max retry. 174 */ 175 static void rsu_max_retry_callback(struct stratix10_svc_client *client, 176 struct stratix10_svc_cb_data *data) 177 { 178 struct stratix10_rsu_priv *priv = client->priv; 179 unsigned int *max_retry = (unsigned int *)data->kaddr1; 180 181 if (data->status == BIT(SVC_STATUS_OK)) 182 priv->max_retry = *max_retry; 183 else if (data->status == BIT(SVC_STATUS_NO_SUPPORT)) 184 dev_warn(client->dev, "FW doesn't support max retry\n"); 185 else 186 dev_err(client->dev, "Failed to get max retry %lu\n", 187 BIT(data->status)); 188 189 complete(&priv->completion); 190 } 191 192 /** 193 * rsu_dcmf_version_callback() - Callback from Intel service layer for getting 194 * the DCMF version 195 * @client: pointer to client 196 * @data: pointer to callback data structure 197 * 198 * Callback from Intel service layer for DCMF version number 199 */ 200 static void rsu_dcmf_version_callback(struct stratix10_svc_client *client, 201 struct stratix10_svc_cb_data *data) 202 { 203 struct stratix10_rsu_priv *priv = client->priv; 204 unsigned long long *value1 = (unsigned long long *)data->kaddr1; 205 unsigned long long *value2 = (unsigned long long *)data->kaddr2; 206 207 if (data->status == BIT(SVC_STATUS_OK)) { 208 priv->dcmf_version.dcmf0 = FIELD_GET(RSU_DCMF0_MASK, *value1); 209 priv->dcmf_version.dcmf1 = FIELD_GET(RSU_DCMF1_MASK, *value1); 210 priv->dcmf_version.dcmf2 = FIELD_GET(RSU_DCMF2_MASK, *value2); 211 priv->dcmf_version.dcmf3 = FIELD_GET(RSU_DCMF3_MASK, *value2); 212 } else 213 dev_err(client->dev, "failed to get DCMF version\n"); 214 215 complete(&priv->completion); 216 } 217 218 /** 219 * rsu_send_msg() - send a message to Intel service layer 220 * @priv: pointer to rsu private data 221 * @command: RSU status or update command 222 * @arg: the request argument, the bitstream address or notify status 223 * @callback: function pointer for the callback (status or update) 224 * 225 * Start an Intel service layer transaction to perform the SMC call that 226 * is necessary to get RSU boot log or set the address of bitstream to 227 * boot after reboot. 228 * 229 * Returns 0 on success or -ETIMEDOUT on error. 230 */ 231 static int rsu_send_msg(struct stratix10_rsu_priv *priv, 232 enum stratix10_svc_command_code command, 233 unsigned long arg, 234 rsu_callback callback) 235 { 236 struct stratix10_svc_client_msg msg; 237 int ret; 238 239 mutex_lock(&priv->lock); 240 reinit_completion(&priv->completion); 241 priv->client.receive_cb = callback; 242 243 msg.command = command; 244 if (arg) 245 msg.arg[0] = arg; 246 247 ret = stratix10_svc_send(priv->chan, &msg); 248 if (ret < 0) 249 goto status_done; 250 251 ret = wait_for_completion_interruptible_timeout(&priv->completion, 252 RSU_TIMEOUT); 253 if (!ret) { 254 dev_err(priv->client.dev, 255 "timeout waiting for SMC call\n"); 256 ret = -ETIMEDOUT; 257 goto status_done; 258 } else if (ret < 0) { 259 dev_err(priv->client.dev, 260 "error %d waiting for SMC call\n", ret); 261 goto status_done; 262 } else { 263 ret = 0; 264 } 265 266 status_done: 267 stratix10_svc_done(priv->chan); 268 mutex_unlock(&priv->lock); 269 return ret; 270 } 271 272 /* 273 * This driver exposes some optional features of the Intel Stratix 10 SoC FPGA. 274 * The sysfs interfaces exposed here are FPGA Remote System Update (RSU) 275 * related. They allow user space software to query the configuration system 276 * status and to request optional reboot behavior specific to Intel FPGAs. 277 */ 278 279 static ssize_t current_image_show(struct device *dev, 280 struct device_attribute *attr, char *buf) 281 { 282 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 283 284 if (!priv) 285 return -ENODEV; 286 287 return sprintf(buf, "0x%08lx\n", priv->status.current_image); 288 } 289 290 static ssize_t fail_image_show(struct device *dev, 291 struct device_attribute *attr, char *buf) 292 { 293 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 294 295 if (!priv) 296 return -ENODEV; 297 298 return sprintf(buf, "0x%08lx\n", priv->status.fail_image); 299 } 300 301 static ssize_t version_show(struct device *dev, struct device_attribute *attr, 302 char *buf) 303 { 304 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 305 306 if (!priv) 307 return -ENODEV; 308 309 return sprintf(buf, "0x%08x\n", priv->status.version); 310 } 311 312 static ssize_t state_show(struct device *dev, struct device_attribute *attr, 313 char *buf) 314 { 315 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 316 317 if (!priv) 318 return -ENODEV; 319 320 return sprintf(buf, "0x%08x\n", priv->status.state); 321 } 322 323 static ssize_t error_location_show(struct device *dev, 324 struct device_attribute *attr, char *buf) 325 { 326 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 327 328 if (!priv) 329 return -ENODEV; 330 331 return sprintf(buf, "0x%08x\n", priv->status.error_location); 332 } 333 334 static ssize_t error_details_show(struct device *dev, 335 struct device_attribute *attr, char *buf) 336 { 337 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 338 339 if (!priv) 340 return -ENODEV; 341 342 return sprintf(buf, "0x%08x\n", priv->status.error_details); 343 } 344 345 static ssize_t retry_counter_show(struct device *dev, 346 struct device_attribute *attr, char *buf) 347 { 348 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 349 350 if (!priv) 351 return -ENODEV; 352 353 return sprintf(buf, "0x%08x\n", priv->retry_counter); 354 } 355 356 static ssize_t max_retry_show(struct device *dev, 357 struct device_attribute *attr, char *buf) 358 { 359 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 360 361 if (!priv) 362 return -ENODEV; 363 364 return sprintf(buf, "0x%08x\n", priv->max_retry); 365 } 366 367 static ssize_t dcmf0_show(struct device *dev, 368 struct device_attribute *attr, char *buf) 369 { 370 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 371 372 if (!priv) 373 return -ENODEV; 374 375 return sprintf(buf, "0x%08x\n", priv->dcmf_version.dcmf0); 376 } 377 378 static ssize_t dcmf1_show(struct device *dev, 379 struct device_attribute *attr, char *buf) 380 { 381 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 382 383 if (!priv) 384 return -ENODEV; 385 386 return sprintf(buf, "0x%08x\n", priv->dcmf_version.dcmf1); 387 } 388 389 static ssize_t dcmf2_show(struct device *dev, 390 struct device_attribute *attr, char *buf) 391 { 392 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 393 394 if (!priv) 395 return -ENODEV; 396 397 return sprintf(buf, "0x%08x\n", priv->dcmf_version.dcmf2); 398 } 399 400 static ssize_t dcmf3_show(struct device *dev, 401 struct device_attribute *attr, char *buf) 402 { 403 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 404 405 if (!priv) 406 return -ENODEV; 407 408 return sprintf(buf, "0x%08x\n", priv->dcmf_version.dcmf3); 409 } 410 411 static ssize_t reboot_image_store(struct device *dev, 412 struct device_attribute *attr, 413 const char *buf, size_t count) 414 { 415 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 416 unsigned long address; 417 int ret; 418 419 if (!priv) 420 return -ENODEV; 421 422 ret = kstrtoul(buf, 0, &address); 423 if (ret) 424 return ret; 425 426 ret = rsu_send_msg(priv, COMMAND_RSU_UPDATE, 427 address, rsu_command_callback); 428 if (ret) { 429 dev_err(dev, "Error, RSU update returned %i\n", ret); 430 return ret; 431 } 432 433 return count; 434 } 435 436 static ssize_t notify_store(struct device *dev, 437 struct device_attribute *attr, 438 const char *buf, size_t count) 439 { 440 struct stratix10_rsu_priv *priv = dev_get_drvdata(dev); 441 unsigned long status; 442 int ret; 443 444 if (!priv) 445 return -ENODEV; 446 447 ret = kstrtoul(buf, 0, &status); 448 if (ret) 449 return ret; 450 451 ret = rsu_send_msg(priv, COMMAND_RSU_NOTIFY, 452 status, rsu_command_callback); 453 if (ret) { 454 dev_err(dev, "Error, RSU notify returned %i\n", ret); 455 return ret; 456 } 457 458 /* to get the updated state */ 459 ret = rsu_send_msg(priv, COMMAND_RSU_STATUS, 460 0, rsu_status_callback); 461 if (ret) { 462 dev_err(dev, "Error, getting RSU status %i\n", ret); 463 return ret; 464 } 465 466 ret = rsu_send_msg(priv, COMMAND_RSU_RETRY, 0, rsu_retry_callback); 467 if (ret) { 468 dev_err(dev, "Error, getting RSU retry %i\n", ret); 469 return ret; 470 } 471 472 return count; 473 } 474 475 static DEVICE_ATTR_RO(current_image); 476 static DEVICE_ATTR_RO(fail_image); 477 static DEVICE_ATTR_RO(state); 478 static DEVICE_ATTR_RO(version); 479 static DEVICE_ATTR_RO(error_location); 480 static DEVICE_ATTR_RO(error_details); 481 static DEVICE_ATTR_RO(retry_counter); 482 static DEVICE_ATTR_RO(max_retry); 483 static DEVICE_ATTR_RO(dcmf0); 484 static DEVICE_ATTR_RO(dcmf1); 485 static DEVICE_ATTR_RO(dcmf2); 486 static DEVICE_ATTR_RO(dcmf3); 487 static DEVICE_ATTR_WO(reboot_image); 488 static DEVICE_ATTR_WO(notify); 489 490 static struct attribute *rsu_attrs[] = { 491 &dev_attr_current_image.attr, 492 &dev_attr_fail_image.attr, 493 &dev_attr_state.attr, 494 &dev_attr_version.attr, 495 &dev_attr_error_location.attr, 496 &dev_attr_error_details.attr, 497 &dev_attr_retry_counter.attr, 498 &dev_attr_max_retry.attr, 499 &dev_attr_dcmf0.attr, 500 &dev_attr_dcmf1.attr, 501 &dev_attr_dcmf2.attr, 502 &dev_attr_dcmf3.attr, 503 &dev_attr_reboot_image.attr, 504 &dev_attr_notify.attr, 505 NULL 506 }; 507 508 ATTRIBUTE_GROUPS(rsu); 509 510 static int stratix10_rsu_probe(struct platform_device *pdev) 511 { 512 struct device *dev = &pdev->dev; 513 struct stratix10_rsu_priv *priv; 514 int ret; 515 516 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); 517 if (!priv) 518 return -ENOMEM; 519 520 priv->client.dev = dev; 521 priv->client.receive_cb = NULL; 522 priv->client.priv = priv; 523 priv->status.current_image = 0; 524 priv->status.fail_image = 0; 525 priv->status.error_location = 0; 526 priv->status.error_details = 0; 527 priv->status.version = 0; 528 priv->status.state = 0; 529 priv->retry_counter = INVALID_RETRY_COUNTER; 530 priv->dcmf_version.dcmf0 = INVALID_DCMF_VERSION; 531 priv->dcmf_version.dcmf1 = INVALID_DCMF_VERSION; 532 priv->dcmf_version.dcmf2 = INVALID_DCMF_VERSION; 533 priv->dcmf_version.dcmf3 = INVALID_DCMF_VERSION; 534 priv->max_retry = INVALID_RETRY_COUNTER; 535 536 mutex_init(&priv->lock); 537 priv->chan = stratix10_svc_request_channel_byname(&priv->client, 538 SVC_CLIENT_RSU); 539 if (IS_ERR(priv->chan)) { 540 dev_err(dev, "couldn't get service channel %s\n", 541 SVC_CLIENT_RSU); 542 return PTR_ERR(priv->chan); 543 } 544 545 init_completion(&priv->completion); 546 platform_set_drvdata(pdev, priv); 547 548 /* get the initial state from firmware */ 549 ret = rsu_send_msg(priv, COMMAND_RSU_STATUS, 550 0, rsu_status_callback); 551 if (ret) { 552 dev_err(dev, "Error, getting RSU status %i\n", ret); 553 stratix10_svc_free_channel(priv->chan); 554 } 555 556 /* get DCMF version from firmware */ 557 ret = rsu_send_msg(priv, COMMAND_RSU_DCMF_VERSION, 558 0, rsu_dcmf_version_callback); 559 if (ret) { 560 dev_err(dev, "Error, getting DCMF version %i\n", ret); 561 stratix10_svc_free_channel(priv->chan); 562 } 563 564 ret = rsu_send_msg(priv, COMMAND_RSU_RETRY, 0, rsu_retry_callback); 565 if (ret) { 566 dev_err(dev, "Error, getting RSU retry %i\n", ret); 567 stratix10_svc_free_channel(priv->chan); 568 } 569 570 ret = rsu_send_msg(priv, COMMAND_RSU_MAX_RETRY, 0, 571 rsu_max_retry_callback); 572 if (ret) { 573 dev_err(dev, "Error, getting RSU max retry %i\n", ret); 574 stratix10_svc_free_channel(priv->chan); 575 } 576 577 return ret; 578 } 579 580 static int stratix10_rsu_remove(struct platform_device *pdev) 581 { 582 struct stratix10_rsu_priv *priv = platform_get_drvdata(pdev); 583 584 stratix10_svc_free_channel(priv->chan); 585 return 0; 586 } 587 588 static struct platform_driver stratix10_rsu_driver = { 589 .probe = stratix10_rsu_probe, 590 .remove = stratix10_rsu_remove, 591 .driver = { 592 .name = "stratix10-rsu", 593 .dev_groups = rsu_groups, 594 }, 595 }; 596 597 module_platform_driver(stratix10_rsu_driver); 598 599 MODULE_LICENSE("GPL v2"); 600 MODULE_DESCRIPTION("Intel Remote System Update Driver"); 601 MODULE_AUTHOR("Richard Gong <richard.gong@intel.com>"); 602