fixed some compile errors. I am planning to add vision stuff later