Equation for chain to use when climbing

[GalexY727]

User Story

If we want to keep the robot stabilized, we might find it useful to see where the chain is relative to the robot so that we can set our climbers to be at an offset with one another to prevent tipping.
The current code has this pseudo logic in place but it only works for three positions on the chain, an equation might make it easier to work with all together
Plus, I already made an equation to represent the chain mathematically (units are in meters)

Equation: 3/10x^2+0.725 ; { | x | < 1.3 }

Acceptance Criteria

• Using the equation, find the closest chain to our robot and see where how high the hooks need to be and what offset to put them at to keep the robot stabilized
  • This could be a command, or could be logic inside of PoseCalculations.java... I'm not sure how it should be structured quite yet.

[GalexY727]

In my humble opinion this was in fact not complicated