Continue work on C++ control + Rework joystick to full c++ + Tweak joystick values + Automatic switch to 4 stance + Position control by joystick