DSP Implementation of A-Control for A forwarder Crane Algorithm: Converting Matlab code to DSP code for a forwarder