here is exactly what are you looking for. I was also making similar camera and it helped me a lot.
http://www.opserver.de/coni_users/web_users/pirvu/au/tutorials/zipped/camtut.pdf