PJ_DEF(pj_status_t) pj_sock_get_qos_params(pj_sock_t sock, pj_qos_params *p_param) { pj_status_t last_err = PJ_ENOTSUP; int val, optlen; pj_sockaddr sa; int salen = sizeof(salen); pj_status_t status; pj_bzero(p_param, sizeof(*p_param)); /* Get DSCP/TOS value */ status = pj_sock_getsockname(sock, &sa, &salen); if (status == PJ_SUCCESS) { optlen = sizeof(val); if (sa.addr.sa_family == pj_AF_INET()) { status = pj_sock_getsockopt(sock, pj_SOL_IP(), pj_IP_TOS(), &val, &optlen); } else if (sa.addr.sa_family == pj_AF_INET6()) { status = pj_sock_getsockopt(sock, pj_SOL_IPV6(), pj_IPV6_TCLASS(), &val, &optlen); } else { status = PJ_EINVAL; } if (status == PJ_SUCCESS) { p_param->flags |= PJ_QOS_PARAM_HAS_DSCP; p_param->dscp_val = (pj_uint8_t)(val >> 2); } else {
PJ_DEF(pj_status_t) pj_sock_get_qos_params(pj_sock_t sock, pj_qos_params *p_param) { pj_status_t status; int val, optlen; pj_sockaddr sa; int salen = sizeof(salen); PJ_ASSERT_RETURN(p_param, PJ_EINVAL); pj_bzero(p_param, sizeof(*p_param)); /* Try SO_NET_SERVICE_TYPE */ status = sock_get_net_service_type_params(sock, p_param); if (status != PJ_ENOTSUP) return status; /* Fall back to IP_TOS/IPV6_TCLASS */ status = pj_sock_getsockname(sock, &sa, &salen); if (status != PJ_SUCCESS) return status; optlen = sizeof(val); if (sa.addr.sa_family == pj_AF_INET()) { status = pj_sock_getsockopt(sock, pj_SOL_IP(), pj_IP_TOS(), &val, &optlen); } else if (sa.addr.sa_family == pj_AF_INET6()) { status = pj_sock_getsockopt(sock, pj_SOL_IPV6(), pj_IPV6_TCLASS(), &val, &optlen); } else status = PJ_EINVAL; if (status == PJ_SUCCESS) { p_param->flags |= PJ_QOS_PARAM_HAS_DSCP; p_param->dscp_val = (pj_uint8_t)(val >> 2); }
PJ_DEF(pj_status_t) pj_sock_set_qos_params(pj_sock_t sock, pj_qos_params *param) { pj_status_t last_err = PJ_ENOTSUP; pj_status_t status; /* No op? */ if (!param->flags) return PJ_SUCCESS; /* Clear WMM field since we don't support it */ param->flags &= ~(PJ_QOS_PARAM_HAS_WMM); /* Set TOS/DSCP */ if (param->flags & PJ_QOS_PARAM_HAS_DSCP) { /* We need to know if the socket is IPv4 or IPv6 */ pj_sockaddr sa; int salen = sizeof(salen); /* Value is dscp_val << 2 */ int val = (param->dscp_val << 2); status = pj_sock_getsockname(sock, &sa, &salen); if (status != PJ_SUCCESS) return status; if (sa.addr.sa_family == pj_AF_INET()) { /* In IPv4, the DS field goes in the TOS field */ status = pj_sock_setsockopt(sock, pj_SOL_IP(), pj_IP_TOS(), &val, sizeof(val)); } else if (sa.addr.sa_family == pj_AF_INET6()) { /* In IPv6, the DS field goes in the Traffic Class field */ status = pj_sock_setsockopt(sock, pj_SOL_IPV6(), pj_IPV6_TCLASS(), &val, sizeof(val)); } else { status = PJ_EINVAL; } if (status != PJ_SUCCESS) { param->flags &= ~(PJ_QOS_PARAM_HAS_DSCP); last_err = status; } } /* Set SO_PRIORITY */ if (param->flags & PJ_QOS_PARAM_HAS_SO_PRIO) { int val = param->so_prio; status = pj_sock_setsockopt(sock, pj_SOL_SOCKET(), pj_SO_PRIORITY(), &val, sizeof(val)); if (status != PJ_SUCCESS) { param->flags &= ~(PJ_QOS_PARAM_HAS_SO_PRIO); last_err = status; } } return param->flags ? PJ_SUCCESS : last_err; }
PJ_DEF(pj_status_t) pj_sock_get_qos_params(pj_sock_t sock, pj_qos_params *p_param) { pj_status_t last_err = PJ_ENOTSUP; int val, optlen; pj_status_t status; pj_bzero(p_param, sizeof(*p_param)); /* Get DSCP/TOS value */ optlen = sizeof(val); status = pj_sock_getsockopt(sock, pj_SOL_IP(), pj_IP_TOS(), &val, &optlen); if (status == PJ_SUCCESS) { p_param->flags |= PJ_QOS_PARAM_HAS_DSCP; p_param->dscp_val = (pj_uint8_t)(val >> 2); } else {
PJ_DEF(pj_status_t) pj_sock_set_qos_params(pj_sock_t sock, pj_qos_params *param) { pj_status_t last_err = PJ_ENOTSUP; pj_status_t status; /* No op? */ if (!param->flags) return PJ_SUCCESS; /* Clear WMM field since we don't support it */ param->flags &= ~(PJ_QOS_PARAM_HAS_WMM); /* Set TOS/DSCP */ if (param->flags & PJ_QOS_PARAM_HAS_DSCP) { /* Value is dscp_val << 2 */ int val = (param->dscp_val << 2); status = pj_sock_setsockopt(sock, pj_SOL_IP(), pj_IP_TOS(), &val, sizeof(val)); if (status != PJ_SUCCESS) { param->flags &= ~(PJ_QOS_PARAM_HAS_DSCP); last_err = status; } } /* Set SO_PRIORITY */ if (param->flags & PJ_QOS_PARAM_HAS_SO_PRIO) { int val = param->so_prio; status = pj_sock_setsockopt(sock, pj_SOL_SOCKET(), pj_SO_PRIORITY(), &val, sizeof(val)); if (status != PJ_SUCCESS) { param->flags &= ~(PJ_QOS_PARAM_HAS_SO_PRIO); last_err = status; } } return param->flags ? PJ_SUCCESS : last_err; }
static pj_status_t sock_set_ip_ds(pj_sock_t sock, pj_qos_params *param) { pj_status_t status = PJ_SUCCESS; PJ_ASSERT_RETURN(param, PJ_EINVAL); if (param->flags & PJ_QOS_PARAM_HAS_DSCP) { /* We need to know if the socket is IPv4 or IPv6 */ pj_sockaddr sa; int salen = sizeof(salen); /* Value is dscp_val << 2 */ int val = (param->dscp_val << 2); status = pj_sock_getsockname(sock, &sa, &salen); if (status != PJ_SUCCESS) return status; if (sa.addr.sa_family == pj_AF_INET()) { /* In IPv4, the DS field goes in the TOS field */ status = pj_sock_setsockopt(sock, pj_SOL_IP(), pj_IP_TOS(), &val, sizeof(val)); } else if (sa.addr.sa_family == pj_AF_INET6()) { /* In IPv6, the DS field goes in the Traffic Class field */ status = pj_sock_setsockopt(sock, pj_SOL_IPV6(), pj_IPV6_TCLASS(), &val, sizeof(val)); } else status = PJ_EINVAL; if (status != PJ_SUCCESS) { param->flags &= ~(PJ_QOS_PARAM_HAS_DSCP); } } return status; }