%Camera to position

clc;
clear all;
close all;

%Include source files in path
addpath(genpath('../src'))

%Initialization Parameters
server_ip   = '127.0.0.1';     %IP address of the Unity Server
server_port = 55001;           %Server Port of the Unity Sever

client = tcpclient(server_ip,server_port);
fprintf(1,"Connected to server\n");

% x,y,z,yaw[z],pitch[y],roll[x]
pose = [0,21,0,90,90,90];%[25,5,0,270,0,90];%;%;% 
unityImage = unityLink(client,pose);


FigH = figure;

imshow(unityImage);
saveas(FigH,append('Court.png'))

%Close Gracefully
fprintf(1,"Disconnected from server\n");