Initial commit with test gyro and motor code