Fixed measurement error with nextX, pushing working now, pulling 1/2 working