Updated camera manager interface with camera id support; fixed some math functions and refactored a bit. Set up 3 cameras in the construct.