完成原始KMP算法代码
可以进行优化

Signed-off-by: Tpoy <tpoy@live.cn>