| 278,17 → 278,20 |
|---|
| print "DebugMsg: \"%s\"" % line[:-1] |
| pass |
| return msg |
| |
| def sendMsg(self, msg): |
| self.sendLn(msg.generateUartLine()) |
| |
| def sendNCRedirectUartFromFC(self): |
| self.serPort.flushInput() |
| msg = MkMsg(address=MkComm.ADDRESS_NC, cmd='u', data=[0]) |
| self.sendLn(msg.generateUartLine()) |
| self.sendMsg(msg) |
| time.sleep(.5) |
| # No reply expected... |
| |
| def sendSettings(self, settings): |
| msg = MkMsg(address=MkComm.ADDRESS_FC, cmd='s', data=settings) |
| self.sendLn(msg.generateUartLine()) |
| self.sendMsg(msg) |
| time.sleep(1) |
| msg = self.waitForMsg('S') |
| |
| 302,7 → 305,7 |
|---|
| def getSettingsMsg(self, index=0xFF): |
| self.serPort.flushInput() |
| msg = MkMsg(address=MkComm.ADDRESS_FC, cmd='q', data=[index]) |
| self.sendLn(msg.generateUartLine()) |
| self.sendMsg(msg) |
| msg = self.waitForMsg('Q') |
| msg = SettingsMsg(msg) |
| return msg |
| 315,13 → 318,13 |
|---|
| |
| def setMotorTest(self, motorSpeeds): |
| msg = MkMsg(address=MkComm.ADDRESS_FC, cmd='t', data=motorSpeeds) |
| self.sendLn(msg.generateUartLine()) |
| self.sendMsg(msg) |
| |
| def doVibrationTest(self, nbSamples, channel): |
| data = [] |
| for i in range(0,(min(nbSamples,1000)/50)): |
| msg = MkMsg(address=MkComm.ADDRESS_FC, cmd='f', data=[channel, i]) |
| self.sendLn(msg.generateUartLine()) |
| self.sendMsg(msg) |
| msg = self.waitForMsg('F') |
| msg = VibrationDataMsg(msg) |
| data += msg.getData() |
| 333,8 → 336,6 |
|---|
| |
| |
| |
| |
| |
| if __name__ == '__main__': |
| try: |
| comm = MkComm() |