48 lines
1.5 KiB
Python
48 lines
1.5 KiB
Python
SOCKET_PATH = "/tmp/compLib"
|
|
|
|
|
|
# def send(data, size):
|
|
# with socket.socket(socket.AF_UNIX, socket.SOCK_STREAM) as sock:
|
|
# sock.connect(SOCKET_PATH)
|
|
# sock.sendall(size.to_bytes(1, byteorder='big'))
|
|
# sock.sendall(data)
|
|
#
|
|
# response_size_bytes = sock.recv(1)
|
|
# response_size = int.from_bytes(response_size_bytes, byteorder="big")
|
|
# # print(f"Response size: {response_size}")
|
|
#
|
|
# response_bytes = sock.recv(response_size)
|
|
# generic_response = CompLib_pb2.GenericResponse()
|
|
#
|
|
# generic_response.ParseFromString(response_bytes)
|
|
# # print(f"Response: {generic_response}")
|
|
#
|
|
# # reponseBytes =
|
|
|
|
|
|
def main():
|
|
# encoder_read_positions_request = CompLib_pb2.EncoderReadPositionsRequest()
|
|
# # readSensorsRequest.header = CompLib_pb2.Header()
|
|
# encoder_read_positions_request.header.message_type = encoder_read_positions_request.DESCRIPTOR.full_name
|
|
#
|
|
# start_time = time.time()
|
|
# for i in range(100000):
|
|
# send(encoder_read_positions_request.SerializeToString(), encoder_read_positions_request.ByteSize())
|
|
# print("--- %s seconds ---" % (time.time() - start_time))
|
|
|
|
# from compLib.IRSensor import IRSensor
|
|
# IRSensor.read_all()
|
|
#
|
|
from compLib.Encoder import Encoder
|
|
Encoder.read_all_positions()
|
|
Encoder.read_all_velocities()
|
|
|
|
# from compLib.Motor import Motor
|
|
# Motor.speed(0, 50)
|
|
# Motor.speed(3, -50)
|
|
|
|
# time.sleep(10)
|
|
|
|
|
|
if __name__ == '__main__':
|
|
main()
|