added forward40cm() and backward40cm()