fixed the wrong y co-ordinates being in put into the system
currently attaining pretty accurate x-y-z co-ordinates for the system. Working on compressing the image to get to a good framerate
got the speed up to 1fps, not using mask, not currently updating the rectangle found