I am currently working on the startup routine. I am coding a finite state machine to manage the different states and their transitions into one another. For example, I currently have idle, sitting, standing and walking states set up with events to transition from one to the other.

I'm in the process of coding the standing state, which will consist of sensing where each leg is, bring them in a safe sitting position, then stand up.