servo control Work in progress

porting found example to l152, struggle with timing