Fix intrinsics / extrinsics calculation
Added basic UI