added some more math
updated fiducial tracking slightly and added some new files