So you have X forward and Z up. Now is Y to the right or left? Is this right handed system or ??!!??

Coordinate transforms math is the most fundamental piece that needs to be understood in robotics if you want to use any …