Export sensor functions and constants to MP

This commit is contained in:
iabdalkader 2014-02-05 14:05:46 +02:00
parent edd4e85c06
commit 422529dcea

View File

@ -9,10 +9,45 @@ struct sensor_dev sensor;
struct sym_entry {
const char *sym;
int val;
} static constants[] = {
};
static struct sym_entry pixformat_constants[] = {
{"RGB565", PIXFORMAT_RGB565}, /* 2BPP/RGB565*/
{"YUV422", PIXFORMAT_YUV422}, /* 2BPP/YUV422*/
{"GRAYSCALE", PIXFORMAT_GRAYSCALE}, /* 1BPP/GRAYSCALE*/
{NULL, 0}
};
static struct sym_entry framesize_constants[] = {
{"QQCIF", FRAMESIZE_QQCIF}, /* 88x72 */
{"QQVGA", FRAMESIZE_QQVGA}, /* 160x120 */
{"QCIF", FRAMESIZE_QCIF}, /* 176x144 */
{"QVGA", FRAMESIZE_QVGA}, /* 320x240 */
{"CIF", FRAMESIZE_CIF}, /* 352x288 */
{"VGA", FRAMESIZE_VGA}, /* 640x480 */
{"SXGA", FRAMESIZE_SXGA}, /* 1280x1024 */
{NULL, 0}
};
static struct sym_entry framerate_constants[] = {
{"FPS2", FRAMERATE_2FPS },
{"FPS8", FRAMERATE_8FPS },
{"FPS15", FRAMERATE_15FPS},
{"FPS30", FRAMERATE_30FPS},
{"FPS60", FRAMERATE_60FPS},
{NULL, 0}
};
static struct sym_entry gainceiling_constants[] = {
{"X2", GAINCEILING_2X},
{"X4", GAINCEILING_4X},
{"X8", GAINCEILING_8X},
{"X16", GAINCEILING_16X},
{"X32", GAINCEILING_32X},
{"X64", GAINCEILING_64X},
{"X128", GAINCEILING_128X},
{NULL, 0}
};
mp_obj_t py_sensor_sinit() {
sensor_init(&sensor);
@ -38,11 +73,55 @@ mp_obj_t py_sensor_snapshot() {
return image;
}
void py_sensor_print(void (*print)(void *env, const char *fmt, ...), void *env, mp_obj_t self_in, mp_print_kind_t kind) {
mp_obj_t py_sensor_set_pixformat(mp_obj_t pixformat) {
if (sensor_set_pixformat(&sensor, mp_obj_get_int(pixformat)) != 0) {
return mp_const_false;
}
return mp_const_true;
}
mp_obj_t py_sensor_set_framerate(mp_obj_t framerate) {
if (sensor_set_framerate(&sensor, mp_obj_get_int(framerate)) != 0) {
return mp_const_false;
}
return mp_const_true;
}
mp_obj_t py_sensor_set_framesize(mp_obj_t framesize) {
if (sensor_set_framesize(&sensor, mp_obj_get_int(framesize)) != 0) {
return mp_const_false;
}
return mp_const_true;
}
mp_obj_t py_sensor_set_gainceiling(mp_obj_t gainceiling) {
if (sensor_set_gainceiling(&sensor, mp_obj_get_int(gainceiling)) != 0) {
return mp_const_false;
}
return mp_const_true;
}
mp_obj_t py_sensor_set_brightness(mp_obj_t brightness) {
if (sensor_set_brightness(&sensor, mp_obj_get_int(brightness)) != 0) {
return mp_const_false;
}
return mp_const_true;
}
void py_sensor_print(void (*print)(void *env, const char *fmt, ...),
void *env, mp_obj_t self_in, mp_print_kind_t kind) {
print(env, "<Sensor MID:0x%.2X%.2X PID:0x%.2X VER:0x%.2X>",
sensor.id.MIDH, sensor.id.MIDL, sensor.id.PID, sensor.id.VER);
}
static void rt_store_constants(mp_obj_t m, struct sym_entry *constants)
{
/* Store module constants */
for (struct sym_entry *p = constants; p->sym != NULL; p++) {
rt_store_attr(m, QSTR_FROM_STR_STATIC(p->sym), MP_OBJ_NEW_SMALL_INT((machine_int_t)p->val));
}
}
mp_obj_t py_sensor_init()
{
/* Init sensor */
@ -57,14 +136,21 @@ mp_obj_t py_sensor_init()
/* Create module */
mp_obj_t m = mp_obj_new_module(qstr_from_str("sensor"));
/* Export functions */
rt_store_attr(m, qstr_from_str("init"), rt_make_function_n(0, py_sensor_sinit));
rt_store_attr(m, qstr_from_str("reset"), rt_make_function_n(0, py_sensor_reset));
rt_store_attr(m, qstr_from_str("snapshot"), rt_make_function_n(0, py_sensor_snapshot));
rt_store_attr(m, qstr_from_str("set_pixformat"), rt_make_function_n(1, py_sensor_set_pixformat));
rt_store_attr(m, qstr_from_str("set_framerate"), rt_make_function_n(1, py_sensor_set_framerate));
rt_store_attr(m, qstr_from_str("set_framesize"), rt_make_function_n(1, py_sensor_set_framesize));
rt_store_attr(m, qstr_from_str("set_gainceiling"), rt_make_function_n(1, py_sensor_set_gainceiling));
rt_store_attr(m, qstr_from_str("set_brightness"), rt_make_function_n(1, py_sensor_set_brightness));
/* Store module attributes */
for (struct sym_entry *p = constants; p->sym != NULL; p++) {
rt_store_attr(m, QSTR_FROM_STR_STATIC(p->sym), MP_OBJ_NEW_SMALL_INT((machine_int_t)p->val));
}
/* Store constants */
rt_store_constants(m, pixformat_constants);
rt_store_constants(m, framesize_constants);
rt_store_constants(m, framerate_constants);
rt_store_constants(m, gainceiling_constants);
return m;
}