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