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 TROO 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 uint8_t testbyte; 13663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint64_t cc; 14663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} troo_regs; 15663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 16663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chenguint8_t tran_table[20] = { 17663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 0xaa,0xbb,0xcc,0xdd,0xff,0xda,0xbc,0xab,0xca,0xea,0xcc,0xee 18663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng}; 19663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 20663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chenguint8_t src[20] = { 21663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 0x04,0x01,0x03,0x07,0x08,0x06,0x02,0x05,0x09 22663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng}; 23663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 24663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chenguint8_t des[20]; 25663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 26663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chengtroo_regs tr(uint8_t *addr, uint8_t *codepage, uint8_t *dest, uint64_t len, 27663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint8_t test) 28663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng{ 29663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng troo_regs regs; 30663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t test_byte asm("0") = test; 31663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t length asm("3") = len; 32663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t srcaddr asm("4") = (uint64_t)addr; 33663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t codepage2 asm("1") = (uint64_t)codepage; 34663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t desaddr asm("2") = (uint64_t)dest; 35663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng register uint64_t cc asm("5"); 36663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 37663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = 2; /* cc result will never be 2 */ 38663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng asm volatile( 39663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng " troo %1,%2\n" 40663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng " ipm %0\n" 41663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng " srl %0,28\n" 42663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng : "=d"(cc),"+&d"(desaddr) 43663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng : "d" (srcaddr),"d"(test_byte),"d" (codepage2),"d"(length) 44663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng : "memory" ); 45663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 46663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.srcaddr = srcaddr; 47663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.len = length; 48663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.desaddr = desaddr; 49663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.tabaddr = codepage2; 50663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.testbyte = test_byte; 51663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs.cc = cc; 52663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng return regs; 53663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} 54663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 55663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chengint run_test(void *srcaddr, void *tableaddr, void *desaddr, uint64_t len, 56663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng uint8_t testbyte) 57663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng{ 58663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng troo_regs regs; 59663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng int i; 60663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 61663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng assert(len <= sizeof src); 62663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 63663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((testbyte & 0xff) != testbyte) 64663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("testbyte should be 1 byte only\n"); 65663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 66663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng regs = tr(srcaddr, tableaddr, desaddr, len, testbyte); 67663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 68663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((uint64_t)tableaddr != regs.tabaddr) 69663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("translation table address changed\n"); 70663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((uint64_t)srcaddr + (len - regs.len) != regs.srcaddr) 71663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("source address/length not updated properly\n"); 72663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if ((uint64_t)desaddr + (len - regs.len) != regs.desaddr) 73663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("destination address/length not updated properly\n"); 74663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (regs.cc == 0 && regs.len != 0) 75663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("length is not zero but cc is zero\n"); 76663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("%u bytes translated\n", (unsigned)(len - regs.len)); 77663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("the translated values are"); 78663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng for (i = 0; i < len - regs.len; i++) { 79663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf(" %x", des[i]); 80663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng } 81663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("\n"); 82663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 83663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng return regs.cc; 84663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} 85663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 86663860b1408516d02ebfcb3a9999a134e6cfb223Ben Chengint main() 87663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng{ 88663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng int cc; 89663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 90663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng assert(sizeof des >= sizeof src); 91663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 92663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng /* Test 1 : len == 0 */ 93663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(NULL, NULL, NULL, 0, 0x0); 94663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 95663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d", cc); 96663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 97663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 0, 0xca); 98663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 99663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 100663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 101663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng /* Test 2 : len > 0, testbyte not matching */ 102663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 5, 0xee); 103663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 104663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 105663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 106663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 10, 0x00); 107663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 0) 108663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 109663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 110663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng memset((char *)&des, 0, 10); 111663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 112663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng /* Test 3 : len > 0, testbyte matching */ 113663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 5, 0xff); /* 1st byte matches */ 114663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 1) 115663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 116663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 117663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 5, 0xbb); /* 2nd byte matches */ 118663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 1) 119663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 120663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 121663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng cc = run_test(&src, &tran_table, &des, 10, 0xea); 122663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng if (cc != 1) 123663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng printf("cc not updated properly:%d",cc); 124663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng 125663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng return 0; 126663860b1408516d02ebfcb3a9999a134e6cfb223Ben Cheng} 127