Added holonomic drive functions

1 boring holonomic drive function and one smart holonomic drive
function that allows you to move in a directions while passively
rotating.