Using opencv again instead of crappy college code