1aba578bdSHuai-Cheng Kuo /* 2aba578bdSHuai-Cheng Kuo * CXL CDAT Structure 3aba578bdSHuai-Cheng Kuo * 4aba578bdSHuai-Cheng Kuo * Copyright (C) 2021 Avery Design Systems, Inc. 5aba578bdSHuai-Cheng Kuo * 6aba578bdSHuai-Cheng Kuo * This work is licensed under the terms of the GNU GPL, version 2 or later. 7aba578bdSHuai-Cheng Kuo * See the COPYING file in the top-level directory. 8aba578bdSHuai-Cheng Kuo */ 9aba578bdSHuai-Cheng Kuo 10aba578bdSHuai-Cheng Kuo #include "qemu/osdep.h" 11aba578bdSHuai-Cheng Kuo #include "hw/pci/pci.h" 12aba578bdSHuai-Cheng Kuo #include "hw/cxl/cxl.h" 13aba578bdSHuai-Cheng Kuo #include "qapi/error.h" 14aba578bdSHuai-Cheng Kuo #include "qemu/error-report.h" 15aba578bdSHuai-Cheng Kuo 16aba578bdSHuai-Cheng Kuo static void cdat_len_check(CDATSubHeader *hdr, Error **errp) 17aba578bdSHuai-Cheng Kuo { 18aba578bdSHuai-Cheng Kuo assert(hdr->length); 19aba578bdSHuai-Cheng Kuo assert(hdr->reserved == 0); 20aba578bdSHuai-Cheng Kuo 21aba578bdSHuai-Cheng Kuo switch (hdr->type) { 22aba578bdSHuai-Cheng Kuo case CDAT_TYPE_DSMAS: 23aba578bdSHuai-Cheng Kuo assert(hdr->length == sizeof(CDATDsmas)); 24aba578bdSHuai-Cheng Kuo break; 25aba578bdSHuai-Cheng Kuo case CDAT_TYPE_DSLBIS: 26aba578bdSHuai-Cheng Kuo assert(hdr->length == sizeof(CDATDslbis)); 27aba578bdSHuai-Cheng Kuo break; 28aba578bdSHuai-Cheng Kuo case CDAT_TYPE_DSMSCIS: 29aba578bdSHuai-Cheng Kuo assert(hdr->length == sizeof(CDATDsmscis)); 30aba578bdSHuai-Cheng Kuo break; 31aba578bdSHuai-Cheng Kuo case CDAT_TYPE_DSIS: 32aba578bdSHuai-Cheng Kuo assert(hdr->length == sizeof(CDATDsis)); 33aba578bdSHuai-Cheng Kuo break; 34aba578bdSHuai-Cheng Kuo case CDAT_TYPE_DSEMTS: 35aba578bdSHuai-Cheng Kuo assert(hdr->length == sizeof(CDATDsemts)); 36aba578bdSHuai-Cheng Kuo break; 37aba578bdSHuai-Cheng Kuo case CDAT_TYPE_SSLBIS: 38aba578bdSHuai-Cheng Kuo assert(hdr->length >= sizeof(CDATSslbisHeader)); 39aba578bdSHuai-Cheng Kuo assert((hdr->length - sizeof(CDATSslbisHeader)) % 40aba578bdSHuai-Cheng Kuo sizeof(CDATSslbe) == 0); 41aba578bdSHuai-Cheng Kuo break; 42aba578bdSHuai-Cheng Kuo default: 43aba578bdSHuai-Cheng Kuo error_setg(errp, "Type %d is reserved", hdr->type); 44aba578bdSHuai-Cheng Kuo } 45aba578bdSHuai-Cheng Kuo } 46aba578bdSHuai-Cheng Kuo 47aba578bdSHuai-Cheng Kuo static void ct3_build_cdat(CDATObject *cdat, Error **errp) 48aba578bdSHuai-Cheng Kuo { 49aba578bdSHuai-Cheng Kuo g_autofree CDATTableHeader *cdat_header = NULL; 50aba578bdSHuai-Cheng Kuo g_autofree CDATEntry *cdat_st = NULL; 51aba578bdSHuai-Cheng Kuo uint8_t sum = 0; 52aba578bdSHuai-Cheng Kuo int ent, i; 53aba578bdSHuai-Cheng Kuo 54aba578bdSHuai-Cheng Kuo /* Use default table if fopen == NULL */ 55aba578bdSHuai-Cheng Kuo assert(cdat->build_cdat_table); 56aba578bdSHuai-Cheng Kuo 57aba578bdSHuai-Cheng Kuo cdat_header = g_malloc0(sizeof(*cdat_header)); 58aba578bdSHuai-Cheng Kuo if (!cdat_header) { 59aba578bdSHuai-Cheng Kuo error_setg(errp, "Failed to allocate CDAT header"); 60aba578bdSHuai-Cheng Kuo return; 61aba578bdSHuai-Cheng Kuo } 62aba578bdSHuai-Cheng Kuo 63aba578bdSHuai-Cheng Kuo cdat->built_buf_len = cdat->build_cdat_table(&cdat->built_buf, cdat->private); 64aba578bdSHuai-Cheng Kuo 65aba578bdSHuai-Cheng Kuo if (!cdat->built_buf_len) { 66aba578bdSHuai-Cheng Kuo /* Build later as not all data available yet */ 67aba578bdSHuai-Cheng Kuo cdat->to_update = true; 68aba578bdSHuai-Cheng Kuo return; 69aba578bdSHuai-Cheng Kuo } 70aba578bdSHuai-Cheng Kuo cdat->to_update = false; 71aba578bdSHuai-Cheng Kuo 72aba578bdSHuai-Cheng Kuo cdat_st = g_malloc0(sizeof(*cdat_st) * (cdat->built_buf_len + 1)); 73aba578bdSHuai-Cheng Kuo if (!cdat_st) { 74aba578bdSHuai-Cheng Kuo error_setg(errp, "Failed to allocate CDAT entry array"); 75aba578bdSHuai-Cheng Kuo return; 76aba578bdSHuai-Cheng Kuo } 77aba578bdSHuai-Cheng Kuo 78aba578bdSHuai-Cheng Kuo /* Entry 0 for CDAT header, starts with Entry 1 */ 79aba578bdSHuai-Cheng Kuo for (ent = 1; ent < cdat->built_buf_len + 1; ent++) { 80aba578bdSHuai-Cheng Kuo CDATSubHeader *hdr = cdat->built_buf[ent - 1]; 81aba578bdSHuai-Cheng Kuo uint8_t *buf = (uint8_t *)cdat->built_buf[ent - 1]; 82aba578bdSHuai-Cheng Kuo 83aba578bdSHuai-Cheng Kuo cdat_st[ent].base = hdr; 84aba578bdSHuai-Cheng Kuo cdat_st[ent].length = hdr->length; 85aba578bdSHuai-Cheng Kuo 86aba578bdSHuai-Cheng Kuo cdat_header->length += hdr->length; 87aba578bdSHuai-Cheng Kuo for (i = 0; i < hdr->length; i++) { 88aba578bdSHuai-Cheng Kuo sum += buf[i]; 89aba578bdSHuai-Cheng Kuo } 90aba578bdSHuai-Cheng Kuo } 91aba578bdSHuai-Cheng Kuo 92aba578bdSHuai-Cheng Kuo /* CDAT header */ 93aba578bdSHuai-Cheng Kuo cdat_header->revision = CXL_CDAT_REV; 94aba578bdSHuai-Cheng Kuo /* For now, no runtime updates */ 95aba578bdSHuai-Cheng Kuo cdat_header->sequence = 0; 96aba578bdSHuai-Cheng Kuo cdat_header->length += sizeof(CDATTableHeader); 97aba578bdSHuai-Cheng Kuo sum += cdat_header->revision + cdat_header->sequence + 98aba578bdSHuai-Cheng Kuo cdat_header->length; 99aba578bdSHuai-Cheng Kuo /* Sum of all bytes including checksum must be 0 */ 100aba578bdSHuai-Cheng Kuo cdat_header->checksum = ~sum + 1; 101aba578bdSHuai-Cheng Kuo 102aba578bdSHuai-Cheng Kuo cdat_st[0].base = g_steal_pointer(&cdat_header); 103aba578bdSHuai-Cheng Kuo cdat_st[0].length = sizeof(*cdat_header); 104aba578bdSHuai-Cheng Kuo cdat->entry_len = 1 + cdat->built_buf_len; 105aba578bdSHuai-Cheng Kuo cdat->entry = g_steal_pointer(&cdat_st); 106aba578bdSHuai-Cheng Kuo } 107aba578bdSHuai-Cheng Kuo 108aba578bdSHuai-Cheng Kuo static void ct3_load_cdat(CDATObject *cdat, Error **errp) 109aba578bdSHuai-Cheng Kuo { 110aba578bdSHuai-Cheng Kuo g_autofree CDATEntry *cdat_st = NULL; 111aba578bdSHuai-Cheng Kuo uint8_t sum = 0; 112aba578bdSHuai-Cheng Kuo int num_ent; 113*71ba92f3SHao Zeng int i = 0, ent = 1; 114*71ba92f3SHao Zeng gsize file_size = 0; 115aba578bdSHuai-Cheng Kuo CDATSubHeader *hdr; 116*71ba92f3SHao Zeng GError *error = NULL; 117aba578bdSHuai-Cheng Kuo 118aba578bdSHuai-Cheng Kuo /* Read CDAT file and create its cache */ 119*71ba92f3SHao Zeng if (!g_file_get_contents(cdat->filename, (gchar **)&cdat->buf, 120*71ba92f3SHao Zeng &file_size, &error)) { 121*71ba92f3SHao Zeng error_setg(errp, "CDAT: File read failed: %s", error->message); 122*71ba92f3SHao Zeng g_error_free(error); 123aba578bdSHuai-Cheng Kuo return; 124aba578bdSHuai-Cheng Kuo } 125aba578bdSHuai-Cheng Kuo if (file_size < sizeof(CDATTableHeader)) { 126aba578bdSHuai-Cheng Kuo error_setg(errp, "CDAT: File too short"); 127aba578bdSHuai-Cheng Kuo return; 128aba578bdSHuai-Cheng Kuo } 129aba578bdSHuai-Cheng Kuo i = sizeof(CDATTableHeader); 130aba578bdSHuai-Cheng Kuo num_ent = 1; 131aba578bdSHuai-Cheng Kuo while (i < file_size) { 132aba578bdSHuai-Cheng Kuo hdr = (CDATSubHeader *)(cdat->buf + i); 133aba578bdSHuai-Cheng Kuo cdat_len_check(hdr, errp); 134aba578bdSHuai-Cheng Kuo i += hdr->length; 135aba578bdSHuai-Cheng Kuo num_ent++; 136aba578bdSHuai-Cheng Kuo } 137aba578bdSHuai-Cheng Kuo if (i != file_size) { 138f0376c3fSMichael Tokarev error_setg(errp, "CDAT: File length mismatch"); 139aba578bdSHuai-Cheng Kuo return; 140aba578bdSHuai-Cheng Kuo } 141aba578bdSHuai-Cheng Kuo 142aba578bdSHuai-Cheng Kuo cdat_st = g_malloc0(sizeof(*cdat_st) * num_ent); 143aba578bdSHuai-Cheng Kuo if (!cdat_st) { 144aba578bdSHuai-Cheng Kuo error_setg(errp, "CDAT: Failed to allocate entry array"); 145aba578bdSHuai-Cheng Kuo return; 146aba578bdSHuai-Cheng Kuo } 147aba578bdSHuai-Cheng Kuo 148aba578bdSHuai-Cheng Kuo /* Set CDAT header, Entry = 0 */ 149aba578bdSHuai-Cheng Kuo cdat_st[0].base = cdat->buf; 150aba578bdSHuai-Cheng Kuo cdat_st[0].length = sizeof(CDATTableHeader); 151aba578bdSHuai-Cheng Kuo i = 0; 152aba578bdSHuai-Cheng Kuo 153aba578bdSHuai-Cheng Kuo while (i < cdat_st[0].length) { 154aba578bdSHuai-Cheng Kuo sum += cdat->buf[i++]; 155aba578bdSHuai-Cheng Kuo } 156aba578bdSHuai-Cheng Kuo 157aba578bdSHuai-Cheng Kuo /* Read CDAT structures */ 158aba578bdSHuai-Cheng Kuo while (i < file_size) { 159aba578bdSHuai-Cheng Kuo hdr = (CDATSubHeader *)(cdat->buf + i); 160aba578bdSHuai-Cheng Kuo cdat_len_check(hdr, errp); 161aba578bdSHuai-Cheng Kuo 162aba578bdSHuai-Cheng Kuo cdat_st[ent].base = hdr; 163aba578bdSHuai-Cheng Kuo cdat_st[ent].length = hdr->length; 164aba578bdSHuai-Cheng Kuo 165aba578bdSHuai-Cheng Kuo while (cdat->buf + i < 166aba578bdSHuai-Cheng Kuo (uint8_t *)cdat_st[ent].base + cdat_st[ent].length) { 167aba578bdSHuai-Cheng Kuo assert(i < file_size); 168aba578bdSHuai-Cheng Kuo sum += cdat->buf[i++]; 169aba578bdSHuai-Cheng Kuo } 170aba578bdSHuai-Cheng Kuo 171aba578bdSHuai-Cheng Kuo ent++; 172aba578bdSHuai-Cheng Kuo } 173aba578bdSHuai-Cheng Kuo 174aba578bdSHuai-Cheng Kuo if (sum != 0) { 175aba578bdSHuai-Cheng Kuo warn_report("CDAT: Found checksum mismatch in %s", cdat->filename); 176aba578bdSHuai-Cheng Kuo } 177aba578bdSHuai-Cheng Kuo cdat->entry_len = num_ent; 178aba578bdSHuai-Cheng Kuo cdat->entry = g_steal_pointer(&cdat_st); 179aba578bdSHuai-Cheng Kuo } 180aba578bdSHuai-Cheng Kuo 181aba578bdSHuai-Cheng Kuo void cxl_doe_cdat_init(CXLComponentState *cxl_cstate, Error **errp) 182aba578bdSHuai-Cheng Kuo { 183aba578bdSHuai-Cheng Kuo CDATObject *cdat = &cxl_cstate->cdat; 184aba578bdSHuai-Cheng Kuo 185aba578bdSHuai-Cheng Kuo if (cdat->filename) { 186aba578bdSHuai-Cheng Kuo ct3_load_cdat(cdat, errp); 187aba578bdSHuai-Cheng Kuo } else { 188aba578bdSHuai-Cheng Kuo ct3_build_cdat(cdat, errp); 189aba578bdSHuai-Cheng Kuo } 190aba578bdSHuai-Cheng Kuo } 191aba578bdSHuai-Cheng Kuo 192aba578bdSHuai-Cheng Kuo void cxl_doe_cdat_update(CXLComponentState *cxl_cstate, Error **errp) 193aba578bdSHuai-Cheng Kuo { 194aba578bdSHuai-Cheng Kuo CDATObject *cdat = &cxl_cstate->cdat; 195aba578bdSHuai-Cheng Kuo 196aba578bdSHuai-Cheng Kuo if (cdat->to_update) { 197aba578bdSHuai-Cheng Kuo ct3_build_cdat(cdat, errp); 198aba578bdSHuai-Cheng Kuo } 199aba578bdSHuai-Cheng Kuo } 200aba578bdSHuai-Cheng Kuo 201aba578bdSHuai-Cheng Kuo void cxl_doe_cdat_release(CXLComponentState *cxl_cstate) 202aba578bdSHuai-Cheng Kuo { 203aba578bdSHuai-Cheng Kuo CDATObject *cdat = &cxl_cstate->cdat; 204aba578bdSHuai-Cheng Kuo 205aba578bdSHuai-Cheng Kuo free(cdat->entry); 206aba578bdSHuai-Cheng Kuo if (cdat->built_buf) { 207aba578bdSHuai-Cheng Kuo cdat->free_cdat_table(cdat->built_buf, cdat->built_buf_len, 208aba578bdSHuai-Cheng Kuo cdat->private); 209aba578bdSHuai-Cheng Kuo } 210*71ba92f3SHao Zeng g_free(cdat->buf); 211aba578bdSHuai-Cheng Kuo } 212