Added code to test the Vicon system
1. Also added code to test socket comms.