Added code to Camera subsystem

Todo next: Implement particle analysis
Update