Uploaded new proposed code for arduino and wrote pseudocode in python to simulate control of servos in order to take readings