Fix start position, remove servo2 code

2-axis implementation removed, going into separate branch.