#!/usr/bin/python

import os,sys,math
import numpy as np
from amsswcomm import *
import time


## Setup
GPIO.setmode(GPIO.BOARD);
    #other mode is GPIO.BCM - pin numberings are different?

com = amsswcomm()
com.comminit(1,3,7,5,4)




while(True):

    msg = input("Cmd: ")
    msgb = msg.encode(encoding="utf-8")
    msgb = np.frombuffer(msgb, dtype=np.uint8)
    

    t0 = time.time()
    t = time.time()
    com.send_message(msgb)
    while(com.has_message()==False and (t<t0+1)):
        com.update_step()
        t = time.time()

    
    reply = com.recv_message()
    print("reply: {}".format(reply))