Yes, Happy Easter!
Yes, MG995 is not ideal, but it is what I have.
Here is an updated picture that shows the motion & restriction of the right servo arm, as well as how it translates to the knee. It is in orange and in the code/diagram theta2 is this knee/servo. What I see by drawing this, is that I only need to take the 'supplement angle' from beta (180-beta), and that should be the correct angle for the servo. With additional protection restrictions to keep it between min-max.
the black bar is a push rod or cam(?). it runs parallel to the hip/upper leg. it push/pulls the knee at the same rate. It forms a parallelogram with the upper leg. The motion of the right servo arm is independent from the hip servo, that upper triangle the bar is connected to is 'free' of the hip servo, but rotates on the hip servo axis.
Here is a short video of the non-IK version moving up down. It has 370g of weight on it.
https://www.youtube....rts/_2CwU8cZ-0Q
- Oracid aime ceci