This paper is seeking to add a CNC G-code to hexapod CNC system. The mentioned G-code is five axis tool radius compensation. Once the tool radius is changed, especially in the case of tool size changing with tool wear in machining, a new NC program has to be recreated. Five axis tool radius compensation correct cutter path automatically. This G-code contains all the main parts of a standard code such as: interpreter, interpolator and inverse kinematics unit. The interpreter unit extracts the position and orientation from the received code and sends it to the interpolation and kinematics units to correct the errors and achieve the desired six pods lengths. In the tool radius compensation algorithm, the unique vector of the movement direction of the tool tip and the normal vector of the machining surface have been used to calculate the direction of the tool radius compensation. The offset path is calculated by offsetting the tool path along the direction of the offset vector. Accuracy of the proposed method tested with a number of experiments. The experimental results confirmed the accuracy of the proposed methods.