1*5e3eaea3SApple OSS Distributionsfrom __future__ import absolute_import 2*5e3eaea3SApple OSS Distributions 3*5e3eaea3SApple OSS Distributionsfrom builtins import object 4*5e3eaea3SApple OSS Distributions 5*5e3eaea3SApple OSS Distributionsimport logging 6*5e3eaea3SApple OSS Distributionsfrom .interface import Interface 7*5e3eaea3SApple OSS Distributionsfrom . import rsprotocol 8*5e3eaea3SApple OSS Distributionsimport random 9*5e3eaea3SApple OSS Distributions 10*5e3eaea3SApple OSS Distributions 11*5e3eaea3SApple OSS Distributionsclass GDBServer(object): 12*5e3eaea3SApple OSS Distributions """instance of gdbserver""" 13*5e3eaea3SApple OSS Distributions def __init__(self, backing_instance): 14*5e3eaea3SApple OSS Distributions super(GDBServer, self).__init__() 15*5e3eaea3SApple OSS Distributions self.process = backing_instance 16*5e3eaea3SApple OSS Distributions self.portnum = random.randint(2000, 8000) 17*5e3eaea3SApple OSS Distributions logging.info("Starting gdb server for localhost:%d" % self.portnum) 18*5e3eaea3SApple OSS Distributions self.conn = Interface('localhost', self.portnum) 19*5e3eaea3SApple OSS Distributions self.version_string = 'name:kdbserver;version:0.1' 20*5e3eaea3SApple OSS Distributions 21*5e3eaea3SApple OSS Distributions def run(self): 22*5e3eaea3SApple OSS Distributions if not self.conn.connect(): 23*5e3eaea3SApple OSS Distributions logging.critical("No client connected. Bailing.") 24*5e3eaea3SApple OSS Distributions return False 25*5e3eaea3SApple OSS Distributions 26*5e3eaea3SApple OSS Distributions logging.debug('Starting gdb server.') 27*5e3eaea3SApple OSS Distributions 28*5e3eaea3SApple OSS Distributions while True: 29*5e3eaea3SApple OSS Distributions #loop for running the server. 30*5e3eaea3SApple OSS Distributions #read command 31*5e3eaea3SApple OSS Distributions readBytes = "" 32*5e3eaea3SApple OSS Distributions 33*5e3eaea3SApple OSS Distributions while True: 34*5e3eaea3SApple OSS Distributions try: 35*5e3eaea3SApple OSS Distributions p_bytes = self.conn.read() 36*5e3eaea3SApple OSS Distributions except Exception as e: 37*5e3eaea3SApple OSS Distributions logging.warn("found exception in read %s" % (str(e))) 38*5e3eaea3SApple OSS Distributions logging.debug("currentbytes: %s" % readBytes) 39*5e3eaea3SApple OSS Distributions readBytes = "" 40*5e3eaea3SApple OSS Distributions break 41*5e3eaea3SApple OSS Distributions readBytes += p_bytes.decode() 42*5e3eaea3SApple OSS Distributions p_begin = readBytes.find('$') 43*5e3eaea3SApple OSS Distributions p_end = readBytes.find('#') 44*5e3eaea3SApple OSS Distributions if p_begin >= 0 and p_end >= 0 and p_end > p_begin: 45*5e3eaea3SApple OSS Distributions break 46*5e3eaea3SApple OSS Distributions # ignore if empty or ack messages 47*5e3eaea3SApple OSS Distributions if readBytes in ('', '+'): 48*5e3eaea3SApple OSS Distributions logging.debug('ignoring message: %s' % readBytes) 49*5e3eaea3SApple OSS Distributions continue 50*5e3eaea3SApple OSS Distributions req_msg = rsprotocol.Message.fromRSPByteData(readBytes) 51*5e3eaea3SApple OSS Distributions resp = self.handleMessage(req_msg) 52*5e3eaea3SApple OSS Distributions #in case resp is to detach 53*5e3eaea3SApple OSS Distributions if resp is None: 54*5e3eaea3SApple OSS Distributions return True 55*5e3eaea3SApple OSS Distributions for r_msg in resp: 56*5e3eaea3SApple OSS Distributions logging.debug("response: %s" % r_msg.getRSPByteData()) 57*5e3eaea3SApple OSS Distributions self.conn.write(r_msg.getRSPByteData()) 58*5e3eaea3SApple OSS Distributions return True 59*5e3eaea3SApple OSS Distributions 60*5e3eaea3SApple OSS Distributions def handleMessage(self, msg): 61*5e3eaea3SApple OSS Distributions """ return array of messages that needs to responded. """ 62*5e3eaea3SApple OSS Distributions query = msg.getData() 63*5e3eaea3SApple OSS Distributions replymsgs = [] 64*5e3eaea3SApple OSS Distributions sendAck = None 65*5e3eaea3SApple OSS Distributions logging.debug('RCV:' + query) 66*5e3eaea3SApple OSS Distributions 67*5e3eaea3SApple OSS Distributions if query == "?": 68*5e3eaea3SApple OSS Distributions h_msg = rsprotocol.Message(self.process.getSignalInfo()) 69*5e3eaea3SApple OSS Distributions replymsgs.append(h_msg) 70*5e3eaea3SApple OSS Distributions 71*5e3eaea3SApple OSS Distributions elif query[0] == 'm': 72*5e3eaea3SApple OSS Distributions replymsgs.append(self.getMemory(query)) 73*5e3eaea3SApple OSS Distributions 74*5e3eaea3SApple OSS Distributions elif query in ('qVAttachOrWaitSupported'): 75*5e3eaea3SApple OSS Distributions logging.debug('Ignoring query %s' % query) 76*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.UnSupportedMessage) 77*5e3eaea3SApple OSS Distributions 78*5e3eaea3SApple OSS Distributions elif query == "qC": 79*5e3eaea3SApple OSS Distributions replymsgs.append(self.getCurrentThreadID(query)) 80*5e3eaea3SApple OSS Distributions 81*5e3eaea3SApple OSS Distributions elif query[0] in ('z', 'Z'): 82*5e3eaea3SApple OSS Distributions logging.debug('Ignoring breakpoint query %s' % query) 83*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.UnSupportedMessage) 84*5e3eaea3SApple OSS Distributions 85*5e3eaea3SApple OSS Distributions elif query[0] in ('g', 'p'): 86*5e3eaea3SApple OSS Distributions replymsgs.append(self.getRegisterData(query)) 87*5e3eaea3SApple OSS Distributions 88*5e3eaea3SApple OSS Distributions elif query[0] in ('P', 'G'): 89*5e3eaea3SApple OSS Distributions # we do not support writing into registers 90*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.Message('E05')) 91*5e3eaea3SApple OSS Distributions 92*5e3eaea3SApple OSS Distributions elif query in ('QStartNoAckMode'): 93*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.OKMessage) 94*5e3eaea3SApple OSS Distributions sendAck = True 95*5e3eaea3SApple OSS Distributions 96*5e3eaea3SApple OSS Distributions elif query in ('QListThreadsInStopReply', 'QThreadSuffixSupported'): 97*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.OKMessage) 98*5e3eaea3SApple OSS Distributions 99*5e3eaea3SApple OSS Distributions elif query == 'qGDBServerVersion': 100*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.Message(self.version_string)) 101*5e3eaea3SApple OSS Distributions 102*5e3eaea3SApple OSS Distributions elif query == 'qShlibInfoAddr': 103*5e3eaea3SApple OSS Distributions #return shared library info address if any 104*5e3eaea3SApple OSS Distributions replymsgs.append(self.getSharedLibInfoAddress(query)) 105*5e3eaea3SApple OSS Distributions 106*5e3eaea3SApple OSS Distributions elif query == 'qProcessInfo': 107*5e3eaea3SApple OSS Distributions replymsgs.append(self.getProcessInfo(query)) 108*5e3eaea3SApple OSS Distributions 109*5e3eaea3SApple OSS Distributions elif query == 'qHostInfo': 110*5e3eaea3SApple OSS Distributions h_msg = rsprotocol.Message(self.process.getHostInfo()) 111*5e3eaea3SApple OSS Distributions replymsgs.append(h_msg) 112*5e3eaea3SApple OSS Distributions 113*5e3eaea3SApple OSS Distributions elif query == 'vCont?': 114*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.Message('vCont;')) 115*5e3eaea3SApple OSS Distributions 116*5e3eaea3SApple OSS Distributions elif query == 'D': 117*5e3eaea3SApple OSS Distributions logging.info('Client requested to detach.') 118*5e3eaea3SApple OSS Distributions return None 119*5e3eaea3SApple OSS Distributions 120*5e3eaea3SApple OSS Distributions elif query.find('qRegisterInfo') >= 0: 121*5e3eaea3SApple OSS Distributions replymsgs.append(self.getRegisterInfo(query)) 122*5e3eaea3SApple OSS Distributions 123*5e3eaea3SApple OSS Distributions elif query.find('qMemoryRegionInfo') >= 0: 124*5e3eaea3SApple OSS Distributions replymsgs.append(self.getMemoryRegionInfo(query)) 125*5e3eaea3SApple OSS Distributions 126*5e3eaea3SApple OSS Distributions elif query.find('qThreadStopInfo') >= 0 or query in ('qfThreadInfo', 'qsThreadInfo'): 127*5e3eaea3SApple OSS Distributions replymsgs.append(self.getThreadRegistersInfo(query)) 128*5e3eaea3SApple OSS Distributions 129*5e3eaea3SApple OSS Distributions else: 130*5e3eaea3SApple OSS Distributions replymsgs.append(rsprotocol.UnSupportedMessage) 131*5e3eaea3SApple OSS Distributions 132*5e3eaea3SApple OSS Distributions if sendAck is not None: 133*5e3eaea3SApple OSS Distributions if sendAck: 134*5e3eaea3SApple OSS Distributions replymsgs.insert(0, rsprotocol.AckMessage) 135*5e3eaea3SApple OSS Distributions else: 136*5e3eaea3SApple OSS Distributions replymsgs.insert(0, rsprotocol.NAckMessage) 137*5e3eaea3SApple OSS Distributions 138*5e3eaea3SApple OSS Distributions return replymsgs 139*5e3eaea3SApple OSS Distributions 140*5e3eaea3SApple OSS Distributions def getThreadRegistersInfo(self, query): 141*5e3eaea3SApple OSS Distributions bytes = '' 142*5e3eaea3SApple OSS Distributions if query == 'qfThreadInfo': 143*5e3eaea3SApple OSS Distributions bytes = self.process.getFirstThreadInfo() 144*5e3eaea3SApple OSS Distributions elif query == 'qsThreadInfo': 145*5e3eaea3SApple OSS Distributions bytes = self.process.getSubsequestThreadInfo() 146*5e3eaea3SApple OSS Distributions else: 147*5e3eaea3SApple OSS Distributions try: 148*5e3eaea3SApple OSS Distributions query = query.replace('qThreadStopInfo', '') 149*5e3eaea3SApple OSS Distributions tid = int(query, 16) 150*5e3eaea3SApple OSS Distributions bytes = self.process.getThreadStopInfo(tid) 151*5e3eaea3SApple OSS Distributions except Exception as e: 152*5e3eaea3SApple OSS Distributions logging.error("Failed to get register information query: %s error: %s" % (query, e)) 153*5e3eaea3SApple OSS Distributions return rsprotocol.Message(bytes) 154*5e3eaea3SApple OSS Distributions 155*5e3eaea3SApple OSS Distributions def getRegisterData(self, query): 156*5e3eaea3SApple OSS Distributions if query[0] == 'g': 157*5e3eaea3SApple OSS Distributions #TODO should implement this sometime. Considering getThreadRegistersInfo is there 158*5e3eaea3SApple OSS Distributions #we wont need this one. 159*5e3eaea3SApple OSS Distributions return rsprotocol.UnSupportedMessage 160*5e3eaea3SApple OSS Distributions 161*5e3eaea3SApple OSS Distributions #the query is of type p<regnum>;thread:<id>; 162*5e3eaea3SApple OSS Distributions bytes = '' 163*5e3eaea3SApple OSS Distributions try: 164*5e3eaea3SApple OSS Distributions args = query[1:].split(';') 165*5e3eaea3SApple OSS Distributions if len(args) > 0: 166*5e3eaea3SApple OSS Distributions regnum = int(args[0], 16) 167*5e3eaea3SApple OSS Distributions if args[1].find('thread') >= 0: 168*5e3eaea3SApple OSS Distributions threadid = int(args[1].split(':')[-1], 16) 169*5e3eaea3SApple OSS Distributions bytes = self.process.getRegisterDataForThread(threadid, regnum) 170*5e3eaea3SApple OSS Distributions logging.debug('REGISTER INFO bytes = ' + bytes) 171*5e3eaea3SApple OSS Distributions except Exception as e: 172*5e3eaea3SApple OSS Distributions logging.error("Failed to get register information query: %s error: %s" % (query, e)) 173*5e3eaea3SApple OSS Distributions return rsprotocol.Message(bytes) 174*5e3eaea3SApple OSS Distributions 175*5e3eaea3SApple OSS Distributions def getRegisterInfo(self, query): 176*5e3eaea3SApple OSS Distributions bytes = '' 177*5e3eaea3SApple OSS Distributions try: 178*5e3eaea3SApple OSS Distributions query_index = query.replace('qRegisterInfo', '') 179*5e3eaea3SApple OSS Distributions regnum = int(query_index, 16) 180*5e3eaea3SApple OSS Distributions bytes = self.process.getRegisterInfo(regnum) 181*5e3eaea3SApple OSS Distributions except Exception as e: 182*5e3eaea3SApple OSS Distributions logging.error("Non-fatal: Failed to get register information: query: %s error: %s" % (query, e)) 183*5e3eaea3SApple OSS Distributions return rsprotocol.Message(bytes) 184*5e3eaea3SApple OSS Distributions 185*5e3eaea3SApple OSS Distributions def getMemory(self, query): 186*5e3eaea3SApple OSS Distributions query = query[1:] 187*5e3eaea3SApple OSS Distributions addr, size = query.split(',') 188*5e3eaea3SApple OSS Distributions mem_address = int(addr, 16) 189*5e3eaea3SApple OSS Distributions mem_size = int(size, 16) 190*5e3eaea3SApple OSS Distributions bytes = '' 191*5e3eaea3SApple OSS Distributions try: 192*5e3eaea3SApple OSS Distributions bytes = self.process.readMemory(mem_address, mem_size) 193*5e3eaea3SApple OSS Distributions except Exception as e: 194*5e3eaea3SApple OSS Distributions logging.warn('Failed to read data %s' % str(e)) 195*5e3eaea3SApple OSS Distributions return rsprotocol.Message('E03') 196*5e3eaea3SApple OSS Distributions return rsprotocol.Message(bytes) 197*5e3eaea3SApple OSS Distributions 198*5e3eaea3SApple OSS Distributions def getMemoryRegionInfo(self, query): 199*5e3eaea3SApple OSS Distributions return rsprotocol.UnSupportedMessage 200*5e3eaea3SApple OSS Distributions 201*5e3eaea3SApple OSS Distributions def setMemory(self, query): 202*5e3eaea3SApple OSS Distributions logging.info('Not supporting writing to memory. %s' % query) 203*5e3eaea3SApple OSS Distributions return rsprotocol.Message('E09') 204*5e3eaea3SApple OSS Distributions 205*5e3eaea3SApple OSS Distributions def getProcessInfo(self, query): 206*5e3eaea3SApple OSS Distributions data = '' 207*5e3eaea3SApple OSS Distributions try: 208*5e3eaea3SApple OSS Distributions data = self.process.getProcessInfo() 209*5e3eaea3SApple OSS Distributions except Exception as e: 210*5e3eaea3SApple OSS Distributions logging.error("Failed to get process information") 211*5e3eaea3SApple OSS Distributions return rsprotocol.Message(data) 212*5e3eaea3SApple OSS Distributions 213*5e3eaea3SApple OSS Distributions def getSharedLibInfoAddress(self, query): 214*5e3eaea3SApple OSS Distributions data = 'E44' 215*5e3eaea3SApple OSS Distributions try: 216*5e3eaea3SApple OSS Distributions data = self.process.getSharedLibInfoAddress() 217*5e3eaea3SApple OSS Distributions data = self.process.encodeThreadID(data) 218*5e3eaea3SApple OSS Distributions except Exception as e: 219*5e3eaea3SApple OSS Distributions logging.error("Failed to get Shared Library information") 220*5e3eaea3SApple OSS Distributions return rsprotocol.Message(data) 221*5e3eaea3SApple OSS Distributions 222*5e3eaea3SApple OSS Distributions def getCurrentThreadID(self, query): 223*5e3eaea3SApple OSS Distributions tid = '0' 224*5e3eaea3SApple OSS Distributions try: 225*5e3eaea3SApple OSS Distributions tid = '%x' % (self.process.getCurrentThreadID()) 226*5e3eaea3SApple OSS Distributions except Exception as e: 227*5e3eaea3SApple OSS Distributions logging.error("Failed to get QC info") 228*5e3eaea3SApple OSS Distributions 229*5e3eaea3SApple OSS Distributions return rsprotocol.Message('QC'+tid) 230*5e3eaea3SApple OSS Distributions 231*5e3eaea3SApple OSS Distributions def kill(self): 232*5e3eaea3SApple OSS Distributions pass 233