Refer to CHAMP controller
I2C PCA9685 Controller: https://github.com/cholan2100/i2c_pwm_board CHAMP base: https://github.com/chvmp/champ
20 kgcm servos are recommended, cheaper MG996r are underwhelming to support dual leg movements. For MG996r i recommend using other gait implementation here, https://github.com/cholan2100/ceasar.git
https://github.com/cholan2100/spotmicro_description
Configure config/servos_calibration.yaml
roslaunch ceasar_config bringup.launch hardware_connected:=true
roslaunch champ_teleop teleop.launch joy:=true
Refer to original CHAMP controller for detailed documentation