Add source code and test data

Signed-off-by: Max Liao <liaops@embedinfo.com>