Robot kinematics, dynamics and controls in python