mp_flipper_fileio.c 8.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251
  1. #include <stdio.h>
  2. #include <stdbool.h>
  3. #include <stdint.h>
  4. #include <string.h>
  5. #include "py/obj.h"
  6. #include "py/stream.h"
  7. #include "py/runtime.h"
  8. #include "py/mperrno.h"
  9. #include "mp_flipper_fileio.h"
  10. extern const mp_obj_type_t mp_flipper_binary_fileio_type;
  11. extern const mp_obj_type_t mp_flipper_text_fileio_type;
  12. typedef struct _mp_flipper_fileio_file_descriptor_t {
  13. mp_obj_base_t base;
  14. void* handle;
  15. mp_obj_t name;
  16. uint8_t access_mode;
  17. uint8_t open_mode;
  18. } mp_flipper_fileio_file_descriptor_t;
  19. void* mp_flipper_file_new_file_descriptor(void* handle, const char* name, uint8_t access_mode, uint8_t open_mode, bool is_text) {
  20. mp_flipper_fileio_file_descriptor_t* fd = mp_obj_malloc_with_finaliser(
  21. mp_flipper_fileio_file_descriptor_t, is_text ? &mp_flipper_text_fileio_type : &mp_flipper_binary_fileio_type);
  22. fd->handle = handle;
  23. fd->name = mp_obj_new_str(name, strlen(name));
  24. fd->access_mode = access_mode;
  25. fd->open_mode = open_mode;
  26. return fd;
  27. }
  28. static mp_uint_t mp_flipper_fileio_read(mp_obj_t self, void* buf, mp_uint_t size, int* errcode) {
  29. mp_flipper_fileio_file_descriptor_t* fd = MP_OBJ_TO_PTR(self);
  30. return mp_flipper_file_read(fd->handle, buf, size, errcode);
  31. }
  32. static mp_uint_t mp_flipper_fileio_write(mp_obj_t self, const void* buf, mp_uint_t size, int* errcode) {
  33. mp_flipper_fileio_file_descriptor_t* fd = MP_OBJ_TO_PTR(self);
  34. return mp_flipper_file_write(fd->handle, buf, size, errcode);
  35. }
  36. static mp_uint_t mp_flipper_fileio_ioctl(mp_obj_t self, mp_uint_t request, uintptr_t arg, int* errcode) {
  37. mp_flipper_fileio_file_descriptor_t* fd = MP_OBJ_TO_PTR(self);
  38. if(request == MP_STREAM_SEEK) {
  39. struct mp_stream_seek_t* seek = (struct mp_stream_seek_t*)(uintptr_t)arg;
  40. size_t position;
  41. bool success;
  42. switch(seek->whence) {
  43. case MP_SEEK_SET:
  44. mp_flipper_file_seek(fd->handle, seek->offset);
  45. break;
  46. case MP_SEEK_CUR:
  47. position = mp_flipper_file_tell(fd->handle);
  48. mp_flipper_file_seek(fd->handle, position + seek->offset);
  49. break;
  50. case MP_SEEK_END:
  51. position = mp_flipper_file_size(fd->handle);
  52. mp_flipper_file_seek(fd->handle, position + seek->offset);
  53. break;
  54. }
  55. seek->offset = mp_flipper_file_tell(fd->handle);
  56. return 0;
  57. }
  58. if(request == MP_STREAM_FLUSH) {
  59. if(!mp_flipper_file_sync(fd->handle)) {
  60. *errcode = MP_EIO;
  61. return MP_STREAM_ERROR;
  62. }
  63. return 0;
  64. }
  65. if(request == MP_STREAM_CLOSE) {
  66. if(fd->handle != NULL) {
  67. if(!mp_flipper_file_close(fd->handle)) {
  68. *errcode = MP_EIO;
  69. return MP_STREAM_ERROR;
  70. }
  71. }
  72. return 0;
  73. }
  74. *errcode = MP_EINVAL;
  75. return MP_STREAM_ERROR;
  76. }
  77. static mp_obj_t mp_flipper_fileio_name(mp_obj_t self) {
  78. mp_flipper_fileio_file_descriptor_t* fd = MP_OBJ_TO_PTR(self);
  79. return fd->name;
  80. }
  81. static MP_DEFINE_CONST_FUN_OBJ_1(mp_flipper_fileio_name_obj, mp_flipper_fileio_name);
  82. static mp_obj_t mp_flipper_fileio_readable(mp_obj_t self) {
  83. mp_flipper_fileio_file_descriptor_t* fd = MP_OBJ_TO_PTR(self);
  84. return (fd->access_mode & MP_FLIPPER_FILE_ACCESS_MODE_READ) ? mp_const_true : mp_const_false;
  85. }
  86. static MP_DEFINE_CONST_FUN_OBJ_1(mp_flipper_fileio_readable_obj, mp_flipper_fileio_readable);
  87. static mp_obj_t mp_flipper_fileio_writable(mp_obj_t self) {
  88. mp_flipper_fileio_file_descriptor_t* fd = MP_OBJ_TO_PTR(self);
  89. return (fd->access_mode & MP_FLIPPER_FILE_ACCESS_MODE_WRITE) ? mp_const_true : mp_const_false;
  90. }
  91. static MP_DEFINE_CONST_FUN_OBJ_1(mp_flipper_fileio_writable_obj, mp_flipper_fileio_writable);
  92. static const mp_map_elem_t mp_flipper_file_locals_dict_table[] = {
  93. {MP_OBJ_NEW_QSTR(MP_QSTR_name), MP_ROM_PTR(&mp_flipper_fileio_name_obj)},
  94. {MP_ROM_QSTR(MP_QSTR_read), MP_ROM_PTR(&mp_stream_read_obj)},
  95. {MP_ROM_QSTR(MP_QSTR_readline), MP_ROM_PTR(&mp_stream_unbuffered_readline_obj)},
  96. {MP_ROM_QSTR(MP_QSTR_readlines), MP_ROM_PTR(&mp_stream_unbuffered_readlines_obj)},
  97. {MP_OBJ_NEW_QSTR(MP_QSTR_readable), MP_ROM_PTR(&mp_flipper_fileio_readable_obj)},
  98. {MP_OBJ_NEW_QSTR(MP_QSTR_writable), MP_ROM_PTR(&mp_flipper_fileio_writable_obj)},
  99. {MP_ROM_QSTR(MP_QSTR_write), MP_ROM_PTR(&mp_stream_write_obj)},
  100. {MP_ROM_QSTR(MP_QSTR_flush), MP_ROM_PTR(&mp_stream_flush_obj)},
  101. {MP_ROM_QSTR(MP_QSTR_close), MP_ROM_PTR(&mp_stream_close_obj)},
  102. {MP_ROM_QSTR(MP_QSTR_seek), MP_ROM_PTR(&mp_stream_seek_obj)},
  103. {MP_ROM_QSTR(MP_QSTR_tell), MP_ROM_PTR(&mp_stream_tell_obj)},
  104. {MP_ROM_QSTR(MP_QSTR___del__), MP_ROM_PTR(&mp_stream_close_obj)},
  105. {MP_ROM_QSTR(MP_QSTR___enter__), MP_ROM_PTR(&mp_identity_obj)},
  106. {MP_ROM_QSTR(MP_QSTR___exit__), MP_ROM_PTR(&mp_stream___exit___obj)},
  107. };
  108. static MP_DEFINE_CONST_DICT(mp_flipper_file_locals_dict, mp_flipper_file_locals_dict_table);
  109. static const mp_stream_p_t mp_flipper_binary_fileio_stream_p = {
  110. .read = mp_flipper_fileio_read,
  111. .write = mp_flipper_fileio_write,
  112. .ioctl = mp_flipper_fileio_ioctl,
  113. .is_text = false,
  114. };
  115. MP_DEFINE_CONST_OBJ_TYPE(
  116. mp_flipper_binary_fileio_type,
  117. MP_QSTR_BinaryFileIO,
  118. MP_TYPE_FLAG_ITER_IS_STREAM,
  119. protocol,
  120. &mp_flipper_binary_fileio_stream_p,
  121. locals_dict,
  122. &mp_flipper_file_locals_dict);
  123. static const mp_stream_p_t mp_flipper_text_fileio_stream_p = {
  124. .read = mp_flipper_fileio_read,
  125. .write = mp_flipper_fileio_write,
  126. .ioctl = mp_flipper_fileio_ioctl,
  127. .is_text = true,
  128. };
  129. MP_DEFINE_CONST_OBJ_TYPE(
  130. mp_flipper_text_fileio_type,
  131. MP_QSTR_TextFileIO,
  132. MP_TYPE_FLAG_ITER_IS_STREAM,
  133. protocol,
  134. &mp_flipper_text_fileio_stream_p,
  135. locals_dict,
  136. &mp_flipper_file_locals_dict);
  137. mp_obj_t mp_flipper_builtin_open(size_t n_args, const mp_obj_t* args, mp_map_t* kwargs) {
  138. const char* file_name = mp_obj_str_get_str(args[0]);
  139. uint8_t access_mode = MP_FLIPPER_FILE_ACCESS_MODE_READ;
  140. uint8_t open_mode = MP_FLIPPER_FILE_OPEN_MODE_OPEN_EXIST;
  141. bool is_text = true;
  142. if(n_args > 1) {
  143. size_t len;
  144. const char* mode = mp_obj_str_get_data(args[1], &len);
  145. for(size_t i = 0; i < len; i++) {
  146. if(i == 0 && mode[i] == 'r') {
  147. access_mode = MP_FLIPPER_FILE_ACCESS_MODE_READ;
  148. open_mode = MP_FLIPPER_FILE_OPEN_MODE_OPEN_EXIST;
  149. continue;
  150. }
  151. if(i == 0 && mode[i] == 'w') {
  152. access_mode = MP_FLIPPER_FILE_ACCESS_MODE_WRITE;
  153. open_mode = MP_FLIPPER_FILE_OPEN_MODE_CREATE_ALWAYS;
  154. continue;
  155. }
  156. if(i == 1 && mode[i] == 'b') {
  157. is_text = false;
  158. continue;
  159. }
  160. if(i == 1 && mode[i] == 't') {
  161. is_text = true;
  162. continue;
  163. }
  164. if(i >= 1 && mode[i] == '+') {
  165. access_mode = MP_FLIPPER_FILE_ACCESS_MODE_READ | MP_FLIPPER_FILE_ACCESS_MODE_WRITE;
  166. open_mode = MP_FLIPPER_FILE_OPEN_MODE_OPEN_APPEND;
  167. continue;
  168. }
  169. mp_raise_OSError(MP_EINVAL);
  170. }
  171. }
  172. void* handle = mp_flipper_file_open(file_name, access_mode, open_mode);
  173. void* fd = mp_flipper_file_new_file_descriptor(handle, file_name, access_mode, open_mode, is_text);
  174. return MP_OBJ_FROM_PTR(fd);
  175. }
  176. MP_DEFINE_CONST_FUN_OBJ_KW(mp_flipper_builtin_open_obj, 1, mp_flipper_builtin_open);
  177. static const mp_rom_map_elem_t mp_module_io_globals_table[] = {
  178. {MP_ROM_QSTR(MP_QSTR___name__), MP_ROM_QSTR(MP_QSTR_io)},
  179. {MP_ROM_QSTR(MP_QSTR_open), MP_ROM_PTR(&mp_flipper_builtin_open_obj)},
  180. {MP_ROM_QSTR(MP_QSTR_BinaryFileIO), MP_ROM_PTR(&mp_flipper_binary_fileio_type)},
  181. {MP_ROM_QSTR(MP_QSTR_TextFileIO), MP_ROM_PTR(&mp_flipper_text_fileio_type)},
  182. };
  183. static MP_DEFINE_CONST_DICT(mp_module_io_globals, mp_module_io_globals_table);
  184. const mp_obj_module_t mp_module_io = {
  185. .base = {&mp_type_module},
  186. .globals = (mp_obj_dict_t*)&mp_module_io_globals,
  187. };
  188. MP_REGISTER_EXTENSIBLE_MODULE(MP_QSTR_io, mp_module_io);