Two things... the target passed to the isWithinRangeOfTarget and the value passed to the setPosition() function should reference the same value os if they change, they change together. In the code below, if the position is 0, but the Position.HOME is changes to 1, the arm will never move.
Also, the shoulder positions...
...seem to reference angle in degrees away from home, but this is not how the shoulder is commanded in practice:
It looks like there is an encoder offset value:
...we should double-check that value tomorrow. Based on what we saw today, I don't think the arm can get to zero.
Two things... the target passed to the isWithinRangeOfTarget and the value passed to the setPosition() function should reference the same value os if they change, they change together. In the code below, if the position is 0, but the Position.HOME is changes to 1, the arm will never move.
Also, the shoulder positions... ...seem to reference angle in degrees away from home, but this is not how the shoulder is commanded in practice:
It looks like there is an encoder offset value: ...we should double-check that value tomorrow. Based on what we saw today, I don't think the arm can get to zero.