leontu 发表于 2023-3-16 21:29:43

Pixhawk-nuttx的相关函数解析

内容参考自:CFZ明的博客,如有侵权,请联系删除

Syntax(句法):int poll(struct pollfd fds[], nfds_t nfds, int timeout)

Function(功能):监控文件描述符(多个);

Explain(说明):timemout=0,poll()函数立即返回而不阻塞;timeout=INFTIM(-1),poll()会一直阻塞下去,直到检测到return > 0;

Parameter(参数):

fds:struct pollfd结构类型的数组;

nfds:用于标记数组fds中的结构体元素的总数量;

timeout:是poll函数调用阻塞的时间,单位:毫秒;

Returned value(返回值):

>0:数组fds中准备好读、写或出错状态的那些socket描述符的总数量;

   ==0:poll()函数会阻塞timeout所指定的毫秒时间长度之后返回;

-1:poll函数调用失败;同时会自动设置全局变量errno;


Syntax:int orb_subscribe(const struct orb_metadata *meta)

Function:订阅主题(topic)

Explain:即使订阅的主题没有被公告,但是也能订阅成功;但是在这种情况下,却得不到数据,直到主题被公告;

Parameter:

meta:uORB元对象,可以认为是主题id,一般是通过ORB_ID(主题名)来赋值;

Returned value:

错误则返回ERROR;

成功则返回一个可以读取数据、更新话题的句柄;如果待订阅的主题没有定义或声明则会返回-1,然后会将errno赋值为ENOENT;

eg:

int fd = orb_subscribe(ORB_ID(topicName));

Syntax:int orb_copy(const struct orb_metadata *meta, int handle, void *buffer)

Function:从订阅的主题中获取数据并将数据保存到buffer中;

Parameter:

meta:uORB元对象,可以认为是主题id,一般是通过ORB_ID(主题名)来赋值;

handle:订阅主题返回的句柄;

buffer:从主题中获取的数据;

Returned value:

返回OK表示获取数据成功;

错误返回ERROR;否则则有根据的去设置errno;

eg:

structsensor_combined_s raw;

orb_copy(ORB_ID(sensor_combined), sensor_sub_fd, &raw);

Syntax:orb_advert_torb_advertise(const struct orb_metadata *meta, const void *data)

Function:公告发布者的主题;

Explain:在发布主题之前是必须的,否则订阅者虽然能订阅,但是得不到数据;

Parameter:

meta:uORB元对象,可以认为是主题id,一般是通过ORB_ID(主题名)来赋值;;

data:指向一个已被初始化,发布者要发布的数据存储变量的指针;

Returned value:

错误则返回ERROR;

成功则返回一个可以发布主题的句柄;

如果待发布的主题没有定义或声明则会返回-1,然后会将errno赋值为ENOENT;

eg:

struct vehicle_attitude_s att;

memset(&att, 0, sizeof(att));

int att_pub_fd = orb_advertise(ORB_ID(vehicle_attitude), &att);

Syntax:intorb_publish(const struct orb_metadata *meta, orb_advert_t handle, const void *data)

Function:发布新数据到主题;

Parameter:

meta:uORB元对象,可以认为是主题id,一般是通过ORB_ID(主题名)来赋值;

handle:orb_advertise函数返回的句柄;

data:指向待发布数据的指针;

Returned value:

OK表示成功;

错误返回ERROR;

否则则有根据的去设置errno;

eg:

orb_publish(ORB_ID(vehicle_attitude), att_pub_fd, &att);

Syntax:int orb_set_interval(int handle, unsigned interval)

Function:设置订阅的最小时间间隔;

Explain:如果设置了,则在这间隔内发布的数据将订阅不到;需要注意的是,设置后,第一次的数据订阅还是由起初设置的频率来获取,

Parameter:

handle:orb_subscribe函数返回的句柄;

interval:间隔时间,单位ms;

Returned value:

OK表示成功;

错误返回ERROR;

否则则有根据的去设置errno;

eg:

orb_set_interval(sensor_sub_fd, 1000);

Syntax:orb_advert_t orb_advertise_multi(const struct orb_metadata *meta, const void *data, int *instance, int priority)

Function:设备/驱动器的多个实例实现公告,利用此函数可以注册多个类似的驱动程序;

