motor sort of works, issues with calculating velocity though.