Imported my master's project code as well as team 341 image code

And used team 341's code to modify our square finding code to actually
work.