forked from logzhan/RobotHardware-UESTC
235 lines
7.1 KiB
Python
235 lines
7.1 KiB
Python
|
#!/usr/bin/python
|
|||
|
|
# -*- coding: utf-8 -*-
|
|||
|
|
import os, sys, inspect
|
|||
|
|
import datetime
|
|||
|
|
import signal
|
|||
|
|
import threading
|
|||
|
|
import time
|
|||
|
|
# function: get directory of current script, if script is built
|
|||
|
|
# into an executable file, get directory of the excutable file
|
|||
|
|
def current_file_directory():
|
|||
|
|
path = os.path.realpath(sys.path[0]) # interpreter starter's path
|
|||
|
|
if os.path.isfile(path): # starter is excutable file
|
|||
|
|
path = os.path.dirname(path)
|
|||
|
|
path = os.path.abspath(path) # return excutable file's directory
|
|||
|
|
else: # starter is python script
|
|||
|
|
caller_file = inspect.stack()[0][1] # function caller's filename
|
|||
|
|
path = os.path.abspath(os.path.dirname(caller_file))# return function caller's file's directory
|
|||
|
|
if path[-1]!=os.path.sep:path+=os.path.sep
|
|||
|
|
return path
|
|||
|
|
|
|||
|
|
"""格式化字符串"""
|
|||
|
|
def formatString(string,*argv):
|
|||
|
|
string=string%argv
|
|||
|
|
if string.find('$(scriptpath)')>=0:
|
|||
|
|
string=string.replace('$(scriptpath)',current_file_directory())
|
|||
|
|
if string.find('$(filenumber2)')>=0:
|
|||
|
|
i=0
|
|||
|
|
path=""
|
|||
|
|
while True:
|
|||
|
|
path=string.replace('$(scriptpath)',"%02d"%i)
|
|||
|
|
if not os.path.lexists(path):break
|
|||
|
|
i+=1
|
|||
|
|
string=path
|
|||
|
|
#8位日期（20140404）
|
|||
|
|
if string.find('$(Date8)')>=0:
|
|||
|
|
now=datetime.datetime.now()
|
|||
|
|
string=string.replace('$(Date8)', now.strftime("%Y%m%d"))
|
|||
|
|
#6位日期（140404）
|
|||
|
|
if string.find('$(Date6)')>=0:
|
|||
|
|
now=datetime.datetime.now()
|
|||
|
|
string=string.replace('$(Date6)', now.strftime("%y%m%d"))
|
|||
|
|
#6位时间（121212）
|
|||
|
|
if string.find('$(Time6)')>=0:
|
|||
|
|
now=datetime.datetime.now()
|
|||
|
|
string=string.replace('$(Time6)', now.strftime("%H%M%S"))
|
|||
|
|
#4位时间（1212）
|
|||
|
|
if string.find('$(Time4)')>=0:
|
|||
|
|
now=datetime.datetime.now()
|
|||
|
|
string=string.replace('$(Time4)', now.strftime("%H%M"))
|
|||
|
|
#文件编号2位（必须在最后）
|
|||
|
|
if string.find('$(filenumber2)')>=0:
|
|||
|
|
i=0
|
|||
|
|
path=""
|
|||
|
|
while True:
|
|||
|
|
path=string.replace('$(filenumber2)',"%02d"%i)
|
|||
|
|
if not os.path.lexists(path):break
|
|||
|
|
i+=1
|
|||
|
|
string=path
|
|||
|
|
#文件编号3位（必须在最后）
|
|||
|
|
if string.find('$(filenumber3)')>=0:
|
|||
|
|
i=0
|
|||
|
|
path=""
|
|||
|
|
while True:
|
|||
|
|
path=string.replace('$(filenumber3)',"%03d"%i)
|
|||
|
|
if not os.path.lexists(path):break
|
|||
|
|
i+=1
|
|||
|
|
string=path
|
|||
|
|
return string
|
|||
|
|
|
|||
|
|
"""
|
|||
|
|
取得进程列表
|
|||
|
|
格式：(PID,cmd)
|
|||
|
|
"""
|
|||
|
|
def getProcessList():
|
|||
|
|
processList = []
|
|||
|
|
try:
|
|||
|
|
for line in os.popen("ps xa"):
|
|||
|
|
fields = line.split()
|
|||
|
|
# spid = fields[0]
|
|||
|
|
pid = 0
|
|||
|
|
try:pid = int(fields[0])
|
|||
|
|
except:None
|
|||
|
|
cmd = line[27:-1]
|
|||
|
|
# print "PS:%d,%s"%(npid,process)
|
|||
|
|
if pid != 0 and len(cmd) > 0:
|
|||
|
|
processList.append((pid, cmd))
|
|||
|
|
except Exception as e:
|
|||
|
|
print("getProcessList except:%s" % (e))
|
|||
|
|
return processList
|
|||
|
|
def killCommand(cmd):
|
|||
|
|
try:
|
|||
|
|
processList = getProcessList()
|
|||
|
|
for p in processList:
|
|||
|
|
if p[1].find(cmd) != -1:
|
|||
|
|
pid = p[0]
|
|||
|
|
os.kill(pid, signal.SIGKILL)
|
|||
|
|
except Exception as e:
|
|||
|
|
print("killCommand ‘%s’ except:%s" % (cmd,e))
|
|||
|
|
|
|||
|
|
def check_pid(pid):
|
|||
|
|
""" Check For the existence of a unix pid. """
|
|||
|
|
if pid == 0:return False
|
|||
|
|
try:
|
|||
|
|
os.kill(pid, 0)
|
|||
|
|
except OSError:
|
|||
|
|
return False
|
|||
|
|
else:
|
|||
|
|
return True
|
|||
|
|
|
|||
|
|
SF=formatString
|
|||
|
|
|
|||
|
|
#全局异常捕获
|
|||
|
|
def excepthook(excType, excValue, tb):
|
|||
|
|
'''''write the unhandle exception to log'''
|
|||
|
|
from log import log
|
|||
|
|
import traceback
|
|||
|
|
log.e('Unhandled Error: %s',''.join(traceback.format_exception(excType, excValue, tb)))
|
|||
|
|
sys.exit(-1)
|
|||
|
|
#sys.__excepthook__(type, value, trace)
|
|||
|
|
#sys.__excepthook__(excType, excValue, tb)
|
|||
|
|
|
|||
|
|
_defaultGlobalExcept=sys.excepthook
|
|||
|
|
|
|||
|
|
def enableGlobalExcept(enable=True):
|
|||
|
|
if enable:
|
|||
|
|
sys.excepthook = excepthook
|
|||
|
|
else:
|
|||
|
|
sys.excepthook=_defaultGlobalExcept
|
|||
|
|
# 默认启动全局异常处理
|
|||
|
|
enableGlobalExcept()
|
|||
|
|
#创建线程
|
|||
|
|
def createThread(name,target,args=(),autoRun=True,daemon=True):
|
|||
|
|
from log import log
|
|||
|
|
def threadProc():
|
|||
|
|
log.i("thread %s started!",name)
|
|||
|
|
try:
|
|||
|
|
target(*args)
|
|||
|
|
log.i("thread %s ended!",name)
|
|||
|
|
except Exception as e:
|
|||
|
|
log.e("thread %s crash!err=%s",name,e)
|
|||
|
|
thd=threading.Thread(name=name,target=threadProc)
|
|||
|
|
thd.setDaemon(daemon)
|
|||
|
|
if autoRun:thd.start()
|
|||
|
|
return thd
|
|||
|
|
|
|||
|
|
|
|||
|
|
#定时器
|
|||
|
|
class Timer():
|
|||
|
|
def __init__(self, timer_proc, args=(),first=0,period=0,name="Timer"):
|
|||
|
|
self.name=name
|
|||
|
|
self.first=first
|
|||
|
|
self.period=period
|
|||
|
|
self.args=args
|
|||
|
|
self.timer_proc=timer_proc
|
|||
|
|
self.thdWork=None
|
|||
|
|
self.stopFlag=False
|
|||
|
|
from log import NamedLog
|
|||
|
|
self.log=NamedLog(name)
|
|||
|
|
def run(self):
|
|||
|
|
if self.first>0:
|
|||
|
|
time.sleep(self.first)
|
|||
|
|
try:
|
|||
|
|
self.timer_proc(*self.args)
|
|||
|
|
except Exception as e:
|
|||
|
|
self.log.error("timer proc crash!err=%s",e)
|
|||
|
|
while self.period>0 and not self.stopFlag:
|
|||
|
|
time.sleep(self.period)
|
|||
|
|
try:
|
|||
|
|
self.timer_proc(*self.args)
|
|||
|
|
except Exception as e:
|
|||
|
|
self.log.error("timer proc crash!err=%s",e)
|
|||
|
|
def start(self):
|
|||
|
|
if self.isAlive():
|
|||
|
|
self.log.d("already running!")
|
|||
|
|
return True
|
|||
|
|
self.stopFlag=False
|
|||
|
|
self.thdWork=threading.Thread(name=self.name,target=self.run)
|
|||
|
|
self.thdWork.setDaemon(True)
|
|||
|
|
self.thdWork.start()
|
|||
|
|
def stop(self,timeout=3):
|
|||
|
|
if self.isAlive():
|
|||
|
|
self.stopFlag=True
|
|||
|
|
try:
|
|||
|
|
self.thdWork.join(timeout)
|
|||
|
|
except Exception as e:
|
|||
|
|
self.log.e("stop timeout!")
|
|||
|
|
|
|||
|
|
def isAlive(self):
|
|||
|
|
return self.thdWork and self.thdWork.isAlive()
|
|||
|
|
#计时器
|
|||
|
|
class Ticker():
|
|||
|
|
def __init__(self):
|
|||
|
|
self.reset()
|
|||
|
|
# 片段,可以判断时长是否在一个特定毫秒段内
|
|||
|
|
self.section=[]
|
|||
|
|
def reset(self):
|
|||
|
|
self.tick=time.time()
|
|||
|
|
self.end=0
|
|||
|
|
def stop(self):
|
|||
|
|
self.end=time.time()
|
|||
|
|
@property
|
|||
|
|
def ticker(self):
|
|||
|
|
if self.end==0:
|
|||
|
|
return int((time.time()-self.tick)*1000)
|
|||
|
|
else:
|
|||
|
|
return int((self.end-self.tick)*1000)
|
|||
|
|
def addSection(self,a,b):
|
|||
|
|
a,b=int(a),int(b)
|
|||
|
|
assert a<b
|
|||
|
|
self.section.append((a,b))
|
|||
|
|
def removeSection(self,a,b):
|
|||
|
|
a,b=int(a),int(b)
|
|||
|
|
self.section.remove((a,b))
|
|||
|
|
def removeAllSectioin(self):
|
|||
|
|
self.section=[]
|
|||
|
|
def inSection(self):
|
|||
|
|
tick=self.ticker
|
|||
|
|
for (a,b) in self.section:
|
|||
|
|
if tick>=a and tick<=b:
|
|||
|
|
return True
|
|||
|
|
return False
|
|||
|
|
def __call__(self):
|
|||
|
|
return self.ticker
|
|||
|
|
def waitExit():
|
|||
|
|
import log
|
|||
|
|
log.log.i("start waiting to exit...")
|
|||
|
|
try:
|
|||
|
|
while(True):
|
|||
|
|
time.sleep(1)
|
|||
|
|
except Exception as e:
|
|||
|
|
log.log.w("recv exit sign!")
|
|||
|
|
|
|||
|
|
def is_python3():
|
|||
|
|
return sys.hexversion > 0x03000000
|