Modified pubsubclient.c and pubsubclient.h