from comm import *


class AppTest:
    def __init__(self, adr_module, adr_sensor):
        self.serial_port = SerialComm('/dev/ttyUSB0')
        self.module = adr_module
        self.sensor = adr_sensor

    def finish(self):
        self.serial_port.close()

    def cmd_version(self):
        resp = self.serial_port.request(self.module, 0, CMD_VERSION,[])
        version = chr(resp[3])+chr(resp[4])+chr(resp[5])
        print("Version: "+version)

    def cmd_echo(self):
        msg=[65,66,67,68,69,70]
        resp = self.serial_port.request(self.module, 0, CMD_ECHO,msg)
        echo = ""
        for r in range(len(msg)):
            echo = echo + chr(resp[3+r])
        print("Echo:"+echo)

    def cmd_set_param(self, param):        
        resp = self.serial_port.request(self.module, self.sensor, (SET+CMD_PARAM),[])     

    def cmd_get_param(self, param):        
        resp = self.serial_port.request(self.module, self.sensor, (CMD_PARAM),[])     

if __name__ == "__main__":
    
    app = AppTest(0x05, 0x0)
    # app.cmd_version()
    # app.cmd_version()
    # app.cmd_echo()
    app.cmd_set_param(5)
    app.cmd_get_param(5)
    app.finish()