@SSK I know that you have a working solution, another option Instead of receiving the robot data into a byte array, would be creating a data structure of length of the byte array, then creating a variable of said type. This variable then would have all your data in correct format that align the bytes into the output data types. This would eliminate the need for any conversions within the program.