La rutina de teclado que usas del ccs, ya esta preparada para ello, no tienes que realizar ninguna modificación, ten en cuenta que las dos rutinas, la de lcd y teclado, no se ejecutan a la vez, y cada una re define las entradas y salidas antes de usarlas, de todas formas no olvides poner en serie unas resistencias con las columnas, pues son necesarias para absorber los estados bajos y altos cuando entran en conflicto con el valor que tu fuerzas al pulsar un botón.