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