Added new commands for switching PID gains

Signed-off-by: Tushar Pankaj <tushar.s.pankaj@gmail.com>