modify pca953x driver and did some changes in main.c.

Signed-off-by: cctsao1008 <chiacheng.tsao@gmail.com>