Made PWM not divide period and cmp value by 2. Manual CMP values means that pulses are the expected way around (same as data sheet). Still needs testing