Jaggedhead solution works Ok in Uno, using Timer 1 there will be no conflict with the motor shield.
I've attached an screenshot...