Tested and fixed initial camera control code, to be merged with main upon further testing