Nearly but far Finishing the algorithm and adding some
modification in Class
conversion form SI data to raw data
adding ralat pengukuran
adding sweepLeft sweepRight
adding offset 1 in cosinusMove
so the graph is always positive
fixing main.cpp
addin PID for targetLock
redesign library