def yawToQuat(angle): quatList = quaternion_from_euler(0.0,0.0,angle) quat = QuaternionMsg() quat.x = quatList[0] quat.y = quatList[1] quat.z = quatList[2] quat.w = quatList[3] return quat
def createQuat(x,y,z): quatList = quaternion_from_euler(x,y,z) quat = QuaternionMsg() quat.x = quatList[0] quat.y = quatList[1] quat.z = quatList[2] quat.w = quatList[3] return quat
def createQuat(x, y, z): quatList = quaternion_from_euler(x, y, z) quat = QuaternionMsg() quat.x = quatList[0] quat.y = quatList[1] quat.z = quatList[2] quat.w = quatList[3] return quat
def yawToQuat(angle): quatList = quaternion_from_euler(0.0, 0.0, angle) quat = QuaternionMsg() quat.x = quatList[0] quat.y = quatList[1] quat.z = quatList[2] quat.w = quatList[3] return quat