1663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng#include<stdio.h> 2663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng#include<stdint.h> 3663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng#include<string.h> 4663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng#include<assert.h> 5663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 6663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng/* Register contents after executing an TROT insn */ 7663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chengtypedef struct { 8663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint64_t srcaddr; 9663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint64_t len; 10663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint64_t desaddr; 11663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint64_t tabaddr; 12663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint16_t testbyte; 13663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint64_t cc; 14663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} trot_regs; 15663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 16663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chenguint16_t tran_table[40] = { 17663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 0xaaaa,0xbbbb,0xcccc,0xccdd,0xffff,0xdada,0xbcbc,0xabab,0xcaca,0xeaea, 18663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 0xbbbb,0xeeee 19663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng}; 20663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 21663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chenguint8_t src[40] = { 22663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 0x01,0x03,0x04,0x02,0x07,0x08,0x06,0x02,0x05,0x09 23663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng}; 24663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 25663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chenguint16_t des[40]; 26663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 27663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chengtrot_regs tr(uint8_t *addr, uint16_t *codepage, uint16_t *dest, uint64_t len, 28663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint16_t test) 29663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng{ 30663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng trot_regs regs; 31663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t test_byte asm("0") = test; 32663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t length asm("3") = len; 33663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t srcaddr asm("4") = (uint64_t)addr; 34663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t codepage2 asm("1") = (uint64_t)codepage; 35663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t desaddr asm("2") = (uint64_t)dest; 36663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t cc asm("5"); 37663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 38663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = 2; /* cc result will never be 2 */ 39663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng asm volatile( 40663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng " trot %1,%2\n" 41663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng " ipm %0\n" 42663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng " srl %0,28\n" 43663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng : "=d"(cc),"+&d"(desaddr) 44663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng : "d" (srcaddr),"d"(test_byte),"d" (codepage2),"d"(length) 45663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng : "memory" ); 46663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 47663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.srcaddr = srcaddr; 48663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.len = length; 49663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.desaddr = desaddr; 50663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.tabaddr = codepage2; 51663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.testbyte = test_byte; 52663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.cc = cc; 53663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng return regs; 54663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} 55663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 56663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chengint run_test(void *srcaddr, void *tableaddr, void *desaddr, uint64_t len, 57663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint16_t testbyte) 58663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng{ 59663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng trot_regs regs; 60663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng int i; 61663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 62663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng assert(len <= sizeof src); 63663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 64663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((testbyte & 0xffff) != testbyte) 65663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("testbyte should be 2 byte only\n"); 66663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 67663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs = tr(srcaddr, tableaddr, desaddr, len, testbyte); 68663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 69663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((uint64_t)tableaddr != regs.tabaddr) 70663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("translation table address changed\n"); 71663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((uint64_t)srcaddr + (len - regs.len) != regs.srcaddr) 72663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("source address/length not updated properly\n"); 73663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((uint64_t)desaddr + 2*(len - regs.len) != regs.desaddr) 74663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("destination address/length not updated properly\n"); 75663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (regs.cc == 0 && regs.len != 0) 76663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("length is not zero but cc is zero\n"); 77663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("%u bytes translated\n", (unsigned)(len - regs.len)); 78663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("the translated values is"); 79663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng for (i = 0; i < len; i++) { 80663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf(" %hx", des[i]); 81663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng } 82663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("\n"); 83663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 84663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng return regs.cc; 85663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} 86663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 87663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 88663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chengint main() 89663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng{ 90663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng int cc; 91663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 92663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng assert(sizeof des >= sizeof src); 93663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 94663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng /* Test 1 : len == 0 */ 95663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(NULL, NULL, NULL, 0, 0x0); 96663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 97663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d", cc); 98663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 99663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 0, 0x0); 100663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 101663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 102663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 103663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 0, 0xcaca); 104663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 105663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 106663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 107663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng /* Test 2 : len > 0, testbyte not matching */ 108663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 3, 0xeeee); 109663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 110663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 111663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 112663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 10, 0xeeee); 113663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 114663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 115663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 116663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng memset((uint16_t *)&des, 0, 10); 117663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 118663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng /* Test 3 : len > 0 , testbyte matching */ 119663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 5, 0xffff); 120663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 1) 121663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 122663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 123663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 5, 0xcccc); 124663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 1) 125663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 126663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 127663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 10, 0xeaea); 128663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 1) 129663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 130663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 131663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng return 0; 132663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} 133