Explain:例如在飞行器中有多个相同的传感器,那他们的数据类型则类似,不必要注册几个不同的话题;

Parameter:

meta:uORB元对象,可以认为是主题id,一般是通过ORB_ID(主题名)来赋值;

data:指向一个已被初始化,发布者要发布的数据存储变量的指针;

instance:整型指针,指向实例的ID(从0开始);

priority:实例的优先级。如果用户订阅多个实例,优先级的设定可以使用户使用优先级高的最优数据源;

Returned value:

错误则返回ERROR;

成功则返回一个可以发布主题的句柄;

如果待发布的主题没有定义或声明则会返回-1,然后会将errno赋值为ENOENT;

eg:

struct orb_test t;

t.val = 0;

int instance0;

orb_advert_t pfd0 = orb_advertise_multi(ORB_ID(orb_multitest), &t, &instance0, ORB_PRIO_MAX);

Syntax:int orb_subscribe_multi(const struct orb_metadata *meta, unsigned instance)

Function:订阅主题(topic);

Explain:通过实例的ID索引来确定是主题的哪个实例;

Parameter:

meta:uORB元对象,可以认为是主题id,一般是通过ORB_ID(主题名)来赋;

instance:主题实例ID;

实例ID=0与orb_subscribe()实现相同;

Returned value:

错误则返回ERROR;

成功则返回一个可以读取数据、更新话题的句柄;

如果待订阅的主题没有定义或声明则会返回-1,然后会将errno赋值为ENOENT;

eg:

int sfd1 = orb_subscribe_multi(ORB_ID(orb_multitest), 1);

Syntax:int orb_unsubscribe(int handle)

Function:取消订阅主题;

Parameter:

handle:主题句柄;

Returned value:

OK表示成功;

错误返回ERROR;

否则则有根据的去设置errno;

eg:

ret = orb_unsubscribe(handle);

Syntax:int orb_check(int handle, bool *updated)

Function:订阅者可以用来检查一个主题在发布者上一次更新数据后,有没有订阅者调用过ob_copy来接收、处理过;

Explain:如果主题在在被公告前就有人订阅,那么这个API将返回“not-updated”直到主题被公告。可以不用poll,只用这个函数实现数据的获取。

Parameter:

handle:主题句柄;

updated:如果当最后一次更新的数据被获取了,检测到并设置updated为ture;

Returned value:

OK表示检测成功;

错误返回ERROR;

否则则有根据的去设置errno;

eg:

if (PX4_OK != orb_check(sfd, &updated))

{

    return printf("check(1) failed");

}

if (updated)

{

    return printf("spurious updated flag");

    }

//or

bool updated;

struct random_integer_data rd;

   

orb_check(topic_handle, &updated);

if (updated)

{

   orb_copy(ORB_ID(random_integer), topic_handle, &rd);

      printf("Random integer is now %d\n", rd.r);

    }

Syntax:int orb_stat(int handle, uint64_t *time)

Function:订阅者可以用来检查一个主题最后的发布时间;

Parameter:

handle:主题句柄;

time:存放主题最后发布的时间;

0表示该主题没有发布或公告;

Returned value:

OK表示检测成功;

错误返回ERROR;

否则则有根据的去设置errno;

eg:

ret = orb_stat(handle,time);

Syntax:int orb_exists(const struct orb_metadata *meta, int instance)

Function:检测一个主题是否存在;

Parameter:

meta:uORB元对象,可以认为是主题id,一般是通过ORB_ID(主题名)来赋值;

instance:ORB 实例ID;

Returned value:

OK表示检测成功;

错误返回ERROR;

否则则有根据的去设置errno;

eg:

ret = orb_exists(ORB_ID(vehicle_attitude),0);

Syntax:int orb_priority(int handle, int *priority)

Function:获取主题优先级别;

Parameter:

handle:主题句柄;

priority:存放获取的优先级别;

Returned Value:

OK表示检测成功;

错误返回ERROR;

否则则有根据的去设置errno;

eg:

ret = orb_priority(handle,&priority);

数据流程使用如下图:

点击“阅读原文”,了解更多无人机学习资源
页: [1]
查看完整版本: Pixhawk-nuttx的相关函数解